西安交通大學agv設計自動循跡代步輪椅設計使用說明

1、I動循跡代步輪椅也逞曾匚L - I£機自16班 機械部分 王劍虹2110101145 電路部分 侶昶 2110302019軟件部分 羅運運211010114112目錄1、概述1.1總體概述1.2市場背景1.3適用人群2、機械部分2.1設計要求2.2具體機構設計和標準件選擇2.2.1車架設計2.2.1.1前車架設計2.2.1.2后車架設計2.2.2電機選擇2.2.3后輪選擇2.2.4前輪選擇2.3可靠性分析3、控制電路部分9.3.1主芯片選擇3.2位置檢查模塊12.3.3電機驅動模塊選擇1.34 .系統(tǒng)軟件的設計1.84.1應用軟件的設計.18.4.2軟件測試1.&4.3電機選

2、擇2Q.4.4輪椅轉向系統(tǒng)的設計264.5具體程序代碼28.參考文獻37.1、概述1.1總體概述自動循跡代步輪椅是一款輔助老人、殘疾人士出行的自動循跡電動輪椅。其整體外觀如 圖1.1所示。其設計思想是使用光電循跡原理，結合軟件編程，機械控制等方法，達到自動 循跡的效果。此產(chǎn)品設計過程中綜合了機電一體化設計思想，將機械和電子有機結合起來,用電子輔助機械，使在功能不變的前提下結構盡量簡單，運作可靠。產(chǎn)品的設計從用戶角度出發(fā)，將產(chǎn)品設計得人性化。材結構，保證強度的前提下,本產(chǎn)品使用電瓶作為動力，能源清潔，獲取方便。車架選用鋼 使結構緊湊可靠。輪胎使用實心橡膠輪胎，減震性能良好，避免用戶充氣的麻煩。1

3、*圖1.1自動循跡輪椅整體外觀1.2背景市場隨著能源短缺和環(huán)保需要，電動車所占的比重越來越大。 相對傳統(tǒng)機車，電動車擁有結1.2。構簡單，能源清潔，重量輕，運行可靠，維修方便，價格低廉等優(yōu)點。設計過程中采用了機電一體化設計思路，使機械與電子部分充分結合起來，機電一體化設計模式見圖圖1.2機電一體化設計模式簡介近幾年，電動輪椅也逐步發(fā)展起來，并且逐年改進，功能越來越完善?？梢娫陔妱虞喴问菇Y構簡單，運這個方向是很有市場前景的。 本產(chǎn)品在結構上對普通電動輪椅進行了優(yōu)化,行可靠。在功能上加入了自動循跡功能，主要使用對象是不能自主活動的老人，病人和殘疾 人。對比老式電動輪椅，本產(chǎn)品主要有以下優(yōu)點:1 ）

4、、結構更加輕便、可靠;2）、設計過程中采用了機電一體化設計思想，用電子控制機械，使功能更加齊全，結構簡單;3）、加入了自動循跡功能，特別適合用于醫(yī)院，療養(yǎng)院，養(yǎng)老院使用;4 ）、電機，電瓶等部件使用標準件，維修方便，價格低廉;1.3適用人群本產(chǎn)品主打功能是自動循跡功能，即不需要外部人員和乘坐者的操作便可以循著事先規(guī) 劃好的路線前進，到達標準位置停下，返回等過程。適合用于醫(yī)院，療養(yǎng)院，養(yǎng)老院使用。而在使用本產(chǎn)品后， 一名護士未至于本產(chǎn)品時，一個護士或者工作人員只能照看一個病人,可以同時照看多名病人。 每位病人的輪椅按著事先安排好的路線前進，在病人運輸，休閑散 步等方面有著極大優(yōu)勢。相信本產(chǎn)品能為

5、這些事業(yè)帶來極大的方便。2、機械設計部分2.1設計要求本產(chǎn)品要實現(xiàn)的功能主要有1 ）、能載人正常行走，遇到緊急情況能安全停車;2 ）、給老人、病人、殘疾人使用，要求避震效果好;3 ）、能實現(xiàn)自動循跡功能;4 ）、結構合理，安全可靠;因此具體的設計要求如下:1 ）、能載重80kg以上，主要受力機構應力不超過需用值，保證一定的安全系數(shù)，變形 不查過許用值;2 ）、通過對測得電路的分析，機械部分接受到電路部分的控制后能正確實現(xiàn)前進，后 退，轉彎，停車等功能;3 ）、有良好避震功能;4 ）、為方便攜帶和搬運，重量不超過70kg ；22具體機構設計和標準件選擇2.2.1車架設計為達到良好的避震效果， 車

