《自動導(dǎo)引小車(AVG)的設(shè)計》由會員分享，可在線閱讀，更多相關(guān)《自動導(dǎo)引小車(AVG)的設(shè)計（39頁珍藏版）》請在裝配圖網(wǎng)上搜索。

1、IAGV 自動導(dǎo)引小車的設(shè)計摘 要AGV 即自動導(dǎo)引小車，它集聲、光、電、計算機技術(shù)于一體，綜合了當(dāng)今科技領(lǐng)域先進的理論和應(yīng)用技術(shù)。廣泛應(yīng)用在柔性制造系統(tǒng)和自動化工廠中，具有運輸效率高、節(jié)能、工作可靠、能實現(xiàn)柔性運輸?shù)仍S多優(yōu)點，極大的提高生產(chǎn)自動化程度和生產(chǎn)效率。本文在分析研究國內(nèi)外 AGV 現(xiàn)狀與發(fā)展的基礎(chǔ)上，設(shè)計了兩后輪獨立驅(qū)動的自動導(dǎo)引小車，其主要工作內(nèi)容包括：小車機械傳動設(shè)計、直流伺服電機的選擇、AT89C51 單片機控制系統(tǒng)硬件電路、運動學(xué)分析、控制系統(tǒng)軟件設(shè)計及圓弧插補程序。所設(shè)計的小車能夠?qū)崿F(xiàn)自主運行、運動軌跡（圓弧、直線）的控制等功能，達到了沿著設(shè)定的路線行駛。關(guān)鍵詞關(guān)鍵詞：自

2、動導(dǎo)引小車，單片機控制，設(shè)計，PWM 技術(shù)IIDesign on Automatic Guided VehicleAbstractThe AGV namely Automatic Guided Vehicle, it collect sound, the light, the electricity, the computer technology in a body, and synthesizes the technical domain advanced theory and the application technology. It widespread applied in the

3、 flexible manufacturing system and the factory automation, and has the merits of high transportation efficiency, the energy conservation, the work reliable, the flexible transportation. It enormously enhanced production automaticity and production efficiency.Based on the analysis of the domestic and

4、 foreign AGV present situation and its development foundation, AGV with two wheel independent drive is designed. The content of the paper includes: design of mechanical structure and drive of the car, the choice of direct current servo motor, the hardware electric circuit of AT89C51 control system,

5、the kinematic analysis, the software design of control system and the procedure of interpolation the circular arc. The designed car can realize the functions of independent movement, the path (circular arc, straight line) control and so on, and has achieved to travel along the hypothesis route.Keywo

6、rd: Automatic Guided Vehicle, singlechip computer control，Design , PWM目 錄摘 要.IA Abstractbstract.II第一章第一章 緒論緒論.11.11.1 AGVAGV 自動導(dǎo)引小車簡介自動導(dǎo)引小車簡介 .11.21.2 AGVAGV 自動導(dǎo)引小車的分類自動導(dǎo)引小車的分類 .11.31.3 國內(nèi)外研究現(xiàn)狀及發(fā)展趨勢國內(nèi)外研究現(xiàn)狀及發(fā)展趨勢 .1第二章第二章 機械部分設(shè)計機械部分設(shè)計.22.12.1 設(shè)計任務(wù)設(shè)計任務(wù) .22.22.2 確定機械傳動方案確定機械傳動方案 .22.32.3 直流伺服電動機的選擇直流伺服電

7、動機的選擇 .32.42.4 聯(lián)軸器的設(shè)計聯(lián)軸器的設(shè)計 .5第三章第三章 控制系統(tǒng)的設(shè)計控制系統(tǒng)的設(shè)計.193.13.1 控制系統(tǒng)總體方案控制系統(tǒng)總體方案.193.23.2 鑒向鑒向.193.33.3 計數(shù)的擴展計數(shù)的擴展.203.43.4 中斷的擴展中斷的擴展.213.53.5 數(shù)摸轉(zhuǎn)換器的選擇數(shù)摸轉(zhuǎn)換器的選擇.223.63.6 電機驅(qū)動芯片選擇電機驅(qū)動芯片選擇.233.73.7 運動學(xué)分析運動學(xué)分析.263.83.8 控制軟件的設(shè)計控制軟件的設(shè)計.27結(jié)論結(jié)論.32參考文獻（參考文獻（R Referenceseferences）.32致謝致謝.321第一章第一章 緒論緒論1.11.1 AG

8、VAGV 自動導(dǎo)引小車簡介自動導(dǎo)引小車簡介 AGV(Automatic Guided Vehicle),即自動導(dǎo)引車，是一種物料搬運設(shè)備，是能在一位置自動進行貨物的裝載，自動行走到另一位置，自動完成貨物的卸載的全自動運輸裝置。AGV 是以電池為動力源的一種自動操縱的工業(yè)車輛。裝卸搬運是物流的功能要素之一，在物流系統(tǒng)中發(fā)生的頻率很高，占據(jù)物流費用的重要部分。因此，運輸工具得到了很大的發(fā)展，其中 AGV 的使用場合最廣泛，發(fā)展十分迅速。1.21.2 AGVAGV 自動導(dǎo)引小車的分類自動導(dǎo)引小車的分類自動導(dǎo)引小車分為有軌和無軌兩種。所謂有軌是指有地面或空間的機械式導(dǎo)向軌道。地面有軌小車結(jié)構(gòu)牢固，承載

9、力大，造價低廉，技術(shù)成熟，可靠性好，定位精度高。地面有軌小車多采用直線或環(huán)線雙向運行，廣泛應(yīng)用于中小規(guī)模的箱體類工件 FMS 中。高架有軌小車（空間導(dǎo)軌）相對于地面有軌小車，車間利用率高，結(jié)構(gòu)緊湊，速度高，有利于把人和輸送裝置的活動范圍分開，安全性好，但承載力小。高架有軌小車較多地用于回轉(zhuǎn)體工件或刀具的輸送，以及有人工介人的工件安裝和產(chǎn)品裝配的輸送系統(tǒng)中。有軌小車由于需要機械式導(dǎo)軌，其系統(tǒng)的變更性、擴展性和靈活性不夠理想。無軌小車是一種利用微機控制的，能按照一定的程序自動沿規(guī)定的引導(dǎo)路徑行駛，并具有停車選擇裝置、安全保護裝置以及各種移載裝置的輸送小車。無軌小車按引導(dǎo)方式和控制方法的分為有徑引導(dǎo)

10、方式和無徑引導(dǎo)自主導(dǎo)向方式。有徑引導(dǎo)方式是指在地面上鋪設(shè)導(dǎo)線、磁帶或反光帶制定小車的路徑，小車通過電磁信號或光信號檢測出自己的所在位置，通過自動修正而保證沿指定路徑行駛。無徑引導(dǎo)自主導(dǎo)向方式中，地圖導(dǎo)向方式是在無軌小車的計算機中預(yù)存距離表（地圖） ，通過與測距法所得的方位信息比較，小車自動算出從某一參考點出發(fā)到目的點的行駛方向。這種引導(dǎo)方式非常靈活，但精度低。1.31.3 國內(nèi)外研究現(xiàn)狀及發(fā)展趨勢國內(nèi)外研究現(xiàn)狀及發(fā)展趨勢AGV 是伴隨著柔性加工系統(tǒng)、柔性裝配系統(tǒng)、計算機集成制造系統(tǒng)、自動化立體倉庫而產(chǎn)生并發(fā)展起來的。日本人認(rèn)為 1981 年是柔性加工系統(tǒng)元年，這樣計算 AGV 大規(guī)模應(yīng)用的歷史

