機電一體化系統(tǒng)設計課程設計參考

《機電一體化系統(tǒng)設計課程設計參考》由會員分享，可在線閱讀，更多相關《機電一體化系統(tǒng)設計課程設計參考（24頁珍藏版）》請在裝配圖網(wǎng)上搜索。

1、機電一體化系統(tǒng)課程設計 X-Y數(shù)控工作臺設計說明書 :稱學校名 :班級學號 :名生學姓 :班級 2016 4 月年 1 / 21 、總體方案設計 1.1 設計任務 設計一個數(shù)控 X-Y工作臺及其控制系統(tǒng)。該工作臺可用于銃床上坐標孔的加工和臘摸、塑料、 鋁合金零件的二維曲線加工，重復定位精度為士 0.01mm,定位精度為 0.025mm。 設計參數(shù)如下：負載重量 G=150N ；臺面尺寸 C x B x H = 145mm x 160mm x 12mm ；底座外形尺 寸 C1 x B1 x H1 = 210mm x 220mm x 140mm ；最大長度 L=388

2、mm ；工作臺加工范圍 X=55mm , Y=50mm ；工作臺最大快移速度為 1m/min。 1.2 總體方案確定 （1）系統(tǒng)的運動方式與伺服系統(tǒng) 由于工件在移動的過程中沒有進行切削， 故應用點位控制系統(tǒng)。 定位方式采用增量坐標控制。 為 了簡化結構，降低成本，采用步進電機開環(huán)伺服系統(tǒng)驅動 X-Y工作臺。 (2)計算機系統(tǒng) 本設計采用了與 MCS-51系列兼容的AT89S51單片機控制系統(tǒng)。它的主要特點是集成度高，可 靠性好，功能強，速度快，有較高的性價比。 控制系統(tǒng)由微機部分、鍵盤、 LED、I/O接口、光電偶合電路、步進電機、電磁鐵功率放大器電 路等組成。系統(tǒng)的加工程序

3、和控制命令通過鍵盤操作實現(xiàn)。 LED顯示數(shù)控工作臺的狀態(tài)。 (3) X-Y工作臺的傳動方式 為保證一定的傳動精度和平穩(wěn)性， 又要求結構緊湊，所以選用絲杠螺母傳動副。為提高傳動剛度 和消除間隙，采用預加負荷的結構。 由于工作臺的運動載荷不大，因此采用有預加載荷的雙 V形滾珠導軌。采用滾珠導軌可減少兩 個相對運動面的動、靜摩擦系數(shù)之差，從而提高運動平穩(wěn)性，減小振動。 考慮電機步距角和絲桿導程只能按標準選取，為達到分辨率的要求，需采用齒輪降速傳動。 圖1-1 系統(tǒng)總體框圖 2 / 21 二、機械系統(tǒng)設計 、工作臺外形尺寸及重量估算2.1 向拖板(上拖 板)尺寸：X 50

