機(jī)電一體化系統(tǒng)綜合課程設(shè)計說明書

1、機(jī)電一體化系統(tǒng)課程設(shè)計X-Y數(shù)控工作臺設(shè)計說明書學(xué)校名稱：湖北文理學(xué)院班級學(xué)號：2013279129學(xué)生姓名：張亮班級:機(jī)電13212015年 11月、總體方案設(shè)計1.1 設(shè)計任務(wù)設(shè)計一個數(shù)控 X Y 工作臺及其控制系統(tǒng) .該工作臺可用于銑床上坐標(biāo)孔的加工和臘摸、塑 料、鋁合金零件的二維曲線加工 ，重復(fù)定位精度為土 0。01mm，定位精度為0。025mm。設(shè)計參數(shù)如下：負(fù)載重量 G=150N ；臺面尺寸 C x B x H = 145mm x 160mm x 12mm ;底座外 形尺寸 C1 x B1 x H1 = 210mm x 220mm x 140mm;最大長度 L=388mm ;工作臺

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

3、實(shí)現(xiàn)。LED 顯示數(shù)控工作臺的狀態(tài)。（3）X-Y 工作臺的傳動方式 為保證一定的傳動精度和平穩(wěn)性，又要求結(jié)構(gòu)緊湊，所以選用絲杠螺母傳動副。為提高傳 動剛度和消除間隙 ，采用預(yù)加負(fù)荷的結(jié)構(gòu)。由于工作臺的運(yùn)動載荷不大，因此采用有預(yù)加載荷的雙 V 形滾珠導(dǎo)軌。采用滾珠導(dǎo)軌可減 少兩個相對運(yùn)動面的動、靜摩擦系數(shù)之差，從而提高運(yùn)動平穩(wěn)性，減小振動?？紤]電機(jī)步距角和絲桿導(dǎo)程只能按標(biāo)準(zhǔn)選取，為達(dá)到分辨率的要求，需采用齒輪降速傳動圖 1-1 系統(tǒng)總體框圖、機(jī)械系統(tǒng)設(shè)計2.1、工作臺外形尺寸及重量估算X向拖板（上拖板）尺寸：長寬高145 X 160 X 50重量：按重量=體積X材料比重估算NY向拖板（下拖板）尺

4、寸：重量:約90N。上導(dǎo)軌座（連電機(jī)）重量：夾具及工件重量：約150N。X-Y工作臺運(yùn)動部分的總重量：約287N.2。2、滾動導(dǎo)軌的參數(shù)確定、導(dǎo)軌型式：圓形截面滾珠導(dǎo)軌、導(dǎo)軌長度 上導(dǎo)軌（X向）取動導(dǎo)軌長度動導(dǎo)軌行程支承導(dǎo)軌長度 下導(dǎo)軌（Y向）選擇導(dǎo)軌的型號：GTA16、直線滾動軸承的選型 上導(dǎo)軌 下導(dǎo)軌由于本系統(tǒng)負(fù)載相對較小，查表后得出LM10UUO型直線滾動軸承的額定動載荷為370N,大于實(shí)際動負(fù)載；但考慮到經(jīng)濟(jì)性等因素最后選擇LM16UUO型直線滾動軸承。并采用雙排兩列4個直線滾動軸承來實(shí)現(xiàn)滑動平臺的支撐。、滾動導(dǎo)軌剛度及預(yù)緊方法當(dāng)工作臺往復(fù)移動時，工作臺壓在兩端滾動體上的壓力會發(fā)生變化

5、，受力大的滾動體變 形大，受力小的滾動體變形小。當(dāng)導(dǎo)軌在位置I時，兩端滾動體受力相等，工作臺保持水平； 當(dāng)導(dǎo)軌移動到位置n或川時，兩端滾動體受力不相等，變形不一致，使工作臺傾斜 a角，由此造成誤差。此外，滾動體支承工作臺，若工作臺剛度差，則在自重和載荷作用下產(chǎn)生彈性變 形，會使工作臺下凹（有時還可能出現(xiàn)波浪形），影響導(dǎo)軌的精度.2。3、滾珠絲杠的設(shè)計計算滾珠絲杠的負(fù)荷包括銃削力及運(yùn)動部件的重量所引起的進(jìn)給抗力。應(yīng)按銃削時的情況計算。、最大動負(fù)載Q的計算查表得系數(shù)，,壽命值查表得使用壽命時間 T=15000h,初選絲杠螺距t=4mm得絲杠轉(zhuǎn)速 所以X向絲杠牽引力Y向絲杠牽引力所以最大動負(fù)荷X向Y