11、也只有 15 至 20 年。但是，其發(fā)展速度是非?？斓?。1981 年美國通用公司開始使用AGV，1985 年 AGV 保有量 500 臺，1987 年 AGV 保有量 3000 臺。資料表明歐洲 40%的 AGV 用于汽車工業(yè)，日本 15%的 AGV 用于汽車工業(yè)，也就是說 AGV 在其他行業(yè)也有廣泛的應(yīng)用。 1目前國內(nèi)總體看 AGV 的應(yīng)用剛剛開始，相當(dāng)于國外 80 年代初的水平。但從應(yīng)用的行業(yè)分析，分布面非常廣闊，有汽車工業(yè)，飛機制造業(yè)，家用電器行業(yè)，煙草行業(yè)，機械加工，倉庫，郵電部門等。這說明 AGV 有一個潛在的廣闊市場。 1AGV 從技術(shù)的發(fā)展看，主要是從國家線路向可調(diào)整線路；從簡單

12、車載單元控制向復(fù)雜系統(tǒng)計算機控制；從原始的段點定期通訊到先進的實時通訊等方向發(fā)展；從落后的現(xiàn)場控制到先進的遠程圖形監(jiān)控；從領(lǐng)域的發(fā)展看，主要是從較為集中的機械制造、加工、裝配生產(chǎn)線向廣泛的各行業(yè)自動化生產(chǎn)，物料搬運，物品倉儲，商品配送等行業(yè)發(fā)展。2第二章第二章 機械部分設(shè)計機械部分設(shè)計2.12.1 設(shè)計任務(wù)設(shè)計任務(wù)設(shè)計一臺自動導(dǎo)引小車 AGV，可以在水平面上按照預(yù)先設(shè)定的軌跡行駛。本設(shè)計采用 AT89C51 單片機作為控制系統(tǒng)來控制小車的行駛，從而實現(xiàn)小車的左、右轉(zhuǎn)彎，直走，倒退，停止功能。其設(shè)計參數(shù)如下：自動導(dǎo)引小車的長度：500mm自動導(dǎo)引小車的寬度：300mm自動導(dǎo)引小車的行駛速度：10

13、0mm/s2.22.2 確定機械傳動方案確定機械傳動方案方案一：采用三輪布置結(jié)構(gòu)。直流伺服電動機經(jīng)過減速器和差速器，通過兩半軸將動力傳遞到兩后輪。自動導(dǎo)引小車的轉(zhuǎn)向由轉(zhuǎn)向機構(gòu)驅(qū)動前面的一個萬向輪轉(zhuǎn)向。傳動系統(tǒng)如圖 2-1 所示。圖 2-1 傳動方案一方案二：采用四輪布置結(jié)構(gòu)。自動導(dǎo)引小車采用兩后輪獨立驅(qū)動差速轉(zhuǎn)向，兩前輪為萬向輪的四輪結(jié)構(gòu)形式。直流伺服電動機經(jīng)過減速器后直接驅(qū)動后輪，當(dāng)兩輪運動速度不同時，就可以實現(xiàn)差速轉(zhuǎn)向。傳動系統(tǒng)如圖 2-2 所示。圖 2-2 傳動方案二四輪結(jié)構(gòu)與三輪結(jié)構(gòu)相比較有較大的負(fù)載能力和較好的平穩(wěn)性。方案一有差速器和轉(zhuǎn)向機構(gòu)，故機械傳動誤差大。方案二采用兩套蝸輪-蝸

14、桿減速器及直流伺服電動機，成本相對于方案一較高，但它的傳動誤差小，并且轉(zhuǎn)向靈活。因此，采用方案二作為本課題的設(shè)3計方案。2.32.3 直流伺服電動機的選擇直流伺服電動機的選擇伺服電動機的主要參數(shù)是功率(KW)。但是，選擇伺服電動機并不按功率，而是更根據(jù)下列三個指標(biāo)選擇。運動參數(shù)：AGV 行走的速度為 100mm/s，則車輪的轉(zhuǎn)速為 （2-1）d10001000 622.75min3.14 140vnr電機的轉(zhuǎn)速 選擇蝸輪-蝸桿的減速比 i=62 （2-2）62 22.751410.5minninr電自動導(dǎo)引小車的受力分析： OGPFBFCFAFDABCD圖 2-3 車輪受力簡圖小車車架自重為

15、P （2-32.85 100.5 0.3 0.032 9.8134PabhgN3）小車的載荷為 G （2-4）35 9.8343GmgN取坐標(biāo)系 OXYZ 如圖 2-3 所示，列出平衡方程由于兩前輪及兩后輪關(guān)于 Y 軸對稱，則 ，ABFFCDFF ， （2-5）0zF 220ACFFPG ， （2-6）0 xM 0.0750.172 0.30CGPF 解得 157.66ABFFN80.84CDFFN4兩驅(qū)動后輪的受力情況如圖 2-4 所示：滾動摩阻力偶矩的大小介于零與最大值之間，即fM （2-7）max0fMM （2-8）max0.006 157.660.946NMFN m其中 滾動摩阻系數(shù)，

16、查表 5-2，=210，取 =6mm 2牽引力 F 為 （2-9）max0.94613.50.072MFNd 電 機1/GW圖 2-4 后輪受力 圖 2-5 摩擦系數(shù) 牽引力 F N 重物的重力 W N滾子直徑 D mm 傳遞效率 傳動裝置減速比 1/G1） 求換算到電機軸上的負(fù)荷力矩（）LT （2-10）19.821000LFWDTG 13.50.15 157.6614019.80.726210000.587N m取=0.7, =157.66, =0.15WN2） 求換算到電機軸上的負(fù)荷慣性（）LJ （2-11）2121342LZJJJJJZ2210.00003490.0047660.000

17、131 0.0000604620.000036189kg m 其中 為車輪的轉(zhuǎn)動慣量；為蝸桿的轉(zhuǎn)動慣量；1J2J為蝸輪的轉(zhuǎn)動慣量；為蝸輪軸的轉(zhuǎn)動慣量。3J4J3） 電機的選定AOFSFNPF5根據(jù)額定轉(zhuǎn)矩和慣量匹配條件，選擇直流伺服電動機。電機型號及參數(shù)：MAXON F2260 60mm 石墨電刷 80W 21290MJgcm匹配條件為 32m ax361. 89LLJJgcm （2-12）max0.251LMJJ即 361.890.2510.250.28051慣量 （2-13）J21290361.891651.89MLJJJgcm其中為伺服電動機轉(zhuǎn)子慣量 MJ故電機滿足要求。4） 快移時的加