6、架分為前后兩個部分， 前后兩車架使用螺栓和減震機構進行連接。連接情況如圖1.3所示。<r/ a圖1.3車架總體結構2.2.1.1前車架設計材料為前車架的主要結構如圖1.4所示。前車架設計中重要使用了標準的方鋼和圓管,低碳鋼，通過焊接的方式進行連接。為保證強度和足夠空間，前車架采用雙層結構設計。車架前方伸出圓管為連接腳踏板用。前車架通過螺栓與后車架和減震機構連接。側邊的圓環(huán)是連接扶手和前車輪用。圖1.4前車架結構展示2.2.1.2后車架設計后車架主要使用標準圓管焊接而成，主要結構如圖1.5所示。前方通過螺栓與前車架連接，中間圓鋼與電機連接， 圓鋼上焊接的方塊用于電機的定位。中間中空的部位用

7、于放置電瓶，為保證足夠運行時間和路程，預留了較大空間來存放大容量的電瓶。后方伸出的部分用 于安裝防傾倒的后輪。圖1.5后車架結構示意圖12v電壓。電機和減速2.2.2電機選擇計算電機所需轉速和扭矩，考慮減速器減速比，選擇直流電機, 器外觀如圖1.6所示。0尸,圖1.6電機及減速器外形展示2.2.3后輪選擇考慮到電機轉速和扭矩，所需的運行速度為10km/h，有良好的減震性能。選擇14寸實心橡膠輪作為驅動后輪。外形如圖1.7所示。輪轂為鋁合金材質，輪胎為實心橡膠。后輪為驅動輪，通過兩個后輪的轉速差來實現(xiàn)轉向。選用實心橡膠輪胎在保證良好避震性能的前提下避免了用戶充氣的麻煩。圖1.7后輪外形圖2.2.

8、4前輪選擇前輪選擇8寸萬向輪，材質為塑料和橡膠。在后輪的驅動下，前輪隨著轉向。外形如圖1.8所示。2.3可行性分析取前車架和后車架主要部件進行受理分析，受力分析報告見附錄。滿足強度要求。3.控制電路的設計控制電路作為控制程序的載體，主要分為主控芯片、位置檢測模塊和電機驅動模塊。3.1主控芯片的選擇經(jīng)小組討論，我們決定采用技術成熟且被廣泛使用的80C51單片機。80C51單片機屬于MCS-51系列單片機，由In tel公司開發(fā)，其結構是8048的延伸，改進了 8048的缺點,增加了如乘（MUL ）、除（DIV ）、減（SUBB ）、比較（CMP ）、16位數(shù)據(jù)指針、布爾代數(shù) 運算等指令，以及串行

9、通信能力和 5個中斷源。采用40引腳雙列直插式 DIP（ Dual In LinePackage），內有128個RAM 單元及4K的ROM。80C51有兩個16位定時計數(shù)器，兩個外中斷，兩個定時計數(shù)中斷，及一個串行中斷，并有4個8位并行輸入口。 80C51內部有時鐘電路，但需要石英晶體和微調電容外接。由于80C51的系統(tǒng)性能滿足系統(tǒng)數(shù)據(jù)采集及以下時間精度的要求，而且產(chǎn)品產(chǎn)量豐富來源廣，應用也很成熟，故采用來作為控制核心。對其管腳進行簡單的介紹。Vss（20腳）:接地Vcc （40腳）：主電源+5VXTAL1 （19 腳）用外部時鐘時，對于為驅動端。XTAL2 （ 18 腳）Tif>i.a

10、|TT2£XiPkl7PtM巨P1.5TPl iyP"叵 ”眶 p«-y ftST叵"C-Fa.lpii'PTlaj 徑7g-TP3-3p5TCVPH 叵71'P3 5Q對即戸K5ZJ_2 匹 >LM空C-JMi'k-_IIM=FWXMWs回VccFC l AOaPCi 問PC !.-AWFC d 'TOPC_m心FC日心PC Ti'Wl?PZ TfAliPZ.Sf'AliPZJ'AUFi 3' ArP22'A1O<P2.yfi£圖3.1 80C51管腳圖:接外

11、部晶體的一端。在片內它是振蕩電路反相放大器的輸入端。在采HMOS單片機，該端引腳必須接地；對于 CHMOS單片機，此引腳作:接外部晶體的另一端。在片內它是一個振蕩電路反相放大器的輸出端，振蕩電路的頻率是晶體振蕩頻率。若需采用外部時鐘電路，對于HMOS單片機，該引腳輸入外部時鐘脈沖；對于 CHMOS單片機，此引腳應懸浮。24RST （9腳）：單片機剛接上電源時，其內部各寄存器處于隨機狀態(tài)，在該腳輸入個時鐘周期寬度以上的高電平將使單片機復位（RESET）PSEN （29腳）：在訪問片外程序存儲器時，此端輸出負脈沖作為存儲器讀選通信號。CPU在向片外存儲器取指令期間，PSEN信號在12個時鐘周期中兩