6、向查表，取滾珠絲杠公稱直徑，選用滾珠絲杠螺母副的型號為SFK1004,其額定動載荷為 390N,足夠用。、滾珠絲杠螺母副幾何參數(shù)計算表2-1滾珠絲杠螺母副幾何參數(shù)名稱符號計算公式和結(jié)果螺紋滾道公稱直徑10螺距接觸角鋼球直徑螺紋滾道法面半徑偏心距螺紋升角螺桿螺桿外徑螺桿內(nèi)徑螺桿接觸直徑螺母螺母螺紋外徑螺母內(nèi)徑（外循環(huán)）見表2-1 o、傳動效率計算式中： 摩擦角； 絲杠螺紋升角。、剛度驗(yàn)算 滾珠絲杠受工作負(fù)載 P引起的導(dǎo)程的變化量Y向所受牽引力大，故應(yīng)用Y向參數(shù)計算 所以絲杠因受扭矩而引起的導(dǎo)程變化量很小，可以忽略.所以導(dǎo)程總誤差查表知E級精度的絲杠允許誤差，故剛度足夠.、穩(wěn)定性驗(yàn)算 由于絲杠兩端

7、采用止推軸承，故不需要穩(wěn)定性驗(yàn)算2o 4、步進(jìn)電機(jī)的選用、步進(jìn)電機(jī)的步距角 取系統(tǒng)脈沖當(dāng)量，初選步進(jìn)電機(jī)步距角。、步進(jìn)電機(jī)啟動力矩的計算設(shè)步進(jìn)電機(jī)等效負(fù)載力矩為T,負(fù)載力為P,根據(jù)能量守恒原理，電機(jī)所做的功與負(fù)載力做功有如下關(guān)系式中： 一一電機(jī)轉(zhuǎn)角；一一移動部件的相應(yīng)位移；一一機(jī)械傳動效率。若取，貝嘰且，所以式中： 一一移動部件負(fù)載（N）;G 移動部件重量（N）;與重量方向一致的作用在移動 部件上的負(fù)載力（N）;-導(dǎo)軌摩擦系數(shù)；一一步進(jìn)電機(jī)步距角，（rad） ; T-電機(jī)軸負(fù)載力 矩（）本例中，?。ù慊痄摑L珠導(dǎo)軌的摩擦系數(shù)），為絲杠牽引力，考慮到重力影響，Y向電機(jī)負(fù)載較大，因此取，所以若不考慮

8、啟動時運(yùn)動部件慣性的影響，則啟動力矩取安全系數(shù)為0。3，則對于工作方式為三相六拍的三相步進(jìn)電機(jī)、步進(jìn)電機(jī)的最高工作頻率查表選用兩個45BF005H型步進(jìn)電機(jī)。電機(jī)的有關(guān)參數(shù)見表22。表2 2 步進(jìn)電機(jī)參數(shù)型號主要技術(shù)數(shù)據(jù)外形尺寸重量步距 角最大 靜轉(zhuǎn)距最咼空載 啟動頻率（）相 數(shù)電壓電流外徑長度軸徑45BF005n1.519。630003272。545584112.5、確定齒輪傳動比因步進(jìn)電機(jī)步距角，滾珠絲杠螺距，要實(shí)現(xiàn)脈沖當(dāng)量，在傳動系統(tǒng)中應(yīng)加一對齒輪降速傳動.齒輪傳動比選 ，。2。6、確定齒輪模數(shù)及有關(guān)尺寸因傳遞的扭距較小，取模數(shù)，齒輪有關(guān)尺寸見表3-3。2.7、步進(jìn)電機(jī)慣性負(fù)載的計算表2