4、X 145 X 160 長寬高 體積x材料比重估算重量：按重量 =2 3901010 7.8 145 16050 N 04551 6 01 Y向拖板(下拖板)尺寸： 重量：約90N。 上導軌座(連電機)重量： 3 22 107 10 810) 7.8 10 1.1 (220140 38 2 155 )N( 。150N 夾具及工件重量：約 287N。工作臺運動部分的總重量：約 X-Y 2.2、滾動導軌的參數(shù)確定 ⑴、導軌型式：圓形截面滾珠導軌 ⑵、導軌長度x向) ①上導軌(l 100 取動導軌長度Bl 55 動導軌行程 L l l 155 支承導軌長度 b②下導軌(y向) l 1

5、0050l bL 150 選擇導軌的型號： GTA16 ⑶、直線滾動軸承的選型 ①上導軌 G 240(N) x②下導軌 G 287(N) Y由于本系統(tǒng)負載相對較小，查表后得出 LM10UUOP1直線滾動軸承的額定動載荷為 370N,大于實際動負載；但考慮到經(jīng)濟性等因素最后選擇 LM16UUOP1直線滾動軸承。并采用雙 排兩列4個直線滾動軸承來實現(xiàn)滑動平臺的支撐。 3 / 21 ⑷、滾動導軌剛度及預緊方法 當工作臺往復移動時，工作臺壓在兩端滾動體上的壓力會發(fā)生變化， 受力大的滾動體變形大，受 力小的滾動體變形小。當導軌在位置I時， 兩端滾動體受力相等， 工作臺保持水平；當導

6、軌移動 到位置n或m時，兩端滾動體受力不相等，變形不一致，使工作臺傾斜a角，由此造成誤差。此 外，滾動體支承工作臺，若工作臺剛度差，則在自重和載荷作用下產(chǎn)生彈性變形，會使工作臺下 凹(有時還可能出現(xiàn)波浪形)，影響導軌的精度。 2.3、滾珠絲杠的設計計算 滾珠絲杠的負荷包括銃削力及運動部件的重量所引起的進給抗力。應按銃削時的情況計算。 ⑴、最大動負載 Q的計算J- 3LffQ P Hf 1f 1,壽命值，查表得系數(shù)H60nT L 610查表得使用壽命時間 T=15000h, 初選絲杠螺距t=4mm,得絲杠轉速 1000V1000 1max 250(r/n min)t460 250

7、 15000 225L 所以 610X向絲杠牽引力 P 1.414fG(f——當量摩擦系數(shù)) xx當當 1.414 0.01 240 3.39(N) Y向絲杠牽引力 P 1.414fGyy當)N287 4.06( 1.414 0.01 所以最大動負荷 J 3225 1 1 3.39 Q 20.6(N) X 向 J 3225 Q 1 1 4.06 24.7(N)向 Y yd 10mm,選用滾珠絲杠螺母徑稱杠珠取表查，滾絲公直 副 。的型號為 SFK1004,其額定動載荷為 390N,足夠用。 ⑵、滾珠絲杠螺母副幾何參數(shù)計算 4 / 21 表2-1 滾珠絲杠螺母副幾何參數(shù)

8、 稱名 符號 計算公式和結果 公稱直徑 d0 10 螺距 t 4 接觸角 45 d2 鋼球直徑q螺紋滾道1.04 0.52dR R 螺紋滾道法面半徑q e 0.03sin d/e 2R 偏心距q螺紋升角t tg7.26 arc dO 0 d 9.50.2~0.25d d d螺桿外徑 qod d 2e 2R 7.98d螺桿 螺桿內徑 0ll d 8.59 dcosd d 螺桿接觸直徑

9、zqz0D d 2e 2R 12.02D 螺母螺紋外徑 0 d 0.255d 10.50.2~D D螺母 螺母內徑(外循環(huán)) 的團見表2-1。⑶、傳動效率計算 tg7.26tg 0.973 0 )tg(7.26 0.2tg() 0 o ——絲杠螺紋升角?！Σ两?；式中： ⑷、剛度驗算 L的變化量引起的導程 滾珠絲杠受工作負載 P0PL0 L, _ 1EF Y向所受牽引力大，故應 用Y向參數(shù)計算 L 0.4(cm))P 24.7(N 0 26 材料為鋼)(N/ E20.6 10cm L很小，可以忽略。絲杠 因受扭矩而引起的導程變化量 所以導程總誤差 5 / 2

10、1 100100 6 m/ 1.2 103mL |__| 0.4L0 m15, 故剛度足夠。查表知 E級精度的絲杠允許誤差 ⑸、穩(wěn)定性驗算 由于絲杠兩端采用止推軸承，故不需要穩(wěn)定性驗算。 2.4、 步進電機的選用 ⑴、步進電機的步距角 b stepmm/ 0.01 1.5。取系統(tǒng)脈沖當量，初選步進電機步距角 pb 0 ⑵、步進電機啟動力矩的計算 設步進電機等效負載力矩為 T,負載力為P,根據(jù)能量守恒原理，電機所做的功與負載力做功有 如下關系 = PsT s ——機械傳動效率。 式中：一一移動部件的相應位移； 一一電機轉角； G PP s,所以，且，則 若取 sbp G

11、36P sp（Ncm）T 2bPP——與重量方向一 致的作；G ——移動部彳^重量（N式中：） 一一移動部彳^負載（N）; Sz ——步進電機步距角， （rad）；用在移動部件上的負載力（ N）； T ——導軌摩擦系數(shù)；bNcm） ——電機軸負載力矩 P0.96 0.03為絲杠牽引力，，本例中，取(淬火鋼滾珠導軌的摩擦系數(shù)) ， sP P 24.7NG G 287N,所以向電機負載較大，因此取 。考慮到重力影響， YHsy 287 0.0324.7 36 0.01 1.33(NcmT ) 0.96 1.5 2若不考慮啟 動時運動部件慣性的影響，則啟動力矩 TT

12、 q0.5~0.31.33 T4.42 Ncm ,則 0.3 取安全系數(shù)為 ，q0.3 對于工作方式為三相六 拍的三相步進電機 6 / 21 T qcmN5.1 T maxj0.866 ⑶、步進電機的最高工 作頻率 V100011000 max)f 1667(Hz max 0.016060 P 2-2。查表 選用兩個45BF005- n型步進電機。電機的有關參數(shù)見表 2-2 步進電機參數(shù)表 號型 主要技術數(shù)據(jù)2 )(mm外形尺寸 重 量) N( 步 距 角 最 大靜 轉距 Ncm 最高空 載動頻 率啟 (s/step 相 數(shù) 電壓 V)(

13、 電 流) A( 外徑 長度 軸徑 ) 11 II 1 . 5 19.6 58 4 3 27 2.5 45 45BF005- 3000 2.5、 確定齒輪傳動比 mm4t 1.5量當脈沖實角，距，滾珠絲杠螺 要現(xiàn)距進因步電 step/0.01mm ,在傳動系統(tǒng)中應加一對齒輪 降速傳動。齒輪傳動比 p 360 Z3600.01 piO.6 i O 4 Zt1.&228 17ZZ ，選 。2i 2.6、 確定齒輪模數(shù)及有關尺寸 mmlm因傳遞的扭距較小，取模數(shù) 3-3 ,齒輪有 關尺寸見表。 、

14、步進電機慣性負載的計算 2.7 2-3表齒輪尺寸 Z28 17 7 / 21 28 17 mmd mZ 30 19 mm2md d a 25.5 14.5 mm 1.25md d 2 f 5 5 mm 6b m3 d d17.5 21mm a根據(jù)等效轉動慣量的計算公式，得 Z piM J JJ JJ 30d12Z bl80 2jJcmkg——步進電機轉軸的轉動慣量 式中：）一一折算到電機軸 上的慣性負載（；0d 的轉動慣量（21 22jJcmcmkgcmkgkg；的轉動慣量（） （；）——齒輪）； ——齒輪 2Jkgcmkg）； M——移動 部件質量

15、（一一滾珠絲杠的轉動慣量（） o 3 對材料為鋼的圓柱零 件轉動慣量可按下式估算 234 cmD10kgL J0.78 ——零件長度（cm）——圓柱零件直徑（cm）; L式中：D所以 23 34 cm1010kg 1.7 0.5 3.26 J0.78 1 234 3 cm2.8kg 0.5 23.910J 0.78 10 2 2 34 3cm10kg J0.78 103.91 5 3 電機軸轉動慣量很小, 可以忽略，則 217 3 3103.26J 10 23.93.9 d28 2 0.001 25 m 250.4 10kg 3.14 1.5 180 0.4J1

16、d1 0.319 ,所以慣性匹配比較符合要求。因為 1.274J4M8 / 21 三、控制系統(tǒng)硬件設計 X-Y數(shù)控工作臺控制系統(tǒng)硬件主要包括 CPU、傳動驅動、傳感器、人機交互界面。 硬件系統(tǒng)設計時，應注意幾點：電機運轉平穩(wěn)、響應性能好、造價低、可維護性、人機交互界面 可操作性比較好。 3.1 CPU 板 3.1.1 CPU的選擇 隨著微電子技術水平的不斷提高， 單片微型計算機有了飛躍的發(fā)展。 單片機的型號很多， 而目前 市場上應用 MCS-51芯片及其派生的兼容芯片比較多， 如目前應用最廣的 8位單片機89C51,價 格低廉，而性能優(yōu)良，功能強大。 在一些復雜的系統(tǒng)中就不得不考

17、慮使用 16位單片機，MCS -96系列單片機廣泛應用于伺服系統(tǒng)， 變頻調速等各類要求實時處理的控制系統(tǒng)， 它具有較強的運算和擴展能力。 但是定位合理的單片 機可以節(jié)約資源，獲得較高的性價比。 從要設計的系統(tǒng)來看，選用較老的 8051單片機需要拓展程序存儲器和數(shù)據(jù)存儲器，無疑提高了 設計價格，而選用高性能的16位MCS-96又顯得過于浪費。 生產(chǎn)基于51為內核的單片機的廠家 有Intel、ATMEL、Simens,其中在 CMOS器件生產(chǎn)領域 ATMEL公司的工藝和封裝技術一直處 于領先地位。ATMEL公司的AT89系列單片機內含 Flash存儲器，在程序開發(fā)過程中可以十分容 易的進行

18、程序修改，同時掉電也不影響信息的保存；它和 80C51插座兼容，并且采用靜態(tài)時鐘 方式可以節(jié)省電能。 因此硬件CPU選用AT89S51 , AT表示ATMEL公司的產(chǎn)品，9表示內含F(xiàn)lash存儲器，S表示含 有串行下載Flash存儲器。 AT89S51的性能參數(shù)為：Flash存儲器容量為4KB、16位定時器2個、中斷源6個（看門狗中斷、 接收發(fā)送中斷、外部中斷 0、外部中斷1、定時器0和定時器1中斷）、RAM為128B、14位的 計數(shù)器 WDT、I/O 口共有32個。 3.1.2 CPU接口設計 CPU接口部分包括傳感器部分、傳動驅動部分、人機交互界面三部分。示意圖如下所示: （行

19、程開關）感傳器 AT89S51 （電磁鐵）  前向通道 傳動驅動(步進 電機) 后向通道 人機界面 LED )(鍵盤、 9 / 21 圖3-1 CPU外部接口示意圖 AT89S51要完成的任務： (1) 將行程開關的狀態(tài)讀入 CPU,通過中斷進行處理，它的優(yōu)先級別最高。 (2) 通過程序實時控制電機和電磁鐵的運行。 (3) 接受鍵盤中斷指令，并響應指令，將當前行程開關狀態(tài)和鍵盤狀態(tài)反應到 LED上，實現(xiàn)人 機交互作用。 由于AT89S51只有P1 口和P3 口是準雙向口，但P3 口主要以第二功能為主， 并且在系統(tǒng)中要用

20、到第二功能的中斷口，因此要進行 I/O擴展?？紤]到電路的簡便性和可實現(xiàn)性，實際中采用內部 自帶鎖存器的8155,所以AT89S51的I/O 口線分配如下： (4) P1.0-P1.5控制X-Y兩個方向步進電機的 A、B、C線圈通電，形成 A-AB-B-BC-C-CA-A三 相六拍正轉模式和 A-AC -C-CB-B-BA -A的反轉模式。 (5) P1.6 口輸出控制電磁鐵的吸合。 (6) P3.2和P3.3兩個中斷源中INT0優(yōu)先級最高，它讀入行程開關的狀態(tài)并觸發(fā)中斷； INT1 讀入點動、復位、圓弧插補開關的狀態(tài)而觸發(fā)中斷。 (7) P0.0-P0.7外部I/O擴展的數(shù)據(jù)讀取