18、速性能最大空載加速轉(zhuǎn)矩發(fā)生在自動導(dǎo)引小車攜帶工件，從靜止以階躍指令加速到伺服電機最高轉(zhuǎn)速時。這個最大空載加速轉(zhuǎn)矩就是伺服電動機的最大輸出轉(zhuǎn)矩。maxnmaxT （2-14）maxmax22 3.14 40001651.890.916060 0.076anTJJN mt加速時間 （2-15）44 0.0190.076aMTTs其中 機械時間常數(shù)19MTms2.42.4 聯(lián)軸器的設(shè)計聯(lián)軸器的設(shè)計由于電動機軸直徑為 8mm，并且輸出軸削平了一部分與蝸桿軸聯(lián)接部分軸徑為12mm，故其結(jié)構(gòu)設(shè)計如圖 2-6 所示。電機軸蝸桿軸圖 2-6 聯(lián)軸器機構(gòu)圖聯(lián)軸器采用安全聯(lián)軸器，銷釘直徑 d 可按剪切強度計算，即

19、 46 （2-16） 8mKTdD Z銷釘材料選用 45 鋼。查表 5-2 優(yōu)質(zhì)碳素結(jié)構(gòu)鋼（GB 699-88） 545 調(diào)質(zhì) 200mm =637MPa =353MPa =17% =35% bss 硬度 217255HBS 20.39kMJ m 銷釘?shù)脑S用切應(yīng)力為 （2-17） 0.70.80.75 637477.75BMPa 過載限制系數(shù) k 值 查表 14-4 取 k=1.6 4 T=0.321Nm 8 1.6 5780.6463.14 12 1 477.75dmm 選用 d=5mm 滿足剪切強度要求。2.52.5 蝸桿傳動設(shè)計蝸桿傳動設(shè)計1.選擇蝸桿的傳動類型根據(jù) GB/T 10085

20、-1988 的推薦，采用漸開線蝸桿(ZI)。2.選擇材料蝸桿要求表面硬度和耐磨性較高，故材料選用 40Cr。蝸輪用灰鑄鐵 HT200 制造，采用金屬模鑄造。3.蝸桿傳動的受力分析確定作用在蝸輪上的轉(zhuǎn)矩 T2按 Z=1，估取效率=0.7,則 4 （2-6662221120.08 0.79.55 109.55 109.55 102350822.75PPTN mmnn i18）7圖 2-7 蝸輪-蝸桿受力分析各力的大小計算為 （2-19）112122 58765.2218taTFFNd （2-20）212222 23508606.6677.5atTFFNd （2-21）00122tan20606.6

21、6 tan20220.8rrtFFFN 4.按齒根彎曲疲勞強度進行設(shè)計根據(jù)開式蝸桿傳動的設(shè)計準(zhǔn)則，按齒根彎曲疲勞強度進行設(shè)計。蝸輪輪齒因彎曲強度不足而失效的情況，多數(shù)發(fā)生在蝸輪齒數(shù)較多或開式傳動中。彎曲疲勞強度條件設(shè)計的公式為 4 （2-22）221221.53FaFKTm dYYz確定載荷系數(shù) K 4由于工作載荷較穩(wěn)定，故取載荷分布不均系數(shù) K=1，由表 11-15選取使用系數(shù) 4KA=1.15。由于轉(zhuǎn)速不高，沖擊不大，可取動載系數(shù) KV=1.1,則 （2-23）1.15 1 1.11.265AVKKKK 由表 11-8得，蝸輪的基本許用彎曲應(yīng)力 434FMPa假設(shè) 31048，蝸輪的當(dāng)量齒

22、數(shù) 262z = （2-24）22336262.29coscos 310Vzz 48根據(jù)，從圖 11-19中可查得齒形系數(shù) 20 x 262.29Vz 422.3FaY螺旋角系數(shù) （2-25）310110.9773140 Y 48140 2311.53 1.265 235082.3 0.977334.3762 48m dmm由表 11-2得 4中心距 a=50mm 模數(shù) m=1.25mm 分度圓直徑 122.4dmm23135m dmm蝸桿頭數(shù) 直徑系數(shù) 17.92 分度圓導(dǎo)程角 =31138 11z 蝸輪齒數(shù) 變位系數(shù)262z 20.04x 5.蝸桿與蝸輪的主要參數(shù)與幾何尺寸81）蝸桿軸向齒

23、距 （2-26）3.14 1.253.925apmmm齒頂圓直徑 （2-27）*11222.42 1 1.2524.9addha mmm 齒根圓直徑 （2-28）*11222.421 1.250.25 1.2519.275fddha mcmm 蝸桿軸向齒厚 （2-29）113.14 1.251.962522asmmm2）蝸輪傳動比 （2-30）2162621ziz蝸輪分度圓直徑 （2-31）221.25 6277.5dmzmm蝸輪喉圓直徑 （2-*222277.52 1.251 0.0480.1addm haxmm 32）蝸輪齒根圓直徑 （2-*222277.52 1.251 0.040.25

24、74.475fddm haxcmm 33）蝸輪咽喉母圓半徑 （2-34）22115080.19.9522garadmm6.精度等級公差和表面粗糙度的確定考慮到所設(shè)計的自動導(dǎo)引小車屬于精密傳動，從 GB/T 10089-1988 圓柱蝸桿、蝸輪精度中選擇 6 級精度，側(cè)隙種類為7.熱平衡核算由于該蝸輪-蝸桿傳動是開式傳動，蝸輪-蝸桿產(chǎn)生的熱傳遞到空氣中，故無須熱平衡計算。2.62.6 軸的設(shè)計軸的設(shè)計2.6.1 前輪軸的設(shè)計前輪軸的設(shè)計前輪軸只承受彎矩而不承受扭矩，故屬于心軸。9 圖 2-8 前輪軸結(jié)構(gòu) 1.求作用在軸上的力自動導(dǎo)引小車的前輪受力，受力如圖 2-9a)所示。 CFF180.844

25、0.422CFFFN1=22.軸的結(jié)構(gòu)設(shè)計1）擬定軸上零件的裝配方案裝配方案是：左輪輻板、右輪輻板、螺母、套筒、滾動軸承、軸用彈性擋圈依次從軸的右端向左安裝，左端只安裝滾動軸承和軸用彈性擋圈。這樣就對各軸段的粗細(xì)順序作了初步安排。2）根據(jù)軸向定位的要求確定軸的各段直徑和長度(1)初步選擇滾動軸承。自動導(dǎo)引小車前輪軸只受彎矩的作用，主要承受徑向力而軸向力較小，故選用單列深溝球軸承。由軸承產(chǎn)品目錄中初步選取單列深溝球軸承 6004，其尺寸為 dDT=20mm42mm12mm,故。20dddmm右端滾動軸承采用軸肩進行軸向定位。由手冊上查得 6004 型軸承的定位軸肩高度h=2.5mm，因此取。25