12、次生效。不過，在訪問片外數(shù)據(jù)存儲器時，這兩次有效PSEN信號不出現(xiàn)。PSEN端同樣可驅動8個LSTTL負載。我們根據(jù)PSEN、ALE和XTAL2輸出端是否有信號輸出，可以判別80C51是否在工作。ALE/PROG （ 30腳）：在訪問片外程序存儲器時，此端輸出負脈沖作為存儲器讀選通信號。CPU在向片外存儲器取指令期間，PSEN信號在12個時鐘周期中兩次生效。不過，在訪問片外數(shù)據(jù)存儲器時，這兩次有效PSEN信號不出現(xiàn)。PSEN端同樣可驅動8個LSTTL負載。我們根據(jù) PSEN、ALE和XTAL2輸出端是否有信號輸出，可以判別80C51是否在工作。EA/VPP （31腳）：當EA端輸入高電平時，C

13、PU從片內程序存儲器地址 0000H單元開始執(zhí)行程序。當?shù)刂烦?KB時，將自動執(zhí)行片外程序存儲器的程序。當EA輸入低電平時，CPU僅訪問片外程序存儲器。在對87C51EPROM 編程時，此引腳用于施加編程電 壓 VPP。輸入/輸出引腳:(1)P0.0 -P0.7 (39 腳一32 腳)(2)P 1.0 -P 1.7（1腳一8腳）(3)P2.0 -P2.7（26 腳一21 腳）(4)P3.0 -P 3.7（10 腳一17 腳）X1 I_CRYSTAL191829303TU1XTAL1XTAL2RSTP SEN ALE EAP0.0/AD0 P0.1/AD1P0.2/AD2P0.3/AD3P0.

14、4/AD4P0.5/AD5P0.6/AD6P0.7/AD7P2.0/A8P2.1/A9P 2.2/A10P 2.3/A11P 2.4/A12P 2.5/A13P 2.6/A14P 2.7/A15GND38SEN2/37SEN3/39 sent /36 5 34 r 32_2122 23 24F262728L IN22匕IN33.IN44L ENA5L ENB6Z8111 11 111P 3.0/RXDP 3.1/TXDP 3.2/INT0P3.3/lNTrP 3.4/T0P3.5/T1 P3.6/WR P 3.7/RD10T4話26T780C51圖3.2主控芯片外圍電路主控芯片選擇完畢后， 還

15、需對其外接電路進行設計。 外接電路要與電機控制模塊和位置檢測模塊相適應，同時一些基本的電路如晶振的接法和頻率的選擇,則參照有關資料進行連接。下面結合實際電路來介紹一下。每個單片機系統(tǒng)里都有晶振，全稱是叫晶體震蕩器，在單片機系統(tǒng)里晶振的作用非常大,他結合單片機內部的電路， 產(chǎn)生單片機所必須的時鐘頻率，單片機的一切指令的執(zhí)行都是建立在這個基礎上的，晶振的提供的時鐘頻率越高，那單片機的運行速度也就越快。其實晶振用一種能把電能和機械能相互轉化的晶體在共振的狀態(tài)下工作,以提供穩(wěn)定，精確的單頻振蕩。在通常工作條件下， 普通的晶振頻率絕對精度可達百萬分之五十。高級的精度更高。有些晶振還可以由外加電壓在一定范

16、圍內調整頻率，稱為壓控振蕩器（VCO ）。晶振的作用是為系統(tǒng)提供基本的時鐘信號。通常一個系統(tǒng)共用一個晶振，便于各部分保持同步。 有些通訊系統(tǒng)的基頻和射頻使用不同的晶振，而通過電子調整頻率的方法保持同步如上圖所示，給單片機加上晶振X1，查閱單片機資料。將其頻率調到22MHz 。RC復位電路的工作原理是，上電前電容里的電荷放光，上電瞬間，電源通過電阻向電容充電，在充電過程中，RESET的電壓慢慢上升，對外部電路進行復位，當RESET上升到復位高電平時，外部系統(tǒng)開始工作。 這里存在兩個問題， 一個是必須合理選擇電阻和電容的值否則復位時間過長或過短都不能滿足要求，第二個問題是當系統(tǒng)正常復位后在工作狀態(tài)