21、。 (8) P2.7 和 P2.6 決定 8155 的 PA、PB、PC 口的地址。 8155 P1.0-P1.2 P0.0-P0.7 P1.3-P1.5 P1.6 P2.7 P3.2 P2.6 P3.3 AT89S51 AD0?AD7 X步進電機 Y步進電機 外部中斷， 1驅動 2驅動 初始化 電磁鐵3驅動1鍵盤2 外部中斷外部中斷  開外部中斷，開總中 斷等待中斷 CE IO/M PPBP

22、8155 T89S51控制系統(tǒng)圖3-2 A 圖 X+禁止、手動Y+禁止、Y-個狀態(tài)：反映當前運行的 8X+禁止、X-禁止、口接PBLED運行。運 行、手動Y-運行、手動X-運行、手動 Y+ 4個行程開關的狀態(tài)。 PA 口低四位反映觸發(fā)中斷 1的 運Y-運行、手動運行、手動 X+X-運行、手動 Y+的手動位反映了觸發(fā)中斷口低 PC62個開關的 狀態(tài)。、圓弧插補 RST行、復位（）6 10 / 21 中斷源。 中娠源 * IXT0 INT1J 二 PAPC 口， 圖3-3多中斷源中斷觸發(fā)圖 3.2 驅動系統(tǒng) 傳動驅動部分包括步進電機的驅動和電磁鐵的驅動， 步進電機須滿