26、dmm(2)取安裝左、右輪輻處的軸段的直徑;輪輻的左端采用軸肩定位，右端30dmm用螺母夾緊輪輻。已知輪輻的寬度為 34mm，為了使螺母端面可靠地壓緊左右輪輻，此軸段應(yīng)略短于輪輻的寬度，故取。左右輪輻的左段采用軸肩定位，軸肩高度32lmm，取 h=3mm，則軸環(huán)處的直徑。軸環(huán)寬度 b1.4h，取。0.07hd36Vdmm5Vlmm(3)軸用彈性擋圈為標(biāo)準(zhǔn)件。選用型號為 GB 894.1-86 20，其尺寸為,故020dmm, ,。19ddmm1.1llmm13 1.111.9lmm其余尺寸根據(jù)前輪軸上關(guān)于左右輪輻結(jié)合面基本對稱可任意確定尺寸，確定了軸上的各段直徑和長度如圖 2-8 所示。3）軸

27、上零件的周向定位左右輪輻與軸的周向定位采用平鍵聯(lián)接。按 d由手冊查得平鍵截面 bh=8mm7mm(GB/T 1095-1979),鍵槽用鍵槽銑刀加工，長為 28mm(標(biāo)準(zhǔn)鍵長見 GB/T 1096-1979),同時為了保證左右輪輻與軸配合有良好的對中性，故選擇左右輪輻與軸的配合為 H7/n6。滾動軸10承與軸的周向定位是借過度配合來保證的，此處選軸的直徑尺寸公差為 j7。 4）確定軸上圓角和倒角尺寸取軸端倒角為 145，各軸肩處的圓角半徑為 R1。3.求軸上的載荷首先根據(jù)軸的結(jié)構(gòu)圖作出軸的計算簡圖。根據(jù)軸的計算簡圖作出軸的彎矩圖。McFF1F2M圖 2-9 前輪軸的載荷分析圖 121180.8

28、440.4222FFFN1239LLmm 1140.42 391576.38CMFLN mm 4.按彎曲應(yīng)力校核軸的強度進行校核時，通常只校核軸上承受最大彎矩的截面強度。最大負(fù)彎矩在截面 C 上，。1576.38 CMN mm對截面 C 進行強度校核，由公式 4 （2-35）1caMW由表 15-1得，45 鋼 調(diào)質(zhì) 4160MPa由表 15-4得， 4 （2-36）223338 43043.14 302288.84322322 30bt dtdWmmd 11576.380.6892288.84caMPa因此該軸滿足強度要求，故安全。2.6.22.6.2 后輪軸的設(shè)計后輪軸的設(shè)計后輪軸在工作中

29、既承受彎矩又承受扭矩，故屬于轉(zhuǎn)軸。11 圖 2-10 后輪軸結(jié)構(gòu)1.求后輪軸上的功率、轉(zhuǎn)速和轉(zhuǎn)矩2P2n2T取蝸輪-蝸桿傳動的效率=0.7,則 （2-37）20.08 0.70.056PPKW 222.75minnnr223508TN mm2.作用在蝸輪上的力 21263.8tFN265.22aFN2460rFN3.初步確定軸的最小直徑先按式（15-2初步估算軸的最小直徑。選取軸的材料為 45 鋼，調(diào)質(zhì)處理。根據(jù)表 415-3，取=115，于是得 40A （2-38）233min020.05611515.522.75PdAmmn后輪軸的最小直徑是安裝輪輻處軸的直徑。由于輪輻與軸采用鍵聯(lián)結(jié)，故d

30、。26dmm4.軸的結(jié)構(gòu)設(shè)計1)擬定軸上零件的裝配方案裝配方案是：蝸輪、套筒、深溝球軸承、軸用彈性擋圈依次從軸的左端向右安裝；右端安裝深溝球軸承、透蓋、內(nèi)輪輻、軸端擋圈從右端向左安裝。2)根據(jù)軸向定位的要求確定軸的各段直徑和長度(1)初步選擇滾動軸承。因軸承同時受有徑向力和軸向力的作用，故選用單列深溝球軸承。單列深溝球軸承 6206，其尺寸為 dDT=30mm62mm16mm，故。30dddmm右端滾動軸承采用軸肩進行軸向定位。由手冊上查得 6206 型軸承的定位軸肩高度h=3mm,因此，取。36dmm12(2)軸用彈性擋圈為標(biāo)準(zhǔn)件。選用型號為 GB 894.1-86 30,其尺寸為，故030

31、dmm，。28.6dmm1.7Lmm(3)取安裝輪輻處的軸段的直徑。輪輻的寬度為 27mm,為了使軸端擋圈26dmm可靠地壓緊輪輻，此軸段應(yīng)略短于輪輻的寬度，故取。26lmm其余尺寸根據(jù)零件的結(jié)構(gòu)可任意選取。確定了軸上的各段直徑和長度如圖 2-10 所示。3)軸上零件的周向定位蝸輪與軸的周向定位采用平鍵聯(lián)接。按由手冊查得平鍵截面 bh=8mm7mm,鍵槽d長為 25mm。輪輻與軸的配合為 H8/h7。4)確定軸上圓角和倒角尺寸取軸端倒角為 145，各軸肩處的圓角半徑為 R1。5.求軸上的載荷后輪軸上的受力分析 2-11a)。L1=L2=27.5mm L3=41mm1)在水平面上后輪軸的受力簡圖

32、為 2-11b)。由靜力平衡方程求出支座 A、B 的支反力 122111263.8631.922NHNHtFFFN三個集中力作用的截面上的彎矩分別為11631.9 27.517377.25HDNHMFLN mm0HAHBMM13 圖 2-11 后輪軸的載荷分析圖 2)在垂直面上后輪軸的受力簡圖 2-11c)。由靜力平衡方程求出支座 A、B 的支反力 2265. 22N VaFFN （2-39）2Nm m65. 2277. 52527. 27522aaF DM ， (2-40)0AM212113220raN VFLMFLFLL122131122N VraFFLMFLLL146027. 52527

33、. 275157. 66227. 541227. 50. 726N ， (2-41)0yF1220N VN VrFFFF 122N VrN VFFFF 460157. 660. 762301. 578N在段中，將截面左邊外力向截面簡化，得AD (2-42) 111301. 578N VMFxx1x1027. 5x14在段中，同樣將截面左邊外力向截面簡化，得D B (2-43) 2122227. 5N VraM xFxF xM027. 52x 222301. 57827. 5301. 5784602527. 27510820. 67158. 422xxx在段中，同樣將截面右邊外力向截面簡化，得B

34、C (2-44) 333157. 66M xFxx3041x 0VAVCMM 301. 57827. 58293. 395VDMNm m 10820. 67158. 422010820. 67VDMNm m 157. 66416464. 06VBMNm m計算 A、B、C、D 截面的總彎矩 M 0ACMM2222117377. 258293. 39519254. 85DH DVDMMMN m m(2-45) (2-46)2222217377. 2510820. 6720470. 85DH DVDMMMNm m646406BVBMMNm m 后輪軸上的轉(zhuǎn)矩 223508TTNm m 6.按彎扭合