9、 3齒輪尺寸17281728193014。525。55517。5根據(jù)等效轉(zhuǎn)動慣量的計算公式，得式中：折算到電機(jī)軸上的慣性負(fù)載（）；一一步進(jìn)電機(jī)轉(zhuǎn)軸的轉(zhuǎn)動慣量（）;-齒輪 的 轉(zhuǎn)動慣量 ( ); 齒輪 的轉(zhuǎn)動慣量 ( )；滾珠絲杠的轉(zhuǎn)動慣量 ( )；M -移動部件質(zhì)量 ( )。 對材料為鋼的圓柱零件轉(zhuǎn)動慣量可按下式估算式中：D一一圓柱零件直徑(cm); L零件長度(cm)o所以 電機(jī)軸轉(zhuǎn)動慣量很小，可以忽略，則 因?yàn)?，所以慣性匹配比較符合要求。三、控制系統(tǒng)硬件設(shè)計X Y數(shù)控工作臺控制系統(tǒng)硬件主要包括CPU、傳動驅(qū)動、傳感器、人機(jī)交互界面。硬件系統(tǒng)設(shè)計時，應(yīng)注意幾點(diǎn) :電機(jī)運(yùn)轉(zhuǎn)平穩(wěn)、響應(yīng)性能好、造

10、價低、可維護(hù)性、人機(jī)交 互界面可操作性比較好。3。1 CPU 板3.1.1 CPU 的選擇隨著微電子技術(shù)水平的不斷提高 ,單片微型計算機(jī)有了飛躍的發(fā)展。單片機(jī)的型號很多， 而目前市場上應(yīng)用 MCS51 芯片及其派生的兼容芯片比較多， 如目前應(yīng)用最廣的 8位單片機(jī) 89C51，價格低廉，而性能優(yōu)良，功能強(qiáng)大。在一些復(fù)雜的系統(tǒng)中就不得不考慮使用16位單片機(jī) ,MCS96 系列單片機(jī)廣泛應(yīng)用于伺服系統(tǒng)，變頻調(diào)速等各類要求實(shí)時處理的控制系統(tǒng)，它具有較強(qiáng)的運(yùn)算和擴(kuò)展能力.但是定位合理的單片機(jī)可以節(jié)約資源，獲得較高的性價比 .從要設(shè)計的系統(tǒng)來看 ，選用較老的 8051 單片機(jī)需要拓展程序存儲器和數(shù)據(jù)存儲器

11、，無疑提高了設(shè)計價格，而選用高性能的 16 位 MCS96 又顯得過于浪費(fèi)。生產(chǎn)基于 51 為內(nèi)核的單片 機(jī)的廠家有In tel、ATMEL、Sime ns,其中在CMOS器件生產(chǎn)領(lǐng)域 ATMEL公司的工藝和封裝 技術(shù)一直處于領(lǐng)先地位 .ATMEL 公司的 AT89 系列單片機(jī)內(nèi)含 Flash 存儲器，在程序開發(fā)過程 中可以十分容易的進(jìn)行程序修改,同時掉電也不影響信息的保存；它和80C51 插座兼容,并且采用靜態(tài)時鐘方式可以節(jié)省電能 .因此硬件CPU選用AT89S51,AT表示ATMEL公司的產(chǎn)品，9表示內(nèi)含F(xiàn)lash存儲器，S 表示含有串行下載 Flash 存儲器。AT89S51的性能參數(shù)為

12、：Flash存儲器容量為4KB、16位定時器2個、中斷源6個（看門 狗中斷、接收發(fā)送中斷、外部中斷 0、外部中斷 1、定時器 0和定時器 1 中斷）、 RAM 為 128B、 14位的計數(shù)器 WDT、I/O 口共有32個。3。1.2 CPU 接口設(shè)計CPU 接口部分包括傳感器部分、傳動驅(qū)動部分、人機(jī)交互界面三部分。示意圖如下所圖3-1 CPU外部接口示意圖AT89S51要完成的任務(wù)：(1) 將行程開關(guān)的狀態(tài)讀入CPU,通過中斷進(jìn)行處理，它的優(yōu)先級別最高(2) 通過程序?qū)崟r控制電機(jī)和電磁鐵的運(yùn)行(3) 接受鍵盤中斷指令，并響應(yīng)指令，將當(dāng)前行程開關(guān)狀態(tài)和鍵盤狀態(tài)反應(yīng)到LED上， 實(shí)現(xiàn)人機(jī)交互作用。