23、足快速急停、定位和退刀時能 快速運行、工作時能帶動工作臺并克服外力（如切削力、摩擦力）并以指令的速度運行。在定位 和退刀時電磁鐵吸合使繪筆抬起，繪圖時能及時釋放磁力使筆尖壓下。 3.2.1 步進電機驅動電路和工作原理 步進電機的速度控制比較容易實現(xiàn)，而且不需要反饋電路。設計時的脈沖當量為 0.01mm,步進 電機每走一步，工作臺直線行進 0.01mm。 步進電機驅動電路中采用了光電偶合器，它具有較強的抗干擾性，而且具有保護 CPU的作用， 當功放電路出現(xiàn)故障時，不會將大的電壓加在 CPU上使其燒壞。 圖3-4 步進電機驅動電路圖 該電路中的功放電路是一個單電壓功率放大電路

24、，當 A相得電時，電動機轉動一步。電路中與 繞組并聯(lián)的二極管 D起到續(xù)流作用，即在功放管截止是，使儲存在繞組中的能量通過二極管形 成續(xù)流回路泄放，從而保護功放管。與繞組 W串聯(lián)的電阻為限流電阻，限制通過繞組的電流不 至超過額定值，以免電動機發(fā)熱厲害被燒壞。 由于步進電機采用的是三相六拍的工作方式（三個線圈 A、B、C）,其正轉的通電順序為： A-AB-B-BC-C-CA-A,其反轉的通電順序為： A-AC-C-CB-B-BA-A。 11/ 2i _n_rLrLrLrLrLrLrLrLrLrLrL 步進時鐘 A相波形 相波形B C相波形圖3-5 三相六拍工作  方式時相電壓