35、成應(yīng)力校核軸的強度 進行校核時，通常只校核軸上承受最大彎矩和扭矩的截面（即危險截面 D）的強度。 由式（15-5）得 4 (2-47)2222220470. 850. 62350810. 852288. 84DcaMTM PaW其中，為折合系數(shù)，取=0.6 為軸的抗彎截面系數(shù)，由表 15-4得W 4 22333843043. 14302288. 8432232230btdtdWm md 選定軸的材料為 45 鋼，調(diào)質(zhì)處理，由表 15-1查得 4160M Pa 15因此，故安全。1ca2.72.7 滾動軸承選擇計算滾動軸承選擇計算2.7.12.7.1 前輪軸上的軸承前輪軸上的軸承要求壽命，轉(zhuǎn)速，

36、軸承2500hLh100010001028. 96m i n3. 14110nrd的徑向力，軸向力。40. 42rFN0aF1 由上述條件試選軸承試選 6004 型軸承，查表 16-2 4 9. 38rCkN05. 02rCkNl i m15000m i nnr2 按額定動載荷計算由式 (2-48) 466010hnLCP對球軸承=3， (2-49)PraPrPfXFYFf F查表 13-6 自動導(dǎo)引小車 41. 2Pf代入得 1. 240. 4248. 504PN 366028. 96250048. 50479. 14938010CNN故 6004 型軸承能滿足要求。3 按額定靜載荷校核由式

37、 (2-50)00 0CS P查表 13-8，選取=2 40S (2-51)00040. 42rarPX FYFFN代入上式，滿足要求。00 05020240. 4280. 84CNS PN2.7.22.7.2 蝸桿軸上的軸承蝸桿軸上的軸承要求壽命，轉(zhuǎn)速，軸承的徑向載荷2500hLh1410. 5m i nnr，作用在軸上的軸向載荷。1110. 4rFN606. 66aFN1 由上述條件試選軸承選 30203 型軸承，查表 5-24 516 （脂潤滑） 19. 8CkN013. 2CkNl i m9000m i nnr0. 35e圖 2-12 蝸桿軸上的軸承受力2 按額定動載荷計算 (2-52

38、)112110. 432. 47221. 7rFSSNY 2132. 47606. 66639. 13aSFNS ，12639. 13aaFSFN2232. 47aFSNPraPfXFYF查表 15-12， 51. 2Pf， ， 11639. 135. 7890. 35110. 4arFeF0. 4X1. 7Y11. 20. 4110. 41. 7606. 661290. 58PN ， ， 2232. 470. 2940. 35110. 4arFeF1X0Y 22221. 2110. 4132. 48PraPrPfXFYFf FN由式 152 566010hnLCP10310103311666

39、0601410. 525001290. 5864331010hnLCPN101033226660601410. 52500132. 486601010hnLCPN均小于滿足要求。12CC19800CN3 按額定靜載荷校核由表 1510 500 0CS P17查表 15-14，取 501. 8S110115. 7890. 5221arFFY0101010. 5110. 41606. 66661. 86raPX FYFN 220110. 2940. 5221arFFY 022110. 4rPFN均小于，滿足要求。0102PP013200CN4 極限轉(zhuǎn)速校核由式 (2-53)m ax1 2l i m

40、nf f n，由圖 15-5得 11290. 580. 065219800PC 511f，由圖 15-6得 115. 789arFF 520. 5fm ax110. 590004500m i nnr，由圖 15-5得 2132. 480. 006719800PC 511f ，由圖 15-6得 220. 294arFF 521f m ax 21190009000m i nnr小于和滿足要求。nm ax1nm ax 2n2.7.32.7.3 后輪軸上的軸承后輪軸上的軸承要求軸承的壽命，轉(zhuǎn)速，軸承 A 的徑向載荷2500hLh22. 75m i nnr；軸承 B 的徑向載荷2222111631. 9

41、301. 578700rN HN VFFFN；軸向載荷為。2222222631. 90. 762631. 9rN HN VFFFN65. 22aFN由于軸承 A 承受的載荷大于軸承 B 的載荷，故只需對軸承 A 進行校核。1 由上述給定條件試選軸承18試選 6206 型軸承，查表 15-19 5 （脂潤滑）14. 91CkN010. 01CkNl i m9500m i nnr2 按額定動載荷計算由式 66010hnLCP對球軸承，3 PraPfXFYF由 查表 15-19 065. 220. 006510010aFC 50. 19,2. 3eY由 查表 15-19 65. 220. 0930.

42、 19700arFeF 5rPF 查表 15-12 自動導(dǎo)引小車 51. 2Pf代入得 1. 2700840PN 366022. 7525008401264. 651491010CNN故 6206 型軸承能滿足要求。3 按額定靜載荷校核由式 00 0CS P查表 15-14，選取 501S由 0. 093arFF查表 15-19，時， 50. 8arFF001,0XY得 0700rPFN代入上式，滿足要求。00 010010700CNS PN4 極限轉(zhuǎn)速校核 m ax1 2l i mnf f n由 查圖 15-5 8400. 056314910PC 511f19 查圖 15-6 65. 220

43、. 093700arFF 521f代入 m ax1195009500m i nnr 滿足要求。m ax22. 75m i nnrn第三章第三章 控制系統(tǒng)的設(shè)計控制系統(tǒng)的設(shè)計3.13.1 控制系統(tǒng)總體方案控制系統(tǒng)總體方案本系統(tǒng)使用 AT89C51 單片機作為核心的控制運算部分。連接在電機上的數(shù)字編碼器在電機運轉(zhuǎn)時發(fā)出的脈沖信號，經(jīng)過自行設(shè)計和制作的脈沖鑒向電路，可以得到電機的運轉(zhuǎn)方向；來自鑒向電路的正反方向的脈沖信號進入到兩塊 8253 計數(shù)器進行計數(shù)，以獲得電機的旋轉(zhuǎn)速度和位移；經(jīng)過在 AT89C51 單片機上運行的各種控制程序的適當(dāng)運算以后，輸出的控制量經(jīng)過兩塊 DAC1208 轉(zhuǎn)換器變成模

44、擬量，輸出到兩塊 UC3637 直流電動機脈寬調(diào)制器，通過 H 橋開關(guān)放大器，作為執(zhí)行機構(gòu)的速度或者力矩給定，從而控制電機的運轉(zhuǎn)，使整個 AGV 自動導(dǎo)引小車能夠完成所設(shè)計的控制任務(wù)。整個控制系統(tǒng)的組成框圖如下：20圖 3-1 控制系統(tǒng)的組成框圖3.23.2 鑒向鑒向伺服電機根據(jù)控制要求能夠工作在四個不同的象限，作為系統(tǒng)的狀態(tài)檢測部分，必須能夠檢測電機的轉(zhuǎn)速及分辨電機不同的旋轉(zhuǎn)方向。安裝在電機旋轉(zhuǎn)軸上的數(shù)字編碼器在電機運轉(zhuǎn)時能夠產(chǎn)生相位相差 90 度的兩路脈沖信號，電機的旋轉(zhuǎn)方向可以由鑒向電路對此兩路脈沖進行鑒向后獲得，其原理如圖 3-2 所示。V圖 3-2 鑒向原理伺服電機反轉(zhuǎn)時，A相脈沖超