13、由于AT89S51只有P1 口和P3 口是準(zhǔn)雙向口，但P3 口主要以第二功能為主， 并且在系統(tǒng) 中要用到第二功能的中斷口， 因此要進(jìn)行I/O擴(kuò)展?？紤]到電路的簡便性和可實(shí)現(xiàn)性，實(shí)際中采用內(nèi)部自帶鎖存器的 8155，所以AT89S51的I/O 口線分配如下：(1)P1。0-P1.5控制X Y兩個方向步進(jìn)電機(jī)的 A、B、C線圈通電，形成 A AB B BC-C-CA A三相六拍正轉(zhuǎn)模式和 AAC C-CB B-BA-A 的反轉(zhuǎn)模式。(2)P1。6 口輸出控制電磁鐵的吸合。(3 )P3.2和P3o3兩個中斷源中INT0優(yōu)先級最高，它讀入行程開關(guān)的狀態(tài)并觸發(fā)中斷；INT1讀入點(diǎn)動、復(fù)位、圓弧插補(bǔ)開關(guān)的

14、狀態(tài)而觸發(fā)中斷。(4) P0。0-P0o 7外部I/O擴(kuò)展的數(shù)據(jù)讀取.P2.7 和 P2.6 決定 8155 的 PA、PB、PC 口的地址。圖3-2AT89S51控制系統(tǒng)圖PB 口接LED反映當(dāng)前運(yùn)行的 8個狀態(tài):X+禁止、X-禁止、Y+禁止、Y 禁止、手動 X+ 運(yùn)行、手動X 運(yùn)行、手動 Y+運(yùn)行、手動 Y 運(yùn)行。PA 口低四位反映觸發(fā)中斷 1的4個行程開關(guān)的狀態(tài)。PC 口低6位反映了觸發(fā)中斷 2的手動X+運(yùn)行、手動X-運(yùn)行、手動Y+運(yùn)行、手動Y 運(yùn) 行、復(fù)位（RST）、圓弧插補(bǔ)6個開關(guān)的狀態(tài)。3。2驅(qū)動系統(tǒng)傳動驅(qū)動部分包括步進(jìn)電機(jī)的驅(qū)動和電磁鐵的驅(qū)動，步進(jìn)電機(jī)須滿足快速急停、定位和退刀時

15、 能快速運(yùn)行、工作時能帶動工作臺并克服外力（如切削力、摩擦力）并以指令的速度運(yùn)行。在定位 和退刀時電磁鐵吸合使繪筆抬起，繪圖時能及時釋放磁力使筆尖壓下。3.2.1 步進(jìn)電機(jī)驅(qū)動電路和工作原理步進(jìn)電機(jī)的速度控制比較容易實(shí)現(xiàn)，而且不需要反饋電路設(shè)計時的脈沖當(dāng)量為 0。01mm,步進(jìn)電機(jī)每走一步，工作臺直線行進(jìn)0。01mm。步進(jìn)電機(jī)驅(qū)動電路中采用了光電偶合器，它具有較強(qiáng)的抗干擾性，而且具有保護(hù) CPU的作用，當(dāng)功放電路出現(xiàn)故障時，不會將大的電壓加在 CPU上使其燒壞。圖3 4 步進(jìn)電機(jī)驅(qū)動電路圖該電路中的功放電路是一個單電壓功率放大電路，當(dāng)A相得電時，電動機(jī)轉(zhuǎn)動一步。 電路中與繞組并聯(lián)的二極管 D起

16、到續(xù)流作用，即在功放管截止是，使儲存在繞組中的能量通過二 極管形成續(xù)流回路泄放，從而保護(hù)功放管。與繞組W串聯(lián)的電阻為限流電阻，限制通過繞組的電流不至超過額定值，以免電動機(jī)發(fā)熱厲害被燒壞 由于步進(jìn)電機(jī)采用的是三相六拍的工作方式（三個線圈A、B、C），其正轉(zhuǎn)的通電順序?yàn)椋篈-AB-B BC C-CA A,其反轉(zhuǎn)的通電順序?yàn)?:A AC C-CB B-BA A。步進(jìn)時鐘 jLrLrLTLmmmrLrLrwLA相波形B相波形C相波形圖3-5 三相六拍工作方式時相電壓波形（正轉(zhuǎn)）322電磁鐵驅(qū)動電路該驅(qū)動電路也采用了光電偶合器，但其功放電路相對簡單。 其光電偶合部分采用的是達(dá)林頓管，因?yàn)轵?qū)動電磁鐵的電流