25、波形（正轉） 電磁鐵百區(qū)動電路 3.2.2該驅動電路也采用了光電偶 因為驅動電磁鐵的電流比 其但其功放電路相對簡單。合器，光電偶合部分采用的是達林頓管, 較大。 電磁鐵驅動電路圖3-6 電源設計3.2.3 兩電機同時工作再加上控制系統(tǒng)用電， 所需電源容量比較大， 需要選擇大容量電源。 此系統(tǒng)中電 源作為27V,為了便于管理和電源容量需求，就采用了標準的、用到的電源電壓為 27V12V、5V 12V基準，通過芯片進行電壓轉換得到所需的和 5V電壓。 電源轉換電路圖 3-7圖 此外，前面電容起防止自激作用，電路中在轉換芯片的前后有兩個電容，后面電容起濾波作用。 12

26、 / 21 在具體應用的過程中， LM7805必須加上散熱片。 3.3 傳感器和人機界面 由于步進電機不需要反饋電路，但是要注意工作臺不能超過最大行程。因此，必須在 X、Y 軸的方向各加上兩個行程開關。這里行程開關作用有兩個： （1）防止工作臺超過最大行程， 使電 機損壞（2）可以用與定位。所以這 4個行程開關就充當了傳感器。 人機界面設計的準則就是要有良好的人機交互能力， 一般要求操作簡便，界面簡潔明了。此系統(tǒng) 中共有9個LED, LED1燈亮表示 X軸負方向禁止通行， LED2燈亮表示X軸正方向禁止通行， LED3燈亮表示 Y軸負方向禁止通行， LED4燈亮表示Y軸正方向禁止

27、通行， LED5燈亮表示手 動使工作臺向 X軸負方向通行，LED6燈亮表示手動使工作臺向 X軸正方向通行，LED7燈亮表 示手動使工作臺向 丫軸負方向通行，LED8燈亮表示手動使工作臺向 丫軸正方向通行，LED9亮 表示系統(tǒng)通電運行。 界面上的7個按扭意義為：按扭 1是通斷電開關，按扭 2是向X軸負方向運行的點動開關，按 扭3是向X軸正方向運行的點動開關，按扭 4是向丫軸負方向運行的點動開關，按扭 5是向丫 軸正方向運行的點動開關，按扭 6是復位開關，按扭 7是執(zhí)行繪制圓弧開關。 ? LEDS ? LED9 Y+ii 行 總開美 ? LED1 ? LED2 X-蒙止 X*桑