45、前于B相脈沖90度，在cp十端輸出反向計數(shù)脈沖，當(dāng)正轉(zhuǎn)時，B相脈沖超前于A相脈沖90度，在cp一端輸出正向計數(shù)脈沖，見圖3-3中的(b)和(c所示，分辨出的脈沖進入脈沖計數(shù)電路進行計數(shù)，再由計算機讀入進行處理。其電路圖見圖3-3中的(a)所示。21圖 3-3 電機轉(zhuǎn)向分辨電路本次設(shè)計使用的數(shù)字編碼器為500P/ R ,即電機每旋轉(zhuǎn)一周輸出500個脈沖,電機到車輪的減速齒輪的減速比為62 : 1 ,因此車輪每前進或者后退一周產(chǎn)生50062 即31000個脈沖,可見分辯率非常高。編碼器的脈沖輸出為差動形式,鑒向電路接收差動形式的脈沖信號,鑒向后輸入到8253計數(shù)器。3.33.3 計數(shù)的擴展計數(shù)的擴

46、展為了得到驅(qū)動輪運轉(zhuǎn)的速度、位移等,而數(shù)字編碼器的輸出經(jīng)過鑒向電路提供的是電機的正轉(zhuǎn)和反轉(zhuǎn)脈沖,必須對這些脈沖分別進行計數(shù)、運算才能得到所要的速度、位移等狀態(tài)量。本系統(tǒng)中使用了兩塊8253計數(shù)器,每塊芯片具有三個16 位計數(shù)器。四個獨立的計數(shù)器即1# 、2 # 、3 # 和4 # 分別用于兩臺電機的正/ 反轉(zhuǎn)脈沖的計數(shù)。8253可編程定時器計數(shù)器可由軟件設(shè)定定時與計數(shù)功能，設(shè)定后與CPU并行工作，不占用CPU時間，功能強，使用靈活。它具有3個獨立的16位計數(shù)器通道，每個計數(shù)器都可以按照二進制或二十進制計數(shù)，每個計數(shù)器都有6種工作方式，計數(shù)頻率可高達2MHz，芯片所有的輸入輸出都與TTL兼容。8

47、253的內(nèi)部結(jié)構(gòu)框圖如圖3-4所示；引腳如圖3-5所示。圖3-4 8253內(nèi)部結(jié)構(gòu)框圖 圖3-5 8253引腳圖U6地址為：8000H計數(shù)器0 8001H計數(shù)器1 8002H計數(shù)器2 8003H控制字U7地址為：6000H計數(shù)器0 6001H計數(shù)器1 6002H計數(shù)器2 6003H控制字U6讀/寫控制邏輯接線：，；4CSY00QA11QAU7讀/寫控制邏輯接線：，。3CSY00QA11QA22U6芯片中計數(shù)器0和計數(shù)器1用于左輪電機正反轉(zhuǎn)計數(shù)，并處于工作方式3。U7芯片中計數(shù)器0和計數(shù)器1用于右輪電機正反轉(zhuǎn)計數(shù)，并處于工作方式3。在中斷服務(wù)程序中,這四個計數(shù)器分別對兩臺伺服電機的正/ 反脈沖進

48、行計數(shù),所得到的計數(shù)值減掉上一次的計數(shù)值,就可以得到在這一時間周期內(nèi)的各路脈沖數(shù)。右輪反轉(zhuǎn)、正轉(zhuǎn)和左論反轉(zhuǎn)、正轉(zhuǎn)的結(jié)果分別存于臨時變量temp 1、temp 2、temp 3 和temp 4 中,在主程序中通過對它們進行運算就可以得到移動機器人的狀態(tài)量了。3.43.4 中斷的擴展中斷的擴展AT89C51 單片機是使用兩個級聯(lián)的 8259A 中斷控制器來控制中斷的。主 8259A 芯片上的 IRQ2 擴展成從片上的 IRQ8IRQ15 使用。8259A 作為一種可編程中斷控制器，是一種集成芯片。它用來管理輸入到 CPU 的各種中斷申請，主要外圍設(shè)備，能提供中斷向量、屏蔽各種中斷輸入等功能。每一個

49、 8259A 芯片都能直接管理 8 級中斷，最多可以用 9 片 8259A 芯片級連，由其構(gòu)成級連機構(gòu)可以管理 64 級中斷。8259A的外部引腳：數(shù)據(jù)線，CPU通過數(shù)據(jù)線向8259A70DD發(fā)送各種控制命令和讀取各種狀態(tài)信息。INT：中斷請求，和CPU的INTR引腳相連，用來向CPU提出中斷請求。：中斷響應(yīng)，接收CPU的中斷響應(yīng)信號。INTA圖3-6 8259A引腳圖 ：讀信號，低電平有效，通知8259A將某RD個寄存器的內(nèi)容送到數(shù)據(jù)總線上。 ：寫信號，低電平有效，通知8259A從數(shù)據(jù)線上接受數(shù)據(jù)（即命令字）。WR：片選信號，低電平有效。CS：端口選擇，指出當(dāng)前哪個端口被訪問。0A：接收設(shè)備

50、的中斷請求。07IRIR：級聯(lián)端，指出具體的從片。在采用主從式級聯(lián)的多片8259A的系統(tǒng)中，20CASCAS主從片的對應(yīng)連接在一起。20CASCAS：主從片/緩沖器允許，雙功能引腳，雙向。它有兩個用處：當(dāng)作為輸入時，SP EN用來決定本片8259A是主片還是從片。作為輸出時，當(dāng)從8259A往CPU傳送數(shù)據(jù)時，由引出的信號作為總線啟動信號，以控制總線緩沖器的接收和發(fā)送。SP EN本次設(shè)計采用兩片8259A進行級聯(lián)：主片的引腳連接從片的中斷請求INT，如果某2I R一個引腳下面沒有連接從片，則可以直接連接外部中斷請求；而主片、從片的中斷響應(yīng)信號和數(shù)據(jù)信號互相連在一起。主片CAS和從片CAS互相連在

51、一起，當(dāng)從片數(shù)量I N TA07DD較多時，可以在主片CAS和從片CAS之間增加驅(qū)動器。主片的接高電平。從片的SP EN接低電平。在8259A的主從式級聯(lián)方式中，中斷的優(yōu)先級設(shè)置類似于單片機的情況。SP EN級聯(lián)如圖3-7所示。 23AT89C5174HC1388259AU0U8U5主從U48259A圖3-7 8259A的級聯(lián)3.53.5 數(shù)摸轉(zhuǎn)換器的選擇數(shù)摸轉(zhuǎn)換器的選擇 將數(shù)字量轉(zhuǎn)換為模擬量的器件稱為數(shù)/模轉(zhuǎn)換器(digital-analog converter),簡稱為DAC。數(shù)/模轉(zhuǎn)換器的主要技術(shù)指標(biāo)有分辨率、轉(zhuǎn)換精度、線性誤差和建立時間。分辨率 指最小輸出電壓與最大輸出電壓之比。本次設(shè)

52、計采用DAC1208芯片，故其分辨率為。41212. 4421021轉(zhuǎn)換精度 以最大的靜態(tài)轉(zhuǎn)換誤差的形式給出。DAC1208芯片為12位數(shù)/模轉(zhuǎn)換器其最大誤差為:,精度為。112 11100. 001222 222nnFSFSAV0. 01線性度 指 DAC 的實際轉(zhuǎn)換特性曲線和理想直線之間的最大偏移差。 建立時間 在數(shù)字輸入端發(fā)生滿量程碼的變化以后，數(shù)/模轉(zhuǎn)換器的模擬輸出穩(wěn)定到最終值1/2LSB時所需要的時間，當(dāng)輸出的模擬量為電流時，這個時間很短。DAC1208的內(nèi)部結(jié)構(gòu)及引腳如圖3-8和圖3-9所示。 圖3-8 DAC1208的內(nèi)部結(jié)構(gòu)圖 圖3-9 DAC1208的引腳圖CSWR1AGND

53、DI9DI8DI2DI3DI4DI5DI6DI7VREFRfbDGNDVccBYTE1/BYTE2WR2XFERIout2Iout1DAC1208110987654322014151617181913121124232221(LSB)DI0DI1DI11(MSB)DI1024DAC1208內(nèi)部對輸入數(shù)據(jù)具有兩級緩存：8位輸入寄存器、4位輸入寄存器和12位DAC寄存器，這三個寄存器可以分別選通。DAC1208有三種工作方式：單緩沖方式、雙緩沖方式、直通方式。所謂的單緩沖方式就是使DAC1208的兩個輸入寄存器中有一個處于直通方式，而另一個處于受控的鎖存方式。在實際應(yīng)用中，如果只有一路模擬量輸出。

54、所謂雙緩沖方式，就是把DAC1208的兩個鎖存器都接成受控鎖存方式。本次設(shè)計采用雙緩沖方式，目的是為了讓兩個直流伺服電機能夠?qū)崿F(xiàn)同步。所謂直通方式，輸入寄存器和DAC寄存器都接成直通方式，即信號均有效，數(shù)據(jù)被直接送入數(shù)/模轉(zhuǎn)換電路進行數(shù)/模轉(zhuǎn)換。12I LEW R W RXFERCS+5V+5VOAOAAT89C5174LS37327646264DAC120874HC138U0U1U2U3U9U8U10DAC1208圖3-10 DAC1208雙緩沖連接方式U9輸入寄存器地址為3FFFH DAC寄存器地址為5FFFHU10輸入寄存器地址為1FFFH DAC寄存器地址為5FFFH本次設(shè)計采用DAC