17、下,電源突然有一個較短時間的大幅度抖動。因此設計復位電路主要考慮這兩個問題來選取 電阻電容值。P1.0 P 1.5與L298N 使能端和輸入端相連，P0.0 P0.2因為有AD轉化功能,所以用來與光電檢測器相連，接受位置信號。2.2位置檢測模塊位置檢測采用反射式光電傳感器。其原理如下:圖3.3 TCRT5000及其信號放大電路光電傳感器由兩部分組成，一個發(fā)光二極管和一個光敏二極管。 給發(fā)光二極管通電, 使其發(fā)光。若檢測到黑線，則發(fā)出的光被黑線吸收，光敏二極管接收不到反射回來的光,OUT端輸出則為低電平。反之則為高電平。我們通過市場調研，了解到 TCRT5000比較常用，且性能可以滿足需求，所以

18、決定采用TCRT5000作為位置檢測傳感器。以下為它的基本參數(shù):光學-反射式-模擬輸出檢測距離：0.591" (15mm)檢測方法：反射電壓-集電極發(fā)射極擊穿(最大)：70V電流-集電極(Ic)(最大):100mA電流-DC 正向(If): 60mA輸出類型：光電晶體管工作溫度：-25 °C85 °C考慮到控制系統(tǒng)和整體性能，我們決定采用三個TCRT5000檢測位置。有關TCRT5000個數(shù)選擇，在控制算法設計中進行具體介紹。2.3電機驅動模塊的選擇經(jīng)討論，我們決定選擇 L298N芯片對兩個直流電機進行驅動。L298N電機驅動模塊具有以下特點：1.可實現(xiàn)電機正反轉

19、及調速;2.啟動性能好，啟動轉矩答;3.工作電壓可達到 36V，4A ；4.可同時驅動兩臺直流電機。L298N 是SGS公司的產(chǎn)品，即是15腳Multiwatt 封裝的。內部包含 4通道邏輯驅因采用單個直流電機動電路，可以方便的驅動兩個直流電機或一個兩相步進電機。動，故設計成單直流雙橋合并電路。暑促電壓最高可達 50V ,可以直接通過電源來節(jié)輸出電壓，而且可以直接用單片機的10 口提供信號，而且電路簡單，使用方便。L298N使能端為高電平使能，使能端EN1、EN2可以接I/O 口控制也可直接接源正一直使能，至于使能端是接固定電平還是接I/O 口，視具體情況而定，若I/O 口資源夠用可接I/O

20、口控制，若不夠用，可直接接高電平。同時，控制電機的PWM 脈沖也可以從兩個使能端輸入，那么四個輸入引腳IN1、IN2、IN3、IN4只需設置為相應的高低電平可以控制電機的正反轉，假如 IN1給固定高電平，IN2給固定低電平電機正轉,那么IN1給低IN2給高就可實現(xiàn)反轉,IN3、IN4 同理。L298N的基本參數(shù)如下:類型：半橋輸入類型：非反相輸出數(shù)：4電流-輸出/通道：2A電流-峰值輸出：3A電源電壓 :4.5 V - 46 V工作溫度：-25 °C - 130 °C安裝類型：通孔封裝/外殼：Multiwatt-15 （垂直，彎曲和錯列引線）供應商設備封裝：15-Multi

21、watt包裝：管件器件型號L298N制造商 STMicroelectronics產(chǎn)品型號 Motion Motor ControlQjftVrfT 3如辱曲WIRTMomvriHPi.JTlEJU0UEDWPLTT JI DOC 空jPPi 科 g TA<3f ”匕OSOWPJTJ肌 PL 11CfUrjl2OhfKJl I應砂E牯rs&哮1N0A圖3.4 L298N管腳圖上圖是L298N的管腳圖VSS:芯片電壓5V。VCC :電機電壓,最大可接50V。GND :共地接法。OUT1OUT4 :輸出端，接電機。ENA、ENB :高電平有效， ENA、ENB分別為IN1和IN2、IN

22、3和IN4的使能端。IN1 IN4 :輸入端，輸入端電平和輸出端電平是對應的。我們使用的是兩個直流電機，其接線示意圖如下:7CCMortalirrjoirrzOUT?tm拄首片機訊1 ” 捷單呂執(zhí) EAA 高見乎-方註* 捲單片機EKE,圖3.5直流電機與L298N接線示意圖L298還提供了兩個負載電流的由于電機是感性負載，所以需要在L298的輸出端接四個快速二極管IN5822組成續(xù)流電路，將電機產(chǎn)生的感應電流消耗，防止對電路產(chǎn)生影響。反饋引腳：1腳和15腳，將它們同時接一個 0.1歐姆，12W的電流檢測電阻，再接地,此時就可以通過對1腳或者15腳進行A/D采樣，來得到電路中負載電流， 實現(xiàn)恒