17、比較大。圖3-6 電磁鐵驅(qū)動電路3。2.3電源設(shè)計兩電機(jī)同時工作再加上控制系統(tǒng)用電，所需電源容量比較大，需要選擇大容量電源。此系統(tǒng)中用到的電源電壓為 27V、12V、5V，為了便于管理和電源容量需求，就采用了標(biāo)準(zhǔn)的 27V電源作為基準(zhǔn)，通過芯片進(jìn)行電壓轉(zhuǎn)換得到所需的12V和5V電壓.圖3 7電源轉(zhuǎn)換電路圖電路中在轉(zhuǎn)換芯片的前后有兩個電容，前面電容起防止自激作用，后面電容起濾波作用。此外，在具體應(yīng)用的過程中，LM7805必須加上散熱片。3。3傳感器和人機(jī)界面由于步進(jìn)電機(jī)不需要反饋電路，但是要注意工作臺不能超過最大行程。因此，必須在X、Y軸的方向各加上兩個行程開關(guān)。這里行程開關(guān)作用有兩個：（1）防

18、止工作臺超過最大行程，使電機(jī)損壞（2）可以用與定位所以這4個行程開關(guān)就充當(dāng)了傳感器。人機(jī)界面設(shè)計的準(zhǔn)則就是要有良好的人機(jī)交互能力，一般要求操作簡便，界面簡潔明了。此系統(tǒng)中共有9個LED，LED1燈亮表示X軸負(fù)方向禁止通行，LED2燈亮表示X軸正方向禁 止通行，LED3燈亮表示Y軸負(fù)方向禁止通行，LED4燈亮表示Y軸正方向禁止通行 丄ED5燈 亮表示手動使工作臺向 X軸負(fù)方向通行，LED6燈亮表示手動使工作臺向 X軸正方向通行，LED7 燈亮表示手動使工作臺向Y軸負(fù)方向通行，LED8燈亮表示手動使工作臺向 Y軸正方向通行，LED9亮表示系統(tǒng)通電運(yùn)行.界面上的7個按扭意義為：按扭 1是通斷電開關(guān)，

19、按扭2是向X軸負(fù)方向運(yùn)行的點(diǎn)動開關(guān)， 按扭3是向X軸正方向運(yùn)行的點(diǎn)動開關(guān)，按扭4是向Y軸負(fù)方向運(yùn)行的點(diǎn)動開關(guān)，按扭5是向Y軸正方向運(yùn)行的點(diǎn)動開關(guān)，按扭6是復(fù)位開關(guān)，按扭 7是執(zhí)行繪制圓弧開關(guān)。圖3 8 人機(jī)界面圖3。4 本章小節(jié)本章著重介紹了數(shù)控工作臺控制系統(tǒng)的硬件設(shè)計。CPU板介紹了 CPU的選擇及其外圍的接口設(shè)計和控制流程；驅(qū)動系統(tǒng)介紹了步進(jìn)電機(jī)和電磁鐵的驅(qū)動電路設(shè)計 ；此外還敘述了人機(jī)界面各 個按扭和LED的意義。四、控制系統(tǒng)軟件設(shè)計4.1總體方案對于AT89S51的程序設(shè)計，由于所需實(shí)現(xiàn)的功能較簡單，采用匯編的形式。編譯器采用Keil 7 。02b。該編譯器是51系列單片機(jī)程序設(shè)計的常

20、用工具，既可用匯編，也支持C語言編譯。同時具有完善的調(diào)試功能。4。2主流程圖CTLEQU3FF8HPAEQU3FF9HPBEQU3FFAHPCEQU3FFBHCMDEQU02HORG0000HAJMPMAINORG0003HAJMPINT0IS;外部中斷0入口ORG000BHAJMPTM0IS;定時器0中斷入口ORG0013HAJMPINT1IS;外部中斷1入口ORG001BHAJMPTM1IS;定時器1中斷入口ORG0100HMAIN : ANLP1， 0EFHSETBIT0;外中斷負(fù)跳沿觸發(fā)SETB；IT1MOVA,CTLMOVDPTR，AMOVX DPTR,CMD；A 口輸入，B，口輸出