55、1208芯片的數(shù)/模轉(zhuǎn)換器其連接方式如圖3-10所示。為BYTE BYTE高電平時，選中數(shù)據(jù)輸入到8位輸入寄存器；當(dāng)為低電平時，選114D ID IBYTE BYTE中數(shù)據(jù)輸入到4位輸入寄存器；片選信號，低電平有效，和輸入鎖存信號30D ID IC S一起決定第一級數(shù)據(jù)鎖存是否有效。第一級允許鎖存，高電平有效。寫1I LE W RI LE1W R信號1，作為第一級鎖存信號，必須和同時有效。寫信號2，作為第二級鎖存C SI LE2W R信號，必須和同時有效?？刂菩盘?，低電平有效，和一起決定第二級數(shù)XFERXFER2W R據(jù)鎖存是否有效。模擬電流輸出端，DAC寄存器全1時最大，全0時為0。模擬電1

56、O U TI2O U TI流輸出端，和有一個常數(shù)差：常數(shù)，此常數(shù)對應(yīng)一個固定基準(zhǔn)電壓的1O U TI12O U TO U TII滿量程電流。參考電壓輸入端，可正可負(fù)，。R EFV1010V 3.63.6 電機驅(qū)動芯片選擇電機驅(qū)動芯片選擇電機驅(qū)動采用PWM技術(shù)來驅(qū)動直流伺服電動機。PWM技術(shù)為脈寬調(diào)制技術(shù)其可通過輸入直流電壓，在其輸出可以得到頻率固定、脈沖幅度一定、脈沖寬度與輸入信號成線i nu性關(guān)系的方波脈沖串，利用該方波脈沖串驅(qū)動功率放大電路，從而控制伺服電機的轉(zhuǎn)速。25采用PWM技術(shù)的優(yōu)點是，PWM具有較高的切換頻率，這有助于克服伺服電機的靜摩擦力矩，與其線性功率放大器相比，功耗低且效率高

57、，因而在伺服系統(tǒng)中得到了廣泛的應(yīng)運用。為了改善伺服電機的運行特性，必須適當(dāng)選擇PWM的切換頻率，其選擇可參考以下原則：a)切換頻率應(yīng)能使電機軸產(chǎn)生微振，以克服靜摩擦，改善運行特性。即 (3-1)TMff其中，為力矩常數(shù)，為PWM電源電壓，為電感，為電機靜摩擦4MCfkULTkCULT力矩。b)微振的最大角位移應(yīng)小于設(shè)定的位置誤差。即 (3-3)3192CTkUfLJ其中J為轉(zhuǎn)動慣量，為設(shè)定的位置誤差。c)盡量減少電機產(chǎn)生的高頻功耗。即應(yīng)使得 (3-4)2ATRfL其中為電內(nèi)阻。AR一般伺服電機的電感很小，如果切換頻率不高，導(dǎo)致交流分量很大，很容易損壞功率晶體管。在此采用PWM芯片UC3637和

58、H功率橋放大電路來驅(qū)動伺服電機，其UC3637原理如圖3-11所示，根據(jù)上述原則選擇切換頻率為30KHz。UC3637的特點：單電源或雙電源工作，2.520 V雙路PWM信號輸出，驅(qū)動電流能力為100mA限流保護欠電壓封鎖有溫度補償，2.5V閥值的關(guān)機控制圖3-11 UC3637原理框圖 26UC3637的結(jié)構(gòu)與功能：三角波發(fā)生器：CP，CN，S1，SR1；PWM比較器：CA，CB；輸出控制門：NA，NB；限流電路：CL，SRA，SRB；誤差放大器：EA；關(guān)機比較器：CS；欠電壓封鎖電路：UVL。UC3637最具特色的是三角波振蕩器，三角波產(chǎn)生電路如圖3-12所示。圖3-12 恒幅三角波產(chǎn)生電

59、路 三角波參數(shù)的計算取PWM定時電路充電電流為0.5Ma,則有 (3-5)0.0005STHTVVR 6 (3-6)0.00054TTTHCf V 6其中，為PWM頻率。由允許電機最大電流決定。Tfmax3.21IASR (3-7)max0.2SRI對于圖3-12所示的控制系統(tǒng)，要求：24SVV max10cVV 10INRkPWM 頻率30fkHz限流max8IA27B2v1vxoyPAQL取 1a 計算得 (3-8)43max1212 1024 216.5511024 21INScSR VaRkVVa (3-9)434322 1016.55 103.45INRRRk (3-10)34424