28、止 ? LED 3 ?LED4 「禁止 T十禁止 ? LED5 ? LEDS ? LED? Y-通行 復位 圖3-8 人機界面圖 3.4 本章小節(jié) 本章著重介紹了數(shù)控工作臺控制系統(tǒng)的硬件設計。 CPU板介名S了 CPU的選擇及其外圍的接口設 計和控制流程；驅動系統(tǒng)介紹了步進電機和電磁鐵的驅動電路設計； 此外還敘述了人機界面各個 按扭和LED的意義。 13 / 21 四、控制系統(tǒng)軟件設計 4.1 總體方案 對于AT89S51的程序設計，由于所需實現(xiàn)的功能較簡單，采用匯編的形式。編譯器采用Keil 7.02b 該編譯器是51系列單片機程序設計的常用工具，既可用匯

29、編，也支持 C語言編譯。同時具有完 善的調試功能。 4.2 主流程圖 CTL EQU 3FF8H 3FF9H EQU PA 上電復位 3FFAH EQU PB 3FFBH EQU PC 02H EQU CMD ,吸合電磁鐵，繪筆抬起 P1.6=00000H ORG MAIN AJMP 0003H ORG 入口 ；外部中斷 0AJMP INT0IS 000BH ORG 中斷入口 ；定時器0AJMP TM0IS 0013H ORG 入口 ；外部中斷 1AJMP

30、 INT1IS 001BH ORG 中斷入口；定時器 1 AJMP TM1IS 0100H ORG 0EFH ,P1MAIN : ANL ;外中斷負跳沿觸發(fā) IT0 SETB IT1 SETB 圖 4-1 CTL A , MOV A DPTR MOV CMD @DPTR , MOVX 口輸入B 口輸出，C ; A 口輸入， 0 ;允許外中斷 EX0 SETB 1 ;允許外中斷 SETB EX1 PX0 SETB ;設置優(yōu)先級 PX1 SETB ;開總中斷 EA SETB ;等待中斷 LOOP : LOOPAJMP 的則進入中斷00在等待

31、中斷的過程中，如果有中斷到來，先檢查中斷的狀態(tài)，是中斷 0。1的 中斷服務INT1IS ,是中斷中斷服務INT0IS1則進入中斷然后將結果反口內容，個行程開關觸發(fā) 的，4它觸發(fā)后通過單片機讀取 PA是由中斷服務 0 LEDPB饋到口的上。14 / 21 中斷服務1有6個中斷源，這六個中斷源分別是手動 X正方向運行，手動 X負方向運行，手動 Y正方向運行，手動 Y負方向運行，復位和繪制圓弧。 4.3 INT0中斷服務流程圖 ACC PUSH INT0IS : DPTL PUSH DPTH PUSH PSWPUSH PA , MOV A A MOV DPTR 口內容 ；讀

32、 PAMOVX A ， @DPTR A ， R2 MOV PB ， A MOV DPTR,A MOV @DPTR,R2 MOV R2 ， A MOV A 取反 ； A CPL 6 位 ；屏蔽高 ANL A ， #03H TM2C A ， JZ P1.0 SETB P1.1 SETB P1.2 SETB R2 ， ATM2C ： MOV A CPL #0CH ， A ANL RETIN A ， JZ P1.3 SETB P1.4 4-2 圖 SETB P1.5 SETB RETIN ： POP PSW POP DPTH POP DPTL ACC

33、POP RETI 15 / 21 4.4 INT1 中斷服務流程圖 .1 .

34、 JNB ACC.3 , Y-EN MOV A, PC JNB ACC.5 , ARC MOV DPTR ,A LOOP1 : POP DPTH MOVX A, @DPTR ;讀 PC 口內容 POP DPTL MOV R1, A POP PSW ANL R1, #0FH POP ACC MOV A, PB SETB EX1 MOV DPTR, A RETI MOV A , @DPTR ;讀 PB 口內容 ANL A, #0FH SWAP A ORL A,

35、R1 MOV R2, A MOV A, PB MOV DPTR, A MOVX @DPTR, R2; 數(shù)據(jù)輸入PB 口 INC DPTL 16 / 21 4.4.1 復位程序流程圖 DIRX EQU 30H DIRY EQU 31H RST: CLR P1.6 RPA: MOV A, PA MOV DPTR , A MOVX A, @DPTR ;讀PA 口內容 JNB ACC.0 , ACC2 MOV DIRX , #0