21、，C 口輸入SETBEX0 ;允許外中斷0SETBEX1;允許外中斷1SETBPX0SETBPX1 ;設(shè)置優(yōu)先級SETBEA;開總中斷LOOP: AJMP LOOP ;等待中斷在等待中斷的過程中，如果有中斷到來，先檢查中斷0的狀態(tài),是中斷0則進(jìn)入中斷0的中斷服務(wù)INT0IS，是中斷1則進(jìn)入中斷1的中斷服務(wù)INT1IS.中斷服務(wù)0是由4個行程開關(guān)觸發(fā)的，它觸發(fā)后通過單片機(jī)讀取PA口內(nèi)容，然后將結(jié)果反饋到PB 口的LED上。中斷服務(wù) 1 有 6 個中斷源，這六個中斷源分別是手動 X 正方向運(yùn)行，手動 X 負(fù)方向運(yùn)行， 手動 Y 正方向運(yùn)行，手動 Y 負(fù)方向運(yùn)行，復(fù)位和繪制圓弧。4。3 INT0 中

22、斷服務(wù)流程圖INT0IS ：PUSHACCPUSHDPTLPUSHDPTHPUSHPSWMOVA,PAMOVDPTR,AMOVXA, DPTR；讀 PA 口內(nèi)容MOVR2，AMOVA，PBMOVDPTR,AMOVDPTR,R2MOVA，R2CPLA； A 取反ANLA ， 03H；屏蔽高 6 位JZA ， TM2CSETBP1.0SETBP1.1SETBP1。2TM2C ：MOVA，R2CPLAANLA ， 0CHJZA ， RETINSETBP1 。 3圖 4 2SETBP1 。 4SETBP1.5RETIN:POPPSWPOPDPTHPOPDPTLPOPACCRETI4。4INT1中斷服務(wù)

23、流程圖INT1IS：CLREX1MOVA ,DPTRPUSHACCJNBACC.4 ， RSTPUSHPSWJNBACC 。 0,X+ENPUSHDPTLJNBACC。 1， X-ENPUSHDPTHJNBACC 。 2， Y+ENCLRP1.6JNBACC 。 3,YENMOVA，PCJNBACC 。 5， ARCMOVDPTR ，ALOOP1 ：POPDPTHMOVXA, DPTR;讀 PC 口內(nèi)容POPDPTLMOVR1 ， APOPPSWANLR1， 0FHPOPACCMOVA， PBSETBEX1MOVDPTR ， ARETIMOVA, DPTR ;讀 PB 口內(nèi)容ANLA ， #0

24、FHSWAPAORLA， R1MOVR2,AMOVA， PBMOVDPTR ， AMOVX DPTR , R2 ;數(shù)據(jù)輸入 PB 口INCDPTL4.4 。1 復(fù)位程序流程圖DIRXDIRYEQU 30HEQU 31HRST:CLRP1。6RPA：MOVA,PAMOVDPTR,AMOVXA , DPTR;讀 PA 口內(nèi)容JNBACC 。 0,ACC2MOVDIRX ， 00H;表 X 電機(jī)反轉(zhuǎn)ACALLXMOTOR0; X 電機(jī)反轉(zhuǎn)一步ACC2 ：JNBACC.2 ， LOOP0MOVDIRY ， #00H;表 Y 電機(jī)反轉(zhuǎn)ACALLYMOTOR0; Y 電機(jī)反轉(zhuǎn)一步AJMPRPALOOP0：

25、AJMPLOOP14.4 。2 X 軸電機(jī)點(diǎn)動正轉(zhuǎn)程序流程圖X+EN ： CLRMOVMOVMOVXJNBMOTOR0 ： MOVACALLMOVMOVMOVJNBLOOP2: AJMPP1.6A，PADPTR，AA , DPTRACC 。0， LOOP2DIRX ， 01HXMOTOR0A， PCDPTR， AA， DPTRACC 。0， MOTOR0LOOP1這是 X 軸電機(jī)點(diǎn)動正轉(zhuǎn)的程序，其他的 X 軸電機(jī)點(diǎn)動反轉(zhuǎn)、 Y 軸電機(jī)點(diǎn)動正轉(zhuǎn)、 Y 軸電機(jī) 點(diǎn)動反轉(zhuǎn)依次類推 .4。4.3繪制圓弧程序流程圖圖 4 6 逐點(diǎn)比較法畫圓弧逐點(diǎn)比較法原理：假設(shè)所畫圓弧在第一象限，圓心坐標(biāo)為 （0,0），圓弧上點(diǎn)的坐標(biāo)為（ X ，Y ）， 圓弧半徑為 R,每一點(diǎn)的坐標(biāo)偏差為F=X * X+Y * Y R*R，若F0，應(yīng)沿X軸負(fù)方向走一步此時 FX=（X-1）* （X-1）+Y*Y-R