60、 3.45 103.76822 10SRINV RVVR3.768THVV (3-11)3233.76822 16.55 106.16243.768THSTHVRRkVV243.76855.5360.00050.0005STHTVVRk1316.55RRk930.00050.00051.11 1044 30 103.768TTTHCFf V式中：為三角波峰值的轉(zhuǎn)折（閾值）電壓；為電源電壓；為定時電阻；為定THVSVTRTC時電容；為恒流充電電流；為振蕩頻率。C3637具有一個高速、帶寬為kHz、輸出低SIf阻抗的誤差放大器，既可以作為一般的快速運放，亦可作為反饋補償運放。3.73.7 運動學(xué)分

61、析運動學(xué)分析3.7.13.7.1 運動學(xué)方程運動學(xué)方程AGV 自動導(dǎo)引小車的速度分析。已知車輪驅(qū)動速度，求機構(gòu)本體移動速度和旋轉(zhuǎn)角速度。兩后輪分別驅(qū)動四輪機構(gòu)的速度分析（Q 為瞬心，P 為后輪中心） (3-12)122pvvv (3-13)12coscos2pvvxv （3-12si nsi n2pvvyv14）(3-15) 121v BAvv121vvvAB (3-16) 圖 3-13 AGV 自動導(dǎo)引小車示意圖整理成矩陣形式： 28 (3-17)2121112sin2sin2cos2cosvvJvvBByx為雅可比矩陣。J3.7.23.7.2 轉(zhuǎn)彎半徑轉(zhuǎn)彎半徑小車在轉(zhuǎn)彎時以速度勻速轉(zhuǎn)彎；小

62、車兩主動輪之間的距離為 B；小車兩主動輪中心（假設(shè)小車質(zhì)量分布均勻）與轉(zhuǎn)彎圓心的距離即轉(zhuǎn)彎半徑為 R；車輪半徑為 r；兩輪的速度分別為；小車與行駛路面的摩擦系數(shù)為。則有12 (3-18)2Rg 1 查表 5-2 取 210000 60708. 649. 8Rm m 24m m故取小車轉(zhuǎn)彎的最小半徑為。710Rm m左、右輪的速度為 1 (3-19)2222rRBA 22271026010000 600. 4486443. 1470710RBm msrR (3-20)1222rRBA 12271026010000 600. 3097443. 1470710RBm msrA3.8 控制軟件的設(shè)計控

63、制軟件的設(shè)計根據(jù)機器人的線速度和角速度的表達式(3-12) 和(3-16) ,可以計算狀態(tài)量x、y 和: （3-21）122q （3-22）21B (3-23)0012trlrdtb （3-24）00cos2trlxxrdt (3-25)00sin2trlyyrdt采用數(shù)值積分方法進行近似檢測: 將區(qū)間劃分成若干充分小的子區(qū)間， 0t10t則只要子區(qū)間相對于移動機器人的運動速度選擇得充分小,121,nntttt1iitt或者控制周期比較短,則檢測精度可以達到使用的要求。表達式如下: (3-26)1112nntnnrltrdtb （3-27）111cos2nntnnnrltxxrdt29 (3-

64、28)111sin2nntnnnrltyyrdt另外,考慮到系統(tǒng)的各個狀態(tài)量都是通過數(shù)字編碼器輸出的脈沖信號進行檢測的,要將脈沖信號轉(zhuǎn)換為機器人移動的距離及轉(zhuǎn)過的角度,必須對脈沖信號進行定標(biāo),即確定每個脈沖與驅(qū)動輪移動的距離的系數(shù)。已知驅(qū)動輪的半徑r = 70mm ,電機到車輪的減速齒輪的變比為62 : 1 ,電機每旋轉(zhuǎn)一周發(fā)出500個脈沖,從而可以得到脈沖當(dāng)量應(yīng)為2 * PI * 70/(500 * 62) ,即0.01418mm/ P 。對于控制系統(tǒng)的軟件編程語言，要根據(jù)系統(tǒng)的要求進行選擇，一般要求代碼簡捷，執(zhí)行效率高，實時性好。AGV自動導(dǎo)引小車的引導(dǎo)原理是根據(jù)自動導(dǎo)引小車行走的軌跡進行

65、編程，數(shù)字編碼器檢測出的電壓信號判斷其與預(yù)先編程的軌跡的位置偏差，控制器根據(jù)位置偏差調(diào)整電機轉(zhuǎn)速對偏差進行糾正，從而使自動導(dǎo)引小車沿預(yù)先編程的軌跡行走。因此AGV自動導(dǎo)引小車行走過程中，需不斷地根據(jù)輸入的位置偏差信號調(diào)整電機轉(zhuǎn)速，對系統(tǒng)進行實時控制。為對AGV自動導(dǎo)引小車實施控制，需要對硬件進行操作。整個AGV自動導(dǎo)引小車的控制流程如圖3-14所示。開始函數(shù)、變量、中斷初始化讀取預(yù)設(shè)路徑坐標(biāo)路徑規(guī)劃及軌跡插補讀取上次運行誤差序列AGV平滑啟動環(huán)節(jié)軌跡檢測到第一段軌 跡終點嗎？第二段軌跡控制環(huán)節(jié)到終點了嗎？存儲本次軌跡控制誤差序列偏差自動校正D/A輸出結(jié)束YNYN第i段軌跡控制環(huán)節(jié)ND/A輸出偏

66、差自動校正Y到第i段軌 跡終點嗎？圖3-14 控制系統(tǒng)程序結(jié)構(gòu)圖30程序開始：先設(shè)置函數(shù)和變量，并對各芯片進行初始化；讀取預(yù)先設(shè)置軌跡的坐標(biāo)；對軌跡進行插補；讀取上次的誤差，自動導(dǎo)引小車啟動；進行軌跡的檢測；判斷第一段路徑走完沒有；NO則把檢測的實際軌跡和預(yù)先設(shè)置的軌跡相比較產(chǎn)生偏差，接著把偏差送給D/A轉(zhuǎn)換器，從而控制自動導(dǎo)引小車沿預(yù)先設(shè)定的軌跡行走。YES則走下一段軌跡，接著判斷是否到達終點，到達終點結(jié)束；沒到達終點則繼續(xù)走下一段軌跡。下面為圓弧插補程序，流程圖如圖3-15。DDA圓弧插補程序：XP BIT 00H ；X向益出標(biāo)志YP BIT 01H ；Y向益出標(biāo)志XS EQU 60H ；起點坐標(biāo)XYS EQU 61H ；起點坐標(biāo)YXE EQU 62H ；終點坐標(biāo)XYE EQU 63H ；終點坐標(biāo)YJVX EQU 64H ；X積分累加器JVY EQU 65H ；Y積分累加器JRX EQU 66H ；X被積函數(shù)寄存器JRY EQU 67H ；Y被積函數(shù)寄存器JEX EQU 68H ；X向終點計數(shù)器JEY EQU 69H ；Y向終點計數(shù)器ORG 1000HMOV JVX，YS ；初始化