1312-機(jī)器人集裝箱波紋板焊接機(jī)器人機(jī)構(gòu)運動學(xué)分析及車體結(jié)構(gòu)設(shè)計

1312-機(jī)器人集裝箱波紋板焊接機(jī)器人機(jī)構(gòu)運動學(xué)分析及車體結(jié)構(gòu)設(shè)計,機(jī)器人,集裝箱,波紋,焊接,機(jī)構(gòu),運動學(xué),分析,車體,結(jié)構(gòu)設(shè)計 密級： NANCHANG UNIVERSITY學(xué) 士 學(xué) 位 論 文THESIS OF BACHELOR（2002 —2006 年）題 目 集裝箱波紋板焊接機(jī)器人機(jī)構(gòu)運動學(xué)分析及車體結(jié)構(gòu)設(shè)計 學(xué) 院： 機(jī)電學(xué)院 系 機(jī)制 專 業(yè)： 機(jī)械設(shè)計制造及其自動化 班 級： 機(jī)制 023 班 學(xué) 號： 02122078 學(xué)生姓名： 陳愈馨 指導(dǎo)教師： 張華 教授 起訖日期： 2006.2.13~2006.6.2 學(xué)士學(xué)位論文要求裝訂成冊并應(yīng)包含以下主要內(nèi)容一、 畢業(yè)設(shè)計（論文）任務(wù)書二、開題報告三、南昌大學(xué)學(xué)士學(xué)位論文原創(chuàng)性申明四、畢業(yè)設(shè)計（論文）1、中文摘要2、外文摘要3、畢業(yè)設(shè)計（論文）全文五、外文資料原文六、外文資料譯文第一章 緒論1.1 選題的依據(jù)及意義這里介紹該課題的選題背景，以及完成該課題的意義。1.1.1 選題的依據(jù)圖 1-1 集裝箱波紋板示意圖針對集裝箱波紋板焊接自動化水平低的現(xiàn)狀：目前用于焊接集裝箱側(cè)板與頂側(cè)梁、底側(cè)梁的自動焊專機(jī)，由于在焊接過程中，焊槍不能隨波形的變化調(diào)整與焊槍速度的夾角（焊接工藝參數(shù)也未有變化） ，如圖 1-1 所示，在直線段與在波內(nèi)斜邊段，焊接速度方向恒為水平向右，而焊槍與焊縫保持垂直，故焊槍與焊接速度的夾角不能保持恒定，直接導(dǎo)致在直線段的焊縫成形與在波內(nèi)斜邊段的焊縫成形不能保持一致，進(jìn)而導(dǎo)致在直線段焊接與在波內(nèi)斜邊段焊接的焊縫的質(zhì)量不一樣，進(jìn)而制約集裝箱的生產(chǎn)質(zhì)量。1.1.2 選題的意義通過完成該課題，即設(shè)計出集裝箱波紋板三自由度焊接機(jī)器人及對其進(jìn)行運動學(xué)分析，能夠解決在焊接過程中焊槍不能隨波形的變化調(diào)整與焊槍速度的夾角這個問題，使得在直線段與在波內(nèi)斜邊段焊接時，焊槍與焊縫都保持垂直，相對于焊縫的焊接速度都恒為同一速度，進(jìn)而能夠提高在直線段與在波內(nèi)斜邊段的焊縫成形的一致性，提高集裝箱的生產(chǎn)質(zhì)量。1.2 研究現(xiàn)狀及發(fā)展趨勢這里的研究現(xiàn)狀及發(fā)展趨勢包括三個方面：前面也提到這里的集裝箱波紋板三自由度焊接機(jī)器人（為移動焊接機(jī)器人）是為提高焊接自動化水平的，故這里為移動焊接機(jī)器人的研究現(xiàn)狀及發(fā)展趨勢；關(guān)于結(jié)構(gòu)設(shè)計方面的研究現(xiàn)狀及發(fā)展趨勢；關(guān)于運動學(xué)分析的常用方法。1.2.1 移動焊接機(jī)器人的研究現(xiàn)狀及發(fā)展趨勢這里所設(shè)計的移動機(jī)器人為有軌移動焊接機(jī)器人，只是現(xiàn)有的移動焊接機(jī)器人技術(shù)在集裝箱波紋板焊接中的應(yīng)用，是該領(lǐng)域的焊接自動化水平低的緣故，而當(dāng)前的移動焊接機(jī)器人技術(shù)有相當(dāng)?shù)陌l(fā)展。隨著工業(yè)水平的發(fā)展,重要的大型焊接結(jié)構(gòu)件的應(yīng)用越來越多,其中大量的焊接工作必須在現(xiàn)場作業(yè),如大型艦船艙體、甲板的焊接、大型球罐(儲罐)的焊接等。而這些焊接場合下，焊接機(jī)器人要適應(yīng)焊縫的變化，才能做到提高焊接自動化的水平。無疑,將機(jī)器人技術(shù)和焊縫跟蹤技術(shù)結(jié)合將有效地解決大型結(jié)構(gòu)件野外作業(yè)的自動化焊接難題。當(dāng)前國內(nèi)外在移動焊接機(jī)器人方向研制的幾個典型移動焊接機(jī)器人如下：1、 韓國 Pukyong 國立大學(xué)的 Kam B O 等研制的艙體格子形構(gòu)件焊接移動機(jī)器人這種機(jī)器人能夠在人比較難以達(dá)到的狹窄空間自主地實現(xiàn)焊接過程,能夠自動尋找焊縫的起始點。在遇到格子框架的拐角焊縫時,在保證焊接速度不變且焊炬準(zhǔn)確對準(zhǔn)焊縫的情況下,能夠自動調(diào)整機(jī)器人本體和十字滑塊的位置。2、 南昌大學(xué)研制的履帶式爬壁弧焊機(jī)器人該機(jī)器人適應(yīng)于垂直壁面、球面、管道等多種表面上爬行,自動跟蹤焊接。3、 日本慶應(yīng)大學(xué)學(xué)者 Suga 等為平面薄板焊接研制的自主性移動焊接機(jī)器人該機(jī)器人能夠直線前進(jìn),還可以利用兩個輪的差速控制小車的轉(zhuǎn)彎,它裝焊槍的臂可以伸縮，可以檢測焊縫的位置并精確的識別焊縫的形狀,如是直線焊縫、曲線焊縫、還是折線焊縫等。4、 日本慶應(yīng)大學(xué)學(xué)者 Suga 等研制了管道焊接自主移動機(jī)器人該機(jī)器人可以沿著管道移動 ,根據(jù) CCD 攝取的圖象信息,在焊前可以自動尋找并識別焊縫,然后使機(jī)器人本體沿管道方向移動達(dá)到正確的焊接位置。5、 清華大學(xué)機(jī)械工程系與北京石油化工學(xué)院裝備技術(shù)研究所聯(lián)合研制的球罐磁吸附輪式移動焊接機(jī)器人該機(jī)器人的焊炬跟蹤精度可達(dá)±0.5mm,能夠滿足實際工程應(yīng)用。6、 上海交通大學(xué)研制的具有自尋跡功能的焊接移動機(jī)器人該機(jī)器人在焊前,小車能夠自動尋找焊縫并經(jīng)過軌跡推算后自動調(diào)整小車本體和焊炬的位姿到待焊狀態(tài);在焊接過程中能夠進(jìn)行橫向大范圍的實時焊縫跟蹤。當(dāng)前絕大多數(shù)移動焊接機(jī)器人還能焊縫跟蹤,焊前必須通過人為的方式,把機(jī)器人放到坡口附近合適的位置,并且通過手動將機(jī)器人本體、十字滑塊等調(diào)整到合適的待焊狀態(tài) ,也就是說機(jī)器人的自主性還很低,基本上還不具有自主的運動規(guī)劃能力。未來的發(fā)展趨勢為三個方面：選擇視覺傳感器來進(jìn)行傳感跟蹤，因為與圖象處理方面相關(guān)的技術(shù)得到發(fā)展；采用多傳感信息融合技術(shù)以面對更為復(fù)雜的焊接任務(wù)；由于控制技術(shù)由經(jīng)典控制到向智能控制技術(shù)的發(fā)展，這也將是移動焊接機(jī)器人的控制所采用。1.2.2 焊接機(jī)器人機(jī)構(gòu)設(shè)計的研究現(xiàn)狀及發(fā)展趨勢在當(dāng)前，機(jī)器人的機(jī)構(gòu)設(shè)計絕大部分還是采用依據(jù)具體的情況來設(shè)計專用焊接機(jī)器人，稱之為固定結(jié)構(gòu)的傳統(tǒng)機(jī)器人，其運動特性使特定機(jī)器人僅能適應(yīng)一定的范圍,不利于機(jī)器人的發(fā)展。解決這一問題的方法就是利用關(guān)節(jié)模塊和連桿模塊,根據(jù)具體的要求開發(fā)可重構(gòu)機(jī)器人系統(tǒng)。下面為當(dāng)前一些人所做的研究：1、Benhabib 等人建立的機(jī)器人庫,將模塊分成模塊單元連接器、連桿模塊、主關(guān)節(jié)模塊和末端關(guān)節(jié)模塊四類；2、1999 年 DanielaRus 等提出了一種由晶體結(jié)構(gòu)“分子”組成的可自重構(gòu)機(jī)器人系統(tǒng);3、上海交通大學(xué)的費燕瓊和沈陽航空工業(yè)學(xué)院的張艷麗等對模塊化機(jī)器人的構(gòu)形設(shè)計進(jìn)行了研究。1.2.3 運動學(xué)分析的常用方法機(jī)器人逆運動學(xué)問題在機(jī)器人運動學(xué)、動力學(xué)及控制中占有非常重要的地位，直接影響著控制的快速性與準(zhǔn)確性。逆運動學(xué)問題就是根據(jù)已知的末端執(zhí)行器的位姿(位置和姿態(tài))，求解相應(yīng)的關(guān)節(jié)變量。目前機(jī)器人運動學(xué)逆解方法有三種：1、 以手臂的精確的幾何模型為前提研究求解運動學(xué)方程的方法（幾何法）。該法只能用于特定結(jié)構(gòu)的機(jī)器人。2、通常在假設(shè)機(jī)器人的雅可比矩陣已知的前提下，利用其逆矩陣來求解逆運動學(xué)（齊次變換法）。3、智能求解方法該方法典型的有：基于學(xué)習(xí)的算法和神經(jīng)網(wǎng)絡(luò)算法；基于擴(kuò)散方程的學(xué)習(xí)算法。1.3 本課題的研究設(shè)計內(nèi)容及方法本科題所涉及的內(nèi)容主要是兩塊，分別為關(guān)于集裝箱波紋板三自由度焊接機(jī)器人機(jī)構(gòu)的運動學(xué)分析，該機(jī)器人車體結(jié)構(gòu)的設(shè)計。1.3.1 三自由度焊接機(jī)器人機(jī)構(gòu)運動學(xué)分析1、機(jī)構(gòu)方案根據(jù)實際的集裝箱波紋板的焊接條件，我們采用三個運動關(guān)節(jié)的機(jī)器人：左右平移的焊接機(jī)器人本體1、上下平移的十字滑塊2和做擺動運動的末端效應(yīng)器3。圖 1-2 三自由度焊接機(jī)器人關(guān)節(jié)模型（俯視圖）2、證明該方案能夠求出三個關(guān)節(jié)的運動學(xué)逆解，并且該解滿足一定的約束，能夠有效的解決在集裝箱波紋板在直線段中焊接的焊縫成形與在波內(nèi)斜邊段中焊接的焊縫成形不一致。3、所要解決的問題熟悉運動學(xué)逆解的方法、建立運動學(xué)模型、找出變換關(guān)系、逆解。4、方法齊次坐標(biāo)變換方法。1.3.2 焊接機(jī)器人結(jié)構(gòu)設(shè)計由于在這里借用了一個現(xiàn)成的運動關(guān)節(jié)上下平移的十字滑塊，故這里所做的設(shè)計主要為小車行走機(jī)構(gòu)（即左右平移的焊接機(jī)器人本體1） 。所要解決的問題及任務(wù)：小車行走機(jī)構(gòu)：車體結(jié)構(gòu)方案的確定，驅(qū)動電機(jī)功率的估計，驅(qū)動電機(jī)的選擇傳動的校核。其它：擺動關(guān)節(jié)電機(jī)的選擇等。1.4 課題的完成情況1、確定集裝箱波紋板焊接機(jī)器人總體機(jī)構(gòu)方案，并對該機(jī)構(gòu)存在運動學(xué)逆解，并求出，該解滿足集裝箱波紋板的焊接要求。2、做出了車體結(jié)構(gòu)設(shè)計與校核。第二章 焊接機(jī)器人機(jī)構(gòu)運動學(xué)分析概述：機(jī)器人是空間開環(huán)機(jī)構(gòu)，通過各連桿的相對位置變化、速度變化和加速度變化，使末端執(zhí)行部件（手爪）達(dá)到不同的空間位姿，得到不同的速度和加速度，從而完成期望的工作要求。機(jī)器人運動學(xué)分析指的是機(jī)器人末端執(zhí)行部件（手爪）的位移分析、速度分析及加速度分析。根據(jù)機(jī)器人各個關(guān)節(jié)變量 qi（i=1 ，2，3，…，n）的值，便可計算出機(jī)器人末端的位姿方程，稱為機(jī)器人的運動學(xué)分析（正向運動學(xué)）：反之，為了使機(jī)器人所握工具相對參考系的位置滿足給定的要求，計算相應(yīng)的關(guān)節(jié)變量，這一過程稱為運動學(xué)逆解。從工程應(yīng)用的角度來看，運動學(xué)逆解往往更加重要，它是機(jī)器人運動規(guī)劃和軌跡控制的基礎(chǔ)。在該課題里，很顯然這里是已知末端執(zhí)行器端點（焊槍）的位移，速度及焊槍與焊縫間的夾角關(guān)系，來求三個關(guān)節(jié)的協(xié)調(diào)運動，即三個關(guān)節(jié)的運動規(guī)律，故為運動學(xué)逆解。3．1 運動學(xué)分析數(shù)學(xué)基礎(chǔ)-其次變換（D-H 變換）1、齊次坐標(biāo)將直角坐標(biāo)系中坐標(biāo)軸上的單元格的量值 w 作為第四個元素，用有四個數(shù)所組成的列向量U= ??????wzyx來表示前述三維空間的直角坐標(biāo)的點（a,b,c） ,它們的關(guān)系為Ta= ,b= ,c=xyc則（x,y,z,w） 稱為三維空間點（a,b,c） 的齊次坐標(biāo)。TT這里所建立的直角坐標(biāo)系的坐標(biāo)軸上的單元格的量值 w=1，故（a,b,c,1） 為三維空間T點（a,b,c） 。2、齊次變換對于任意齊次變換 T，可以將其分解為T= = （3-1 ）??????1032311zyxpa??????12AA = （3-2 ）1??????3231aA =（p ,p ,p ） （3-3 ）1xyzT式（3-2）表示活動坐標(biāo)系在參考系中的方向余旋陣，即坐標(biāo)變換中的旋轉(zhuǎn)量；而式（3-3）表示活動坐標(biāo)系原點在參考系中的位置，即坐標(biāo)變換中的平移量。特殊情況有平移變換和旋轉(zhuǎn)變換：平移變換：H=Trans(a,b,c)= (3-??????10cba4)旋轉(zhuǎn)變換：Rot(z, )= (3-5)????????100cosini?3.2 變換方程的建立1、機(jī)構(gòu)運動原理圖 3-1 三自由度焊接機(jī)器人運動簡圖（俯視圖）如圖 3-1 所示，機(jī)器人采用三個運動關(guān)節(jié)：左右平移的焊接機(jī)器人本體 1，前后平移的十字滑塊和做旋轉(zhuǎn)運動的末端效應(yīng)器 3。通過三個關(guān)節(jié)之間的協(xié)調(diào)運動，來保證末端效應(yīng)器的姿態(tài)發(fā)生變化時，焊接速度保持不變，焊槍與焊縫間的夾角保持垂直關(guān)系，來做到直線段與波內(nèi)斜邊段焊縫成形的一致。2、運動學(xué)模型運動學(xué)模型簡化○ 1由于該機(jī)器人是為了實現(xiàn)這樣一種運動：焊槍末端運動軌跡一定，焊接速度恒定，故可以在運動學(xué)逆解時，對實際的關(guān)節(jié)結(jié)構(gòu)進(jìn)行簡化，這里將對其采取等效處理：a 將關(guān)節(jié) 1（左右平移的焊接機(jī)器人本體 1）與關(guān)節(jié) 2（前后平移的十字滑塊 2）之間沿 Z 軸的距離和關(guān)節(jié) 2 與關(guān)節(jié) 3（做旋轉(zhuǎn)運動的末端效應(yīng)器 3）的旋轉(zhuǎn)中心點的距離視為零，這對分析結(jié)果是等效的。b 對旋轉(zhuǎn)關(guān)節(jié)焊槍投影在 X-Y 平面上進(jìn)行等效。設(shè)定機(jī)器人各關(guān)節(jié)坐標(biāo)系○ 2據(jù)簡化后的模型與圖 3-1 可獲得各個坐標(biāo)系及其之間的關(guān)系，各個坐標(biāo)系的 X，Y 方向如圖 3-1 所示，Z 方向都垂直該俯視圖，且由前面的簡化等效思想可知各個關(guān)節(jié)的運動都處在 Z =0 平面上。○ 4求其次變換○ 3通過齊次變換矩陣 T 可以轉(zhuǎn)求{m}中的某點在{n}中的坐標(biāo)值。mn根據(jù)公式（3-4） 、 （3-5）及圖 3-1 可得T = ，T = ，T =10???????101Sl2???????102SL3???????100cosini2L?其中 l ,L ,L 分別表示初始時刻（t ） ，三個坐標(biāo)系原點 OO ，O O ，O O 的距離012 123長度。S 為坐標(biāo)系{1}原點在一定時間 t-t 內(nèi)沿 X 方向的位移，且 , 為關(guān)節(jié) 10 d（ S） =v1的移動速度。S 為坐標(biāo)系{2}點在一定時間 t-t 內(nèi)沿 Y 向的位移，且 , 為關(guān)節(jié)2 2()?22 相對關(guān)節(jié) 1 的移動速度。求 T○ 4 30由變換方程公式可知 T = T T T ，帶入 T ，T ，T 可得：302103210T = （3-30 ????????10cosini2SLl?6）其幾何意義為空間某一點相對于坐標(biāo)系{0}及{3}的坐標(biāo)值之間的變換矩陣。即： = （3-??????10zyx ?????10cosini210SLl????3zyx7）求變換方程○ 5在任意時刻 t，焊槍末端點相對于 {3}系的齊次坐標(biāo)為（0,r,0,1） ，代入公式（3-7）可得變換方程：（3-??????2100cosinSLrylx?8）3．3 運動學(xué)分析處理方法1、替換處理轉(zhuǎn)折點處用一半徑為 R 的圓弧代替，其中半徑 R 的大小受 角的影響， 角越大，R 越?小；反之亦然。這樣方能使運動的連續(xù)成為可能。2、銜接處理在直線段與波內(nèi)斜邊段劃出一小段來為過渡運動更加順利的完成，這樣過渡運動過程運動分三小階段。現(xiàn)利用以上兩處理方法處理第一個轉(zhuǎn)折點的過渡運動，這一階段是銜接兩種運動的過渡階段：旋轉(zhuǎn)關(guān)節(jié)的轉(zhuǎn)角 ：0 到 的過渡。○ 1 ??焊接速度 v 的方向：水平方向到與水平方向呈 的夾角的過渡。○ 2 w ?下面是該過渡階段的運動示意圖：twtA BtA'tB' ttA BtA'tB'??圖 3-2 旋轉(zhuǎn)關(guān)節(jié)在過渡處的運動示意圖3、逆解函數(shù)這里所求逆解都是以時間為自變量，由于這里焊接速度相對焊縫是恒定的，s=v t，w故與以焊槍末端點的自然坐標(biāo)系的位移為自變量是一致的，求解較方便。3．4 逆解過程這臺機(jī)器人焊接時，其運動存在三個約束：焊接速度恒定，焊接軌跡曲線一定，焊槍與焊縫保持垂直。在這里，由前面的分析處理思想及方法可知，在過渡運動過程中放棄了第三個約束，由于這么一小段位移比較短，不然的話，會導(dǎo)致無解，因為旋轉(zhuǎn)關(guān)節(jié)的角速度的必然連續(xù)。這里將取波紋的一個周期進(jìn)行運動學(xué)逆解，求出三個關(guān)節(jié)應(yīng)按照什么運動規(guī)律進(jìn)行運動，還有三個關(guān)節(jié)的運動之間的函數(shù)關(guān)系。圖 3-3 波紋的一個周期的各個運動階段的分段示意圖這里假設(shè) A 處為運動起始時刻，□為字母（A，A ，B，…，H ‘）代表焊接軌跡上的點，'t□ 為焊槍末端點運動到該點處的時間， （x □ ,y□ ）代表該點在基坐標(biāo)系上的坐標(biāo)。1、AB 段（過渡段 1）前面已經(jīng)介紹過這里的處理方法，這一階段是銜接兩種運動的過渡階段。這里又細(xì)分三個小階段：A→A 直線段,A →B 圓弧段，B →B 直線段。為了提高焊接質(zhì)量，該過渡' '' '階段仍然保留焊接速度相對于焊縫為恒定，而放棄焊槍與焊縫保持垂直關(guān)系，不然會導(dǎo)致無解。其中，A→A 直線段旋轉(zhuǎn)關(guān)節(jié)逆時針旋轉(zhuǎn) ，A →B 圓弧段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)，B ' 2?'' '→B 直線段旋轉(zhuǎn)關(guān)節(jié)又逆時針旋轉(zhuǎn) 。直線段○ 1 A??該小階段旋轉(zhuǎn)關(guān)節(jié)逆時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2w??0x0yA?0o圖 3-4 A→A 直線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-4 可得：（3-??????Awytvx00)(9）將其帶入變換方程（3-8）得（3-???????21100cosin)(SLryltvxAw?10）將以上兩式對 t 求導(dǎo)并整理可得：（t ） (3-????????sinc21rvwAt??11)其中旋轉(zhuǎn)關(guān)節(jié) 3 的運動規(guī)律( -t, -t)如圖 3-5 所示：??ttA tAAt?()t?? ()t?At?2?4圖 3-5 A→A 直線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'圓弧段○ 2 B??該小階段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)， ， 為圖 3-6 中所示角。0,2?????)(t?RO1v2w()tA?B?t?0x0y0o圖 3-6 A →B 圓弧段焊接點位置關(guān)系示意圖''根據(jù)圖 3-6 及平面幾何知識可得：（3-????????? )(cos1in0tRyxA?12）將其帶入變換方程（3-8）得：（3-??????????? 210cos)(cs1ini SLrtylxA??13）將以上兩式對 t 求導(dǎo)并整理可得：（3-??????)(sinco21tRv?13）又由速度合成知識可得： ，帶入上式可解得： 。221wv??Rvtw??)(?將這結(jié)果帶入式（3-13）可轉(zhuǎn)化為：（ ） （3-????)(sinco21tvw?BAtt???14）其中 的運動規(guī)律如圖 3-7 所示：)(twvRt?? ()t?t t?At? At? Bt?Bt?圖 3-7 A →B 圓弧段 的運動規(guī)律'' )(t?斜線段○ 3 B??該直線段旋轉(zhuǎn)關(guān)節(jié)又逆時針旋轉(zhuǎn) 角度。2?'Bwv0y0x?W圖 3-8 B →B 直線段焊接點位置關(guān)系示意圖'根據(jù)上圖可得：（3-???????? ?sin)(co0BwBtvyx15）將其帶入變換方程（3-8）得：（3-??? ?????? 210cossin)(iSLrtvylxBwB?16）將以上兩式對 t 求導(dǎo)并整理可得：（ ） （3-?????????sinico21rvw Btt??17）其中旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律( -t, -t)如圖 3-5 所示：?ttB ttBBt? 34?()t?? 2Bt?()t?圖 3-9 B →B 斜線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'2、BC 段（波內(nèi)斜邊段 1）這一階段旋轉(zhuǎn)關(guān)節(jié) 3 不轉(zhuǎn)動， 。0,?????0y0x?B CWVW 1v2圖 3-10 B →C 波內(nèi)斜邊段焊接點位置關(guān)系示意圖根據(jù)上圖可得：（3-??????? ?sin)(co0BwBtvyx18）將其帶入變換方程（3-8）得：（3-??? ?????? 210cossin)(iSLrtvylxBwB?19）將以上兩式對 t 求導(dǎo)并整理可得：（ ） （3-?????sinco21wvCBt?20）3、CD 段（過渡段 2）這一階段里的處理思想方法與過渡段 1 是一樣的。其中，C→C 斜線段旋轉(zhuǎn)關(guān)節(jié)順時針旋轉(zhuǎn) 角度，C →D 圓弧段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)，' 2?''D →D 直線段旋轉(zhuǎn)關(guān)節(jié)又順時針旋轉(zhuǎn) 角度。' A→A 斜線段○ 1 '該小階段旋轉(zhuǎn)關(guān)節(jié)順時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2?w0y 0x?CWV'圖 3-11 C→C 斜線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-11 可得：（3-???????sin)(co0wCCtvyx21）將其帶入變換方程（3-8）得：（3-??? ????210cossin)(iSLrtvylxCwC?22）將以上兩式對 t 求導(dǎo)并整理可得：（ ） （3-?????????sinico21rvw Ctt??23）其中旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律( -t, -t)如圖 3-12 所示：?tt)t? ()t?c c?cc?342圖 3-12 C→C 斜線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖' C →D 圓弧段○ 2 ''該小階段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)， 。0,2?????RO1v2vwR()t?()t? 0x0y0?D?圖 3-13 C →D 圓弧段焊接點位置關(guān)系示意圖''根據(jù)圖 3-13 及平面幾何知識可得：（3-???????? )(cos1in0tRyxD?24）將其帶入變換方程（3-8）得：（3-?????????? 210cos)(cs1ini SLrtylxD??25）將以上兩式對 t 求導(dǎo)并整理可得：（3-???????)(sinco21tRv?26）又由速度合成知識可得： ，帶入上式可解得： 。221wv??wvRt???)(?將這結(jié)果帶入式（3-13）可轉(zhuǎn)化為：（ ） （3-????)(sinco21tvw?DCtt???27）其中 的運動規(guī)律如圖 3-14 所示：)(t'ct t)('?'Dt)(t??'ct 'Dtt圖 3-14 C →D 圓弧段 的運動規(guī)律'' )(t?D →D 直線段○ 3 '該小階段旋轉(zhuǎn)關(guān)節(jié)又順時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2?w0O0y 0xwwv?圖 3-15 D →D 直線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-15 可得：（3-?????????Dwytvx0)(28）將其帶入變換方程（3-8）得（3-?????????? 2110cosin)(SLryltvxDw?29）將以上兩式對 t 求導(dǎo)并整理可得：（ ） (3-????????sinc21rvwDtt??30)其中旋轉(zhuǎn)關(guān)節(jié) 3 的運動規(guī)律( -t, -t)如圖 3-16 所示：??)(t??t'Dt )(t?Dt Dt'Dt2?4圖 3-16 D →D 直線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'4、DE 段（直線段 1）這一階段旋轉(zhuǎn)關(guān)節(jié) 3 不轉(zhuǎn)動， 。0,????又根據(jù)約束（焊槍與焊縫垂直，相對于焊縫焊接速度恒定，焊縫軌跡為水平直線）和運動合成知識可得出：（ ） （3-????021vwEDtt?31）5、EF 段（過渡段 3）這一階段里的處理思想方法與過渡段 1 是一樣的。其中，E→E 斜線段旋轉(zhuǎn)關(guān)節(jié)順時針旋轉(zhuǎn) 角度，E →F 圓弧段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)，' 2?''F →F 直線段旋轉(zhuǎn)關(guān)節(jié)又順時針旋轉(zhuǎn) 角度。'E→E 直線段○ 1 '該小階段旋轉(zhuǎn)關(guān)節(jié)順時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2w0O0y0x'EEwwv圖 3-17 E→E 直線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-17 可得：（3-??????Ewytvx0)(32）將其帶入變換方程（3-8）得（3-???????2110cosin)(SLryltvxEw?33）將以上兩式對 t 求導(dǎo)并整理可得：（ ） (3-????????sinc21rvwEtt??34)其中旋轉(zhuǎn)關(guān)節(jié) 3 的運動規(guī)律( -t, -t)如圖 3-17 所示：??t'EEt 2??)(tE 'Et4)?圖 3-17 E→E 直線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'E →F 圓弧段○ 2 ''該小階段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)， 。0,2??????RO1v2w()t?t0x0y0E?F?圖 3-18 E →F 圓弧段焊接點位置關(guān)系示意圖''根據(jù)圖 3-18 及平面幾何知識可得：（3-????????? )(cos1in0tRyxE?35）將其帶入變換方程（3-8）得：（3-??????????? 210cos)(cs1ini SLrtylxE??36）將以上兩式對 t 求導(dǎo)并整理可得：（3-???????)(sinco21tRv?37）又由速度合成知識可得： ，帶入上式可解得： 。221wv??wvRt??)(?將這結(jié)果帶入式（3-37）可轉(zhuǎn)化為：（ ） （3-?????)(sinco21tvw?FEt???38）其中 、 的運動規(guī)律如圖 3-19 所示：)(tt?t)(t?tRvw ?Et?()t??E?Ft? F?圖 3-19 E →F 圓弧段 的運動規(guī)律'' )(t?F →F 斜線段○ 3 '該小階段旋轉(zhuǎn)關(guān)節(jié)又順時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2?w0O0y 0x?'FFwv圖 3-20 F →F 斜線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-20 可得：（3-???????? ?sin)(co0FwFtvyx39）將其帶入變換方程（3-8）得：（3-??? ?????? 210cossin)(iSLrtvylxFwF?40）將以上兩式對 t 求導(dǎo)并整理可得：（ ） （3-??????????sinico21rvw Ftt??41）其中旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律( -t, -t)如圖 3-21 所示：??t'Ft Ft??)(t?2??43t'FF)?圖 3-21 F →F 斜線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'6、FG 段（波內(nèi)斜邊段 2） ?1v2v wv圖 3-22 FG 段波內(nèi)斜邊段的速度合成圖該階段： ；并滿足焊接速度相對焊縫恒定，焊槍與焊縫保持垂直關(guān)系。0,??????因此根據(jù)速度合成知識（如圖 3-22 所示）可得：（ ） （3-????sinco21wvGFtt?42）7、GH 段（過渡段 4）這一階段里的處理思想方法與過渡段 1 是一樣的。這里分三個小運動階段，其中，G→G 斜線段旋轉(zhuǎn)關(guān)節(jié)逆時針旋轉(zhuǎn) 角度，G →H' 2?'圓弧段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)，H →H 直線段旋轉(zhuǎn)關(guān)節(jié)又逆時針旋轉(zhuǎn) 角度。' 'G→G 斜線段○ 1 '該小階段旋轉(zhuǎn)關(guān)節(jié)逆時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2?w0O0y 0x?'GGwv圖 3-23 G→G 斜線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-23 可得：（3-???????sin)(co0GwGtvyx43）將其帶入變換方程（3-8）得：（3-??? ????210cossin)(iSLrtvylxGw?44）將以上兩式對 t 求導(dǎo)并整理可得：（ ） （3-??????????sinico21rvw Gtt??45）其中旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律( -t, -t)如圖 3-24 所示：?t 'GtGt 43??)(t?2'GG()t??圖 3-24 G→G 斜線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'G →H 圓弧段○ 2 ''該小階段旋轉(zhuǎn)關(guān)節(jié)不旋轉(zhuǎn)， 。0,2??????RO1v2w()t?0x0y0?H?圖 3-25 G →H 圓弧段焊接點位置關(guān)系示意圖''根據(jù)圖 3-25 及平面幾何知識可得：（3-????????? )(cos1in0tRyxH?46）將其帶入變換方程（3-8）得：（3-??????????? 210cos)(cs1ini SLrtylxH??47）將以上兩式對 t 求導(dǎo)并整理可得：（3-???????)(sinco21tRv?48）又由速度合成知識可得： ，帶入上式可解得： 。221wv??wvRt???)(?將這結(jié)果帶入式（3-48）可轉(zhuǎn)化為：（ ） （3-?????)(sinco21tvw?HGt???49）其中 、 的運動規(guī)律如圖 3-26 所示：)(tt?)('t?t)(t?tRvw? Ht'Ht?'HtHt圖 3-26 C →D 圓弧段 的運動規(guī)律'' )(t?H →H 直線段○ 3 '該小階段旋轉(zhuǎn)關(guān)節(jié)又逆時針旋轉(zhuǎn) ，并保證焊接速度 v 相對于焊縫為恒定。2?w0O0y 0xwwv?H圖 3-27 H →H 直線段焊接點位置關(guān)系示意圖'根據(jù)圖 3-27 可得：（3-?????????Hwytvx0)(50）將其帶入變換方程（3-8）得（3-?????????? 2110cosin)(SLryltvxHw?51）將以上兩式對 t 求導(dǎo)并整理可得：（ ） (3-????????sinc21rvwHtt??52)其中旋轉(zhuǎn)關(guān)節(jié) 3 的運動規(guī)律( -t, -t)如圖 3-28 所示：??t'Ht4??)(t?2tH'HtH)t?圖 3-28 H →H 直線段旋轉(zhuǎn)關(guān)節(jié)的運動規(guī)律示意圖'8、HI 段（直線段 2）該階段運動： ；并滿足焊接速度相對于焊縫保持恒定，焊槍與焊縫的夾0,????角保持垂直關(guān)系。根據(jù)速度合成知識可得：（ ） （3-????021vwIHtt?53）以上即為焊接集裝箱一個周期波紋板的運動學(xué)逆解。3.5 結(jié)論1、由逆解過程可以看出三自由度焊接機(jī)器人三個運動關(guān)節(jié)按照一定的運動規(guī)律協(xié)調(diào)動作，即可以保證焊槍以一定的位姿與焊接速率進(jìn)行焊接，將較好的解決波紋直線焊縫與波內(nèi) 斜邊焊縫成形不能保持一致的難題。2、所求焊接過渡段中的過渡運動能較好的銜接直線段與波內(nèi)斜邊段的運動。第三章 結(jié)構(gòu)設(shè)計3.1 小車行走結(jié)構(gòu)設(shè)計這里主要是做了三方面的工作：對小車行走機(jī)構(gòu)的結(jié)構(gòu)方案的比較與選擇；對電機(jī)功率的估計并選擇出小車的驅(qū)動電機(jī)；對根據(jù)結(jié)構(gòu)設(shè)計的齒輪、齒條傳動的接觸疲勞強(qiáng)度、彎曲疲勞強(qiáng)度校核。3.1.1 車體結(jié)構(gòu)方案的比較與選擇根據(jù)一些移動機(jī)器人本體設(shè)計的研究文獻(xiàn)及直動關(guān)節(jié)的知識可獲得兩個車體結(jié)構(gòu)方案。這兩個方案的示意圖如圖所示：方案 1：其中傳動順序為：電機(jī) 齒輪箱 車輪軸上齒輪 （通過車輪軸）驅(qū)動輪。?這也是在移動機(jī)器人本體結(jié)構(gòu)設(shè)計上較為常用的一種車體結(jié)構(gòu)方案，布置比較對稱合理。方案 2：其中傳動順序為：電機(jī) 圓柱齒輪 固定齒條 （通過反推動）車體結(jié)構(gòu)。這里的設(shè)計有借鑒將旋轉(zhuǎn)運動轉(zhuǎn)化為直線運動里有齒輪、齒條這么一種傳動方式，結(jié)構(gòu)比較簡單，設(shè)計比較容易。方案間的比較：表 1 兩車體機(jī)構(gòu)方案的比較方案比較方面方案 1方案 2設(shè)計方面 較復(fù)雜較簡單結(jié)構(gòu)方面 稍復(fù)雜 稍簡單布置方面 對稱點有點偏移效率方面 較低 較高精度方面 高 稍差用材方面 還好 有長齒條根據(jù)實際的工作條件：希望設(shè)計能夠比較簡單，結(jié)構(gòu)比較簡單，焊接小車的移動效率高一點，精度要求并不是很高， 。故可從表 1 可選擇出方案 2 作為該小車的設(shè)計結(jié)構(gòu)方案。3.1.2 小車驅(qū)動電機(jī)功率的確定1、電機(jī)功率的估計根據(jù)機(jī)器人的重量、小車運行速度、輪胎直徑來確定驅(qū)動電機(jī)的功率。假定小車在軌道上行走，不考慮小車行駛中的空氣阻力，分析小車的受力情況，以便估計小車所需的驅(qū)動力矩。此時，應(yīng)把輪胎看成一個彈性體來考慮。前面也提到了，在這里，由于電機(jī)的驅(qū)動是通過齒輪、齒條的嚙合來驅(qū)動，故該小車的四輪都為從動輪。這里先分析車輪的受力情況：vPXmg?UN圖 車輪受力簡圖假設(shè)在運動過程中，輪子做純滾動。設(shè)小車運動時的加速度為 ，相應(yīng)的車輪角加速度為 。dvt dwt根據(jù) 可推得：vwr?1dt其中 v 為小車速度，w 為車輪角速度，r 為車輪的半徑。圖 畫出了該小車的車輪在運動過程中的受力簡圖，圖中P 車輪上的載荷，m 車輪的質(zhì)量，N 地面對車輪的法向反作用力，U 為車輪的切向反作用力，X 車輪軸的車輪的推力。根據(jù)平衡條件有（3-dvUt??1）（3-fwrMJt2）為車輪滾動阻力矩，其值為 ；J 為車輪的轉(zhuǎn)動慣量。f N??根據(jù)式（3-1） 、 （3-2）有（3-2fJdvXmrt?????????3）由此可知，推動車輪前進(jìn)要克服兩種阻力，即車輪的滾動阻力和車輪的加速阻力。而后者又由平移質(zhì)量產(chǎn)生的加速阻力 和由旋轉(zhuǎn)質(zhì)量產(chǎn)生的加速阻力 所組成。dvmt 2Jdvrt?齒輪、齒條傳動作為該小車的驅(qū)動機(jī)構(gòu)，故驅(qū)動力矩設(shè)為 ， 進(jìn)而可將 理解dMdr?為小車的實際驅(qū)動力， 為齒輪的半徑。r?故以小車車體做分析對象，在水平方向上，應(yīng)用牛頓第二定律可得：（3-04()dMdvXmrt??4）其中 為機(jī)器人總質(zhì)量。0將式（3-3）中的 X 帶入上式得；（3-0244fdMJdvmrtr??????????5）由上式可得出結(jié)論為：小車的驅(qū)動力用來克服車輪的滾動阻力和機(jī)器人的平移質(zhì)量的加速阻力和車輪的旋轉(zhuǎn)阻力。可根據(jù)式（3-5）粗估出驅(qū)動力矩：其中：車輪半徑 ， （查理論力學(xué) P120 表 5-2 滾動摩阻系數(shù) 。60rm?2? ?） ， ；40r??估為 40 kg ,車輪質(zhì)量估計為 0.8kg ,J 估計為 ，m 426.10kgm???牛；??0(0.8)1944gN???由于這里的焊接速度為 ，故可一定程度上估出 。.2min2dvst?將上述數(shù)據(jù)帶入式（3-5）得： 4.29()dM??進(jìn)而根據(jù)要求的運行速度為 v ,初步確定電機(jī)的功率 P：（3-dvPKr???6）其中：K 為估計系數(shù)，考慮到該焊接機(jī)器人其上的關(guān)節(jié)的運動，可取為 5。解之得： 10.73w?2. 電機(jī)的選擇前面已初步估計出了驅(qū)動力矩，電機(jī)的功率。在實際的操作中，機(jī)器人的驅(qū)動，使用的電機(jī)類型主要有步進(jìn)電機(jī)、直流伺服電機(jī)、交流伺服電機(jī)等?？紤]到步進(jìn)電機(jī)通過改變脈沖頻率來調(diào)速。能夠快速啟動、制動，有較強(qiáng)的阻礙偏離穩(wěn)定的抗力。又由于這里的位置精度要求并不高，而步進(jìn)電機(jī)在機(jī)器人無位置反饋的位置控制系統(tǒng)中得到了廣泛的應(yīng)用。這里選定步進(jìn)電機(jī)為驅(qū)動電機(jī)，考慮到在實際的選擇中應(yīng)考慮到一定的裕度。這里選用的是杭州日升生產(chǎn)的永磁感應(yīng)子式步進(jìn)電機(jī)：型號：130BYG2501；步距角：0.9/1.8 度；電壓：120-310v相數(shù)：2 ；電流：6 A;靜轉(zhuǎn)矩：270 ；kgcm?空載運行頻率： ；18?轉(zhuǎn)動慣量： ；2?3.1.3 齒輪、齒條傳動的校核這里齒輪、齒條的傳動是按照結(jié)構(gòu)聯(lián)系上來設(shè)計的，故這里對齒輪進(jìn)行彎曲強(qiáng)度校核、接觸強(qiáng)度校核。其參數(shù)為：齒輪直徑 ，齒寬為 ，模數(shù)為 ，齒數(shù)為 80。80m351m前面也對驅(qū)動力矩做出估計并給出轉(zhuǎn)速， ， 。4.29dM?.inv這里參考《機(jī)械設(shè)計》P209 里的帶式輸送機(jī)減速器的高級級齒輪傳動設(shè)計進(jìn)行校核。由于這里的齒條可以理解為半徑無窮大的圓柱齒輪，故不存在疲勞強(qiáng)度是否符合要求，對齒條的強(qiáng)度無需校核，這里只需校核齒輪的彎曲疲勞強(qiáng)度、接觸疲勞強(qiáng)度。1.選定齒輪類型、精度等級、材料1）這里以直齒圓柱齒輪齒條傳動。2）該焊接機(jī)器人速度不高，故選用 7 級精度（GB10095-88） 。3）由表 10-1 選擇齒輪材料為 40Cr（調(diào)質(zhì)） ，硬度為 280HBS，齒條材料為 45 鋼（調(diào)質(zhì)），硬度為 240HBS，二者材料硬度差為 40HBS。2.按齒面接觸強(qiáng)度校核按照公式（10-9a）進(jìn)行校核：（3-??2132. EdHKTZu????????????7）1） 確定公式內(nèi)的各計算數(shù)值（1）計算載荷系數(shù) K根據(jù) ，7 級精度，由表 10-8 查得動載系數(shù) ；.2minv? 1.05vK?由表 10-2 查得使用系數(shù) ；1A?直齒輪，調(diào)質(zhì)，及 。查表 10-334.290.6105tKFNbm???的 ；1.HFK??由表 10-4 查的 7 級精度、小齒輪相對支承非對稱布置時， 31.2080.21HKb???????2d（ +.6）將數(shù)據(jù)帶入后得： 6由 查圖 10-13 得 ；35.,.2.1Hbh??? .FK??故載荷系數(shù)。.051.61.345AvHK???（2）齒寬系數(shù) 。437d??（3）由表 10-6 查得材料的彈性影響系數(shù) 。1289.EZMPa?（4）由圖 10-21d 按齒面硬度查得小齒輪的接觸疲勞強(qiáng)度極限 。lim60HPa??（5）由式 10-13 計算應(yīng)力循環(huán)次數(shù)。7160301(2405).481hNnjL???（7）由圖 10-19 查得接觸疲勞系數(shù) 。.9HNK?（8）JI 計算接觸疲勞許用應(yīng)力取失效概率 1%，安全系數(shù) ，由式（10-12）得1S??lim0.5670HNMPa??（9）由于這里是齒輪、齒條傳動，故可認(rèn)為傳動比 u??2） 計算將上面計算的各項數(shù)據(jù)帶入式（3-7）得： 19.4d?而這里設(shè)計該傳動的齒輪半徑 ，顯然滿足接觸疲勞強(qiáng)度。80?3.按齒根彎曲疲勞強(qiáng)度校核這里按照公式（10-5）進(jìn)行校核： ??132FaSdYKTmz?????????1） 確定公式內(nèi)各計算數(shù)值（1） 由圖 10-20c 查得齒輪的彎曲疲勞強(qiáng)度極限 50FEMPa??（2） 由圖 10-18 查得彎曲疲勞壽命系數(shù) .92NK（3） 計算彎曲疲勞許用應(yīng)力取彎曲疲勞安全系數(shù) ，由式（10-12）得1.4S???1092538.6.FNEK???（4）計算載荷系數(shù) K 1.051.305AvFK??????（5）查取齒形系數(shù)由表 10-5 查得 2.8FaY（6）查取應(yīng)力校正系數(shù)由表 10-5 可查的得 1.73Sa?2）計算 0.3m?而這里設(shè)計的是 ，顯然滿足彎曲疲勞強(qiáng)度，故校核結(jié)果符合要求。4、結(jié)論綜上，所設(shè)計的齒輪參數(shù)符合要求，校核完畢。3.2 擺動關(guān)節(jié)電機(jī)選擇考慮到擺動關(guān)節(jié)的實際情況，對電機(jī)的要求：質(zhì)量輕，體積小，頻繁的正反轉(zhuǎn)，換向性能好，較好的運動控制精度，功率為二十多瓦。故這里選擇直流伺服電機(jī)中的印刷繞組直流永磁式。該類型直流伺服電機(jī)又稱盤式電機(jī)，有特點：快速響應(yīng)性能好；可以頻繁的起動、制動、正反轉(zhuǎn)工作；轉(zhuǎn)子無鐵損，效率高；換向性能好；壽命長；負(fù)載變化時轉(zhuǎn)速變化率小，輸出力矩平穩(wěn)。這里選擇的型號是 Maxon 組合體系：電機(jī)：Maxon DC Motor F2260 功率為 40W;行星輪減速箱：GP 62（11501）傳動比約為 19：1；編碼器：HEDS 55。3.3 本章小結(jié)這里主要是進(jìn)行了車體結(jié)構(gòu)設(shè)計：方案選擇；功率估計；電機(jī)選擇；校核。第四章 結(jié)論1、對該集裝箱波紋板三自由度焊接機(jī)器人進(jìn)行了方案設(shè)計，并對機(jī)構(gòu)進(jìn)行運動學(xué)逆解，證明該方案可行，能夠滿足集裝箱波紋板焊接的要求，能夠提高在直線段與在波內(nèi)斜邊段的焊縫成形的一致性，提高集裝箱的生產(chǎn)質(zhì)量。2、完成了車體結(jié)構(gòu)設(shè)計：車體結(jié)構(gòu)方案的比較與選擇；驅(qū)動電機(jī)功率的估計計算與選擇；齒輪齒條傳動的接觸疲勞強(qiáng)度與彎曲疲勞強(qiáng)度校核。還有擺動關(guān)節(jié)驅(qū)動電機(jī)的選擇。3、其它方面：車輪與選用導(dǎo)軌的匹配設(shè)計，關(guān)節(jié)間的聯(lián)接匹配設(shè)計。這些都是直接在圖紙上設(shè)計出來了。