23、流控制。L298有4腳（VS）和9腳（VSS）兩個電源引腳，4腳為電機驅動電源輸入端，該電壓需9腳為芯片工作電壓輸入端。要比9腳輸入電壓大，否則將會影響芯片的正常工作，而+5Vvcc8U5:A<JD5OUT1VCCSEN112LM3926TU41D4$ D3GND+5VVCCVCCD10i i1N41481N41482D9OUT14VSOUT3OUT2OUT1R310kU2亠OUT2D8iD7GNDOUT3OUT41314OUT3OUT4C1C2U175D11N414822PFC31nF29WI N1TNT5IN1VCCIN1IN2IN3IN4ENAENBSENSAGNDSENSBSEN

24、21+5V48U5:AR610kU66|XTAL1P0.0/AD0P0.1/AD1P0.2/AD2XTAL2P0.3/AD3P0.4/AD4P0.5/AD5P0.6/AD6RSTP0.7/AD7P2.0/A8P2.1/A9P2.2/A10PSENP2.3/A11ALEP2.4/A12EA-P2.5/A13P2.6/A14P2.7/A15P1.0P3.0/RXDP1 1P3.1/TXDP1.2P3.2/IN"P1.3P3.3/INIIP1.4P3.4/T0P1.5P3.5/T1P1.6P3.6/WP1.7P3.7/rL91013239SEN1 HSEN3SEN3圖3.6控制電路總圖+5

25、VU8:AR8U76812LM39251-nPN以上是控制電路的總圖。為了精簡起見，采用總線將各部分連接起來。4 .系統(tǒng)軟件的設計設計單片機應用系統(tǒng)時，通過根據(jù)具體要求現(xiàn)場調查分析，確定單片機應用系統(tǒng)地目標,確定系統(tǒng)的功能與性能。 系統(tǒng)的功能主要有數(shù)據(jù)采集、數(shù)據(jù)處理、輸出控制等，每一功能又細分若干子功能。比如，數(shù)據(jù)采集可分為模擬信號采集和數(shù)字信號采樣,數(shù)據(jù)處理可分為預處理、功能性處理、抗干擾處理等子功能；輸出控制按對象不同可分為各種控制功能,如機電控制、D/A轉換控制，數(shù)碼管顯示控制等。系統(tǒng)功能主要由控制精度、 速度、功耗、體積、重量、價格、可靠性的技術指標來衡量。而一旦這些指標一旦確定下來，

26、整個系統(tǒng)將在這些標定下進行設計。系統(tǒng)的速度、功耗、體積、重量、價格、可靠性的等指標會左右系統(tǒng)軟硬件的功能劃分。4.1應用軟件的設計應用軟件是根據(jù)系統(tǒng)功能進行設計的，應盡可能的實現(xiàn)系統(tǒng)的各種功能,般應用軟件應具有:軟件結構清洗，簡捷，流程合理。各功能程序事先模塊化、系統(tǒng)化。這樣既便于調試、連接，又便于移植、修改和維護。程序存儲區(qū)、數(shù)據(jù)存儲區(qū)規(guī)劃合理，既能節(jié)約存儲容量，又能給程序的設計與操作帶來方便。運行程序實現(xiàn)標志化管理。各個功能程序運行狀態(tài)、運行結果以及運行需求都設置標志狀態(tài)設置標志位以便于檢查，程序的轉移、運行、控制都可通過狀態(tài)標志來控制。經(jīng)過調試修改后的程序應該進行規(guī)范化, 除去修改痕跡。

27、規(guī)范化的程序便于交流、借鑒，也為軟件的模塊化、標準化打下基礎。實現(xiàn)全面軟件抗干擾設計。軟件抗干擾是計算機應用系統(tǒng)提高可靠性的有力措施。為提高運行的可靠性，在軟件中設置自診斷系統(tǒng)，在系統(tǒng)運行前先運行自診斷程序, 以檢查系統(tǒng)的各項參數(shù)是否正常。4.2軟件調試421軟件調試過程軟件調試是通過對用戶程序的匯編、連接、執(zhí)行來發(fā)現(xiàn)程序中存在的語法錯誤與邏輯錯 誤并加以排除糾正的過程。圖4-1軟件調試過程圖4.2.2軟件調試一般方法先獨立后聯(lián)機軟件是硬件的靈魂，沒有軟件系統(tǒng)將無法工作；同時大多數(shù)軟件的運行又依賴于硬件,當軟件測試參數(shù)進行事務處理時，往往是和硬件無關的，即這樣可以通過對用戶程序的仔細 分析，把