36、0H ;表X電機反轉 ACALL XMOTOR0 ;X電機反轉f ACC2 : JNB ACC.2 , LOOP0 MOV DIRY , #00H ;表丫電機反轉 ACALL YMOTOR0 ;Y電機反轉f AJMP RPA LOOP0 : :AJMP LOOP1 17 / 21  X+EN : CLR P1.6 MOV A, PA MOV DPTR , A MOVX A, @DPTR JNB ACC.0 , LOOP2 MOTOR0 : MOV DIRX , #01H

37、 ACALL XMOTOR0 MOV A, PC MOV DPTR, A MOV A, @DPTR JNB ACC.0 , MOTOR0 LOOP2 : AJMP LOOP1 這是X軸電機點動正轉的程序，其他的 X軸電機點動反轉、 Y軸電機點動正轉、 Y軸電機點動 反轉依次類推。 18 / 21 4.4.3 繪制圓弧程序流程圖 分配地址交團、設營初值 A N 跳轉LOCP1| N 圖4-6 逐點比較法畫圓弧 逐點比較法原理：假設所畫圓弧在第一象限，圓心坐標為( 0, 0),圓弧上點的坐標為(X,

38、 Y),圓弧半徑為 R,每一點的坐標偏差為 F=X*X+Y*Y -R*R ,若F>0,應沿X軸負方向走一步， 此時 FX= (X-1) * (X-1) +Y*Y -R*R=F -2X+1 , X=X -1;若 F<0,應沿 Y 軸正方向走一步，此 時 FY=X*X+ (Y-1) * (Y-1) -R*R=F+2Y+1 , Y=Y+1。插補程序見附錄。 19 / 21 4.4.4 步進電機步進一步程序流程圖 步進電機步進一步程序流程圖 圖4-7 DEF EQU 12H SJMP LP3 MOV DEF , #00H TAB : DB FEH XMOTOR1 :JNE D

39、IRX , #01H, XMOTOR0 DB FCH JNE DEF , #05H, LP2 DB FDH CLR DEF DB F9H LP2 : MOV A, DEF DB FBH INC DEF DB FAH LP3 : MOV DPTR, #TAB MOVC A, @A+DPTR ANL P1, A ACALL DELAY RET XMOTOR0 :JNE DEF , #00H , LP4 MOV A, #05H MOV

40、 DEF , A LP4 : MOV A, DEF  DEC DEF 20 / 21 五、附錄 參考文獻 [1] 鄭學堅 , 周斌 . 微型計算機原理及應用 . 清華大學出版社 ,2003 [2] 李廣弟 , 朱月秀，王秀山 . 單片機基礎 . 北京航空航天大學出版社 ,2001 [3] 房小翠 . 單片微型計算機與機電接口技術 . 國防工業(yè)出版社 ,2002 [4] 王小明 . 電動機的單片機控制 . 北京航空航天大學出版社 ,2002 [5] 李建勇 . 機電一體化技術 . 科學出版社 .2004 [6] 王愛玲，白恩遠，趙學良 . 現(xiàn)代

41、數(shù)控機床 . 國防工業(yè)出版社 ,2001 [7] 徐灝 . 機械設計手冊（ 3） . 機械工業(yè)出版社 ,2003 [8] 張建民 . 機電一體化系統(tǒng)設計 . 北京理工出版社 ,2004 [9] 徐灝等 . 機械設計手冊 [M]. 北京 : 機械工業(yè)出版社 ,2000 [10] 濮良貴 , 記名剛 . 機械設計 [M]. 北京 : 高等教育出版社 ,2003 [11] 吳振彪 . 機電綜合設計指導 [M]. 湛江 : 湛江海洋大學 ,1999 [12] . 楊入清 . 現(xiàn)代機械設計—系統(tǒng)與結構 [M]. 上海 : 上?？茖W技術文獻出版 社,2000 [13] . 張立勛 , 孟慶鑫 , 張今瑜 . 機電一體化系統(tǒng)設計 [M]. 哈爾濱 : 哈爾濱工程大學 出版社 ,2000 21 / 21