運(yùn)動(dòng)芯片LM629通過8位數(shù)據(jù)線和6根控制線與單片機(jī)PIC16F877的I/O口相連。單片機(jī)通過數(shù)據(jù)線向LM629發(fā)送位置或速度命令、設(shè)定PID調(diào)節(jié)參數(shù),并從LM629中讀取速度、加速度等數(shù)值。LM629輸出的脈寬調(diào)制幅度信號(hào)和方向信號(hào)直接驅(qū)動(dòng)L298N,經(jīng)過功率放大后驅(qū)動(dòng)直流電機(jī)。增量式光電編碼器提供半閉環(huán)控制所需的反饋信號(hào)(A、B、IN),梯形圖發(fā)生器計(jì)算出位置或速度模式下所需控制的運(yùn)動(dòng)軌跡。PIC16F877為LM629提供加速度、速度和目標(biāo)位置量,在每個(gè)采樣周期用這些值來計(jì)算出新的命令和位置給定值,將其作為指令值。由增量式光電編碼器檢測電機(jī)的實(shí)際位置,其輸出信號(hào)經(jīng)過LM629四倍頻后進(jìn)行解碼,形成位置反饋值。指令值與反饋值的差值作為數(shù)字PID校正環(huán)節(jié)的輸入。通過數(shù)字調(diào)節(jié)器PID計(jì)算,LM629輸出脈寬調(diào)制信號(hào)PWMM和方向信號(hào)PWMS用于控制功率芯片L298N,進(jìn)而驅(qū)動(dòng)電機(jī)運(yùn)動(dòng)到指定的位置。LM629在進(jìn)行位置控制的同時(shí),還對(duì)速度進(jìn)行控制。LM629在接受到主機(jī)送來的位置信號(hào)后,按梯形圖生成加速、勻速、減速的速度曲線,曲線與坐標(biāo)橫軸所包圍的面積就是指定的位置。PID算法中的比例、積分和微分系數(shù)有時(shí)需要進(jìn)行修改,因此將它們存儲(chǔ)在單片機(jī)的E2PROM中。單片機(jī)和PC機(jī)通過無線發(fā)射和接收模塊進(jìn)行串行通信。 6.3 控制系統(tǒng)的程序 我介紹的是LM629的程序,程序的主要過程是想讓機(jī)械手由原位→機(jī)械手前伸→機(jī)械手上升→機(jī)械手抓取并夾緊→機(jī)械手后退→機(jī)械手前進(jìn)(小車)→小車停止→機(jī)械手左轉(zhuǎn)90°→機(jī)械手前伸→機(jī)械手松開→機(jī)械手后退(小車)→機(jī)械手下降→機(jī)械手右轉(zhuǎn)90°→小車后退→退至原位 程序開始首先將工序控制寄存器R2清零,將工序模擬顯示燈清零即將P1口清零。然后在程序段STA檢測P2口的輸入情況,如果某一位假設(shè)P2.2為高電平,就轉(zhuǎn)到該位對(duì)應(yīng)的按鍵所控制的下一段程序NEXT2處執(zhí)行,先調(diào)用一延時(shí)10ms子程序,然后重新判斷該位是否還為高電平,否,就返回STA重新檢測,是,就繼續(xù)執(zhí)行下一步,判斷該為是否變?yōu)榈碗娖剑瘢驮诖说却涉I,是,就將該加工方法的工序模擬信號(hào)所在的表格標(biāo)號(hào)TAB2送查表基址DPTR,然后轉(zhuǎn)到主程序端LOOP執(zhí)行。
主程序清單如下: ORG 0000H LJMP MAIN ORG 0030H MAIN:MOV R2,#00H ;將工序控制寄存器零 MOV P1,#00H ;將P1口清零 MOV R0,#00H ;將寄存器R0清零 STA: JB P2.0,NEXT1 ;判斷哪個(gè)按鍵被按下就 JB P2.1,NEXT2 轉(zhuǎn)到應(yīng)程序段處執(zhí)行 JB P2.2,NEXT3 JB P2.3,NEXT4 JB P2.4,NEXT5 LJMP STA NEXT1:LCALL DLS10MS ;調(diào)用延時(shí)10ms子程序 JNB P2.0, STA ;P2.0=0就返回重新判斷 JB P2.0, $ ;P2.0=1等待松鍵 MOV DPTR, #TAB1 ;將表首址給查表基址DPTR LJMP LOOP ;轉(zhuǎn)到LOOP程序段 NEXT2:LCALL DLS10MS JNB P2.1, STA JB P2.1, $ MOV DPTR, #TAB2 LJMP LOOP NEXT3:LCALL DLS10MS JNB P2.2, STA JB P2.2, $ MOV DPTR, #TAB3 LJMP LOOP NEXT4:LCALL DLS10MS JNB P2.3,STA JB P2.3,$ MOV DPTR,#TAB4 LJMP LOOP NEXT5:LCALL DLS10MS JNB P2.4,STA JB P2.4,$ MOV DPTR,#TAB5 LJMP LOOP LOOP:MOV A,R2 ;將R2的值給A MOVC A,@A+DPTR ;查表將查出的值送到A中 MOV P1,A ;將A中的數(shù)送P1口輸出 INC R2 ;R2自加一 MOV 79H,R2 ;將R2的值送輸出緩沖79H PUSH DPH ;保護(hù)現(xiàn)場 PUSH DPL LCALL DISP ;調(diào)用數(shù)碼顯示子程序 LCALL DLS5S ;調(diào)用延時(shí)5s子程序 POP DPL ;恢復(fù)現(xiàn)場 POP DPH CJNE R2,#08H,LOOP ;八步未完成就返回LOOP JB P2.5,MAIN ;停止按鈕按下就返回MAIN MOV R2,#00H ;將R2清零 LJMP LOOP ;轉(zhuǎn)到LOOP 第七章 設(shè)計(jì)體會(huì) 通過這次畢業(yè)設(shè)計(jì)使我加深了對(duì)過去所學(xué)知識(shí)的理解,真正懂得了如何把松散的知識(shí)有機(jī)的結(jié)合起來,并靈活運(yùn)用,并且在老師和同學(xué)的幫助下讓我懂得了如何去面對(duì)設(shè)計(jì)方案,如何下手,應(yīng)該從哪些方面去考慮問題。 懂得考慮問題時(shí)應(yīng)該由淺入深,從簡到易。在分析問題時(shí)應(yīng)該先抓住重點(diǎn),然后再考慮其他細(xì)節(jié)。知道什么是主要的,什么是次要的。當(dāng)我做機(jī)械手的設(shè)計(jì)時(shí),首先考慮自動(dòng)控制,其次才考慮手動(dòng)控制。在考慮自動(dòng)控制時(shí)又先考慮的是機(jī)械手要完成哪些動(dòng)作,應(yīng)該如何實(shí)現(xiàn)。從而經(jīng)過仔細(xì)思考確定設(shè)計(jì)方案。 遇到問題時(shí),千萬不能慌,應(yīng)當(dāng)保持大腦清醒,不急不躁,通過查找資料逐一解決問題。 做畢業(yè)設(shè)計(jì)時(shí)很重要的一點(diǎn)就是要學(xué)會(huì)自己查找資料。通過經(jīng)常翻翻參考書籍,有目的的選擇自己想要的東西,拓寬一下自己的思路,找到解決問題的方法,使自己在做設(shè)計(jì)的時(shí)候有更多的選擇。 總之,通過這次畢業(yè)設(shè)計(jì)使我受益非淺。我感謝學(xué)校給我這次鍛煉機(jī)會(huì),使我在踏上社會(huì),工作崗位之前又給了我一次很好的磨練。 再次感謝所有支持和幫助過我的領(lǐng)導(dǎo)、老師、同學(xué)們。
第八章 參考文獻(xiàn) 1.吳宗澤. 機(jī)械設(shè)計(jì). 第2版. 北京: 中央廣播電視大學(xué)出版社 ,1998 2.盧頌峰. 機(jī)械設(shè)計(jì)課程設(shè)計(jì)手冊. 第1版. 北京:中央廣播電視大學(xué)出版社 , 1998 3.左健民. 液壓與氣動(dòng)傳動(dòng). 第2版. 北京:機(jī)械工業(yè)出版社,2006 4.齊占慶. 機(jī)床電氣控制技術(shù). 第2版. 北京: 機(jī)械工業(yè)出版社, 2004 5.楊長能, 張興毅. 可編程序控制器基礎(chǔ)及應(yīng)用. 第1版. 重慶:重慶大學(xué)出版社,1998 6.楊黎明. 機(jī)械零件設(shè)計(jì)手冊. 第1版. 北京: 國防工業(yè)出版社,1986 7.羅洪量. 機(jī)械原理課程設(shè)計(jì)指導(dǎo)書. 第2版. 北京: 高等教育出版社,1986 8.JJ.杰克(美). 機(jī)械與機(jī)構(gòu)的設(shè)計(jì)原理. 第1版. 北京: 機(jī)械工業(yè)出版社,1985 9.喬?hào)|凱. 機(jī)械手及其應(yīng)用. 第2版. 北京:機(jī)械工業(yè)出版社,1998 10.黃崇林. 液壓元件樣本. 第2版. 北京: 機(jī)械工業(yè)部 ,2001 11.曲忠萍. 液壓系統(tǒng)設(shè)計(jì)簡明手冊.第1版. 北京: 機(jī)械工業(yè)出版社,2001
首頁 上一頁 3 4 5 6 下一頁 尾頁 6/6/6
本站部分文章來自網(wǎng)絡(luò),如發(fā)現(xiàn)侵犯了您的權(quán)益,請聯(lián)系指出,本站及時(shí)確認(rèn)刪除 E-mail:349991040@qq.com
論文格式網(wǎng)(www.donglienglish.cn--論文格式網(wǎng)拼音首字母組合)提供其他論文畢業(yè)論文格式,論文格式范文,畢業(yè)論文范文