28、與硬件無關的、功能相對獨立的程序抽取出來，形成與硬件無關和依賴硬件的兩大 類用戶程序塊。在具有交叉匯編軟件或主機聯(lián)機仿真的基礎上，形成與硬件無關的程序調試與硬件同步進行，以提高軟件調試速度。當與硬件無關的程序塊全部調試完且用戶系統(tǒng)調試也已完成以后,可以將仿真機與主機、用戶系統(tǒng)連接，進行系統(tǒng)聯(lián)調，先對依賴于硬件的程序塊進行調試，調試成功后,再進行兩大程序的有機結合及總調試。先分塊后組合如果系統(tǒng)的用戶規(guī)模較大， 任務較多，那么即使先行將用戶程序分為與硬件無關和依賴于硬件兩部分，如果這兩部分程序依舊較為龐大的話，采用順序從頭到尾的調試方法既浪費時間又不易進行錯誤性定位，所以常規(guī)的調試方法都是分別對兩

29、類程序塊進一步采用分模塊調試，以提高軟件調試的有效性。每個程序模塊調試完畢后， 將相互關聯(lián)的程序模塊組合起來加以調試,以解決在程序模塊連接中可能出現(xiàn)的邏輯錯誤， 對所有程序模塊的整體組合是在系統(tǒng)聯(lián)調中進行得。由于各個程序模塊已通過調試排除了內部錯誤，所以軟件總體調試的錯誤就大大減少了,而調試成功可能性就大大的提高了。先單步后連續(xù)調試好程序模塊的關鍵是實現(xiàn)對錯誤的正確定位。準確發(fā)現(xiàn)程序中錯誤的最有效的方法是采用單步加斷點運行的方法調試程序。單步運行可以了解被調試程序中每條指令被執(zhí)行的情況，分析指令的運行結果可以知道該指令的正確性,并且進一步了解是硬件電路錯誤、數(shù)據(jù)錯誤還是程序設計錯誤等引起該指令

30、的執(zhí)行錯誤，從而發(fā)現(xiàn)和排除錯誤。但是所有程序都單步運行的方式查找錯誤，是一件費時又費力的工作，所以為了提高調這樣做到調試的快捷和準確。試效率，一般采用先使用斷電運行的方式來精確定位錯誤所在,有些實時性操作利用單步運行方法無法調試，必須采用連續(xù)運行方法進行調試，為了提高對錯誤的定位，可使用連續(xù)加斷點運行方式調試這類程序，即利用斷點定位的改變，一步 步縮小范圍，直至最終確定出錯誤位置并加以排除。423系統(tǒng)聯(lián)調系統(tǒng)聯(lián)調是讓用戶系統(tǒng)的軟件在其硬件上運行,進行軟、硬件聯(lián)合調試，從而發(fā)現(xiàn)硬件故障錯誤或軟、硬件設計錯誤。系統(tǒng)聯(lián)調主要解決以下問題:系統(tǒng)軟硬件是否能按預定的要求配合工作;系統(tǒng)運行中是否有潛在的設

31、計時難以預料的錯誤;系統(tǒng)的動態(tài)性能指標是否滿足設計要求;4.3電機的選擇常用的電機驅動技術有步進驅動、伺服驅動、變頻驅動，其中伺服驅動又分為開環(huán)、半閉環(huán)、閉環(huán)系統(tǒng)。圖4-2開環(huán)系統(tǒng)流程圖圖4-4閉環(huán)系統(tǒng)流程圖4.3.1步進電機的驅動技術它的步進電機是一種將數(shù)字式電脈沖信號轉換成機械角位移或線位移的機電元件。機械位移與輸入的數(shù)字脈沖信號有著嚴格的對應關系,即一個脈沖信號可使步進電動機前進一步，又由于它的輸入信號為脈沖電壓，因此又被稱作脈沖電動機。 步進電動機作 為數(shù)字控制系統(tǒng)的佳配，它是一種比較理想的執(zhí)行元件。步進電機驅動技術是典型的開環(huán)控制系統(tǒng)，主要用于位置或角位移變化的運動控制領域。圖4-5

32、步進電機選擇步進電機驅動技術主要特點：位置控制，成本較低。Vi,控制器腳冷號IIIIIIill三工步逬電機環(huán)行方向信號分電胳11:A1功率 "K大B-3IIIIIIII圖4-6步進電機驅動器432變頻驅動技術連續(xù)、精確地復現(xiàn)輸變頻控制系統(tǒng)是一種能夠實現(xiàn)機械平臺或回轉機構的速度的自動、 入指令信號的變化規(guī)律的自動控制系統(tǒng)。圖4-7變頻器通用系統(tǒng)框圖整流器：將交流電變換成直流的電力電子裝置，其輸入電壓為正弦波， 輸入電流非正弦，帶有豐富的諧波 。逆變器：將直流電轉換成交流電的電力電子裝置，其輸出電壓為非正弦波， 輸出電流近似正弦。變頻驅動技術主要用于轉速或頻率變化的節(jié)能環(huán)保領域。50HZ

33、*2空20圖4-8雙極性SPWM回路iliiiTi!圖4-9輸出電壓波示意圖變頻驅動技術的主要特點：速度控制，成本適中。4.3.3伺服驅動技術方伺服控制系統(tǒng)是一種能夠準確、快速和穩(wěn)定地實現(xiàn)機械平臺或回轉機構的位置、（或給定值）的任意變化位、速度、轉矩或者其它機械狀態(tài)的輸出被控量跟隨輸入目標值的自動控制系統(tǒng)。伺服驅動技術主要用于速度、位置和轉矩變化的全閉環(huán)準確運動控制領域。伺服驅動技術的主要特點：速度、位置和轉矩的全閉環(huán)控制，成本較高。步謹電機腿諭fl逓伺劇電機租交茨解電機皤動力拒范a中小力!&fe在鄧F6VF】小.申、大，全!E0B35范58低LiS在rOWRPM 如勸拒電PW吁 lO

34、OCrPXn高何達j啊冊山S滝伺ffi電枇可達卜】萬薦分観S萬Sies&af?s事澤化書S化fms方式aa方s平郵左低速時育振軸但用細幷型蘢動 器則可明S改善i8,運行平淆S（具悻養(yǎng)瘠SSSBBW誹承«a時，力矩下歸快力距刪好刪轉険a栽特性titt時主先步同卜岡信atfe底時gtanrt炒助fWE制，也可攥粥 備防止先步間祐益aiggas響38-K耐振動»般航轉孌圧器型可耐振珀溫升Sff溫度高-S;生護fe歸可帰歸較好低較ra圖4-10常用伺服裝置比較434電機控制方式選擇不同的應用場合，對控制用電動機的性能密度的要求也有所不同。NC工作機械的進給（1）對于起停頻率

35、低（如幾十次/分），但要求低速平穩(wěn)和扭矩脈動小，高速運行時振動、噪聲小，在整個調速范圍內均可穩(wěn)定運動的機械，如運動、機器人的驅動系統(tǒng)，其功率密度是主要的性能指標;（2）對于起停頻率高（如數(shù)百次/分），但不特別要求低速平穩(wěn)性的產(chǎn)品，如高速打印機、繪圖機、打孔機、集成電路焊接裝置等主要的性能指標是高比功率。(3) 在額定輸出功率相同的條件下，交流伺服電動機的比功率最高、直流伺服電動機次之、步進電動機最低。而我們的自動循跡輪椅由于要求要有足夠的響應速度,同時要能夠要有優(yōu)良的調速性能,并且在控制上能夠和軟件的設計進行較好的結合，所以充分結合各種控制電機調速方式的優(yōu)缺點，并且根據(jù)輪椅的能源裝置需要隨身攜

36、帶，只能采用類似蓄電池式的能源裝置，我們選3個光電對管的控制形式，只設置定直流調速電機作為驅動裝置。為了便于控制，同時適應 兩檔調速，實際情況可以增加多檔調速，同時將控制系統(tǒng)的復雜程度提高以適應變速過程。4.4輪椅轉向系統(tǒng)的設計利用紅外式傳感器檢測地面上引導線的光強模擬信號,3路模數(shù)轉換通道AD0AD2與各個紅外式傳感器的反射信號相連，通過80C51自身的AD轉換通道處理數(shù)據(jù)。反射后光的強弱是通過模擬電壓來表征的，每一個接收管都對應了一個模擬電壓，將他們進行A/D轉換,并將所得的數(shù)值與每個光電管設置的閾值電平相比較,進而判斷輪椅的行進狀態(tài)是否需要改變，要進行調整，將3個光電管同時位于檢測區(qū)，安

37、裝位置大致如圖4-11所示。位置狀態(tài)= 010位置狀態(tài) = 100位g我態(tài) = 001圖4-11輪椅檢測位置示意圖小車采用兩輪驅動，其中使用L298是控制直流電機的專用集成芯片，它是雙H橋高電壓功率大電流功率集成電路，可驅動2個直流電動機等感性負載。L298可以驅動兩個電機運動,A組控制電機，B組控制另一個電機。 其中，ENA、IN1、IN2為L298的A組輸入使能控制,IN1 與 IN2為輸入端，輸出端為0UT1、0UT2。當ENA=1 ，IN1=1 ，IN2=0 時，電動機正轉;ENA=1，IN1=0 ，IN2=1 時,電動機反轉；B組控制方式與A組是一樣的。反射式紅外二極管檢測地面引導線

38、,通過A/D轉換得到一個值,反射光越強，值越大;反射光越小，值越小。程序開始執(zhí)行時,位置檢測裝置位于引導線上,測出引導線與地面背令狀態(tài)dStatue=1景值，求出平均值，作為閾值avg。規(guī)定：當A/D轉換的檢測值大于閾值, 若A/D轉換的檢測值小于閾值，令狀態(tài) dStatue=0用定時器1控制定時采樣輪椅的位置量，根據(jù)車的位置控制其運動， 程序流程圖如下:(a)主程序流程圖(c)定時器中斷服務程序流程圖圖4-12系統(tǒng)控制流程圖具體程序代碼如下:#in clude<reg51.h>#defi ne TMOD_VALUE 0x20II定義C/t1的工作方式#defi ne TH1_VA

39、LUE 0xE6/定義TH1的值#defi ne TL1_VALUE 0xE6II定義TL1的值typ edef un sig ned char uchar;II留意空格uchar data value3 _at_ 0x40 ;uchar data adNum;IIAD通道號uchar data flagi;II完成3路數(shù)據(jù)采集，標志=1uchar data flag2;II完成閾值計算，標志=1uchar data avg;閾值uchar xdata adAddr;II定義ADC0809地址，假設為 0x2000uchar bdata dStatue=0;sbit dStatue_0=dSt

40、atue0;sbit dStatue_仁dStatueX;sbit dStatue_2=dStatue2;sbit P1_0=Piy； sbit P1_仁P "1;sbit P1_2=P1A2;sbit P1_3=PIA3； sbit P1_4=P 1人4;sbit P1_5=PIA5； void in iTimerl(void)TMOD=TMOD_VALUE;定時器1方式2TH1=TH1_VALUE;/定時器1預置數(shù)TL1=TL1_VALUE;/定時器1置重裝載數(shù)TR1=1;/啟動定時器return;void coun t(void)avg=value0/2+value1/2;閾值

41、計算完flag2=1;return;void delay(void) / 延時uchar data i;while(i<5000)i+；return;void tur n( uchar x)/小車方向控制函數(shù)/左轉if(x=0)P1_3=1; P1_2=0; P1_4=0; P1_5=1;/ 使 L298 的 ENA=1 , ENB=1，右輪電機全速前進while(1)P1_1=1; P1_2=0;/左輪半速前進delayO;/延時P1_1= P1_1; P1_2= P1_2;/全速delay();if(x=1)/右轉P1_3=1; P1_2=0; P1_4=0; P1_5=1;/左輪電

42、機全速while(1)P1_4=1; P1_5=0;/左輪電機半速delayO;P1_1=0; P1_2=0;/左輪停轉P1_1= P1_1; P1_2=-P1_2;/全速delay();if(x=2)/前進P1_3=1; P1_0=1;/ 使 L298ENA=1 , ENB=1 ;P1_1=1; P1_2=0;/左輪前進P1_4=0; P1_5=1;/右輪前進return;if(x=3)/停止P1_3=0; P1_0=0;/ 使 L298ENA=0 , ENB=0P1_4=0;P1_5=0;/ 右輪停轉return;void motorc on trol(uchar x)switch(x)c

43、ase O:tur n( 0);break;case 1:tur n( 1);break;case 2:tur n( 2);break;case 3:tur n( 3);break;void judge(void)if(valueO<avg)II小于閾值置位變量 dState 0=0elsedStatue_O=O;dStatue_0=1;/AD轉換值大于閾值，置位變量dState_0=1if(value1<avg)dStatue_O=O;elsedStatue_0=1;if(value2<avg)dStatue_O=O;elsedStatue_0=1;return;mai n

44、()in iTimer1();adNum=O;IT1=1;EA=1;EX1=1;ET1=1;flag1=0;flag2=0;motorco ntrol(2);adAddr=adNum;while(1)if(flag1=1)if(flag2=0)coun t();flag1=0;judgeO;switch(dStatue)case 0:motorc on trol(3);break;case 1:motorc on trol(1);break;case 2:motorc on trol(2);break;case 4:motorc on trol(0);break;default:motorc on trol(3);br