Q編程介紹及例程
Q編程介紹
SCL指令的使用已經(jīng)有很多年的歷史。Q程序是建立在SCL指令基礎之上的一個(gè)新的平臺,擴展了SCL命令的使用,允許用戶(hù)創(chuàng )建與存儲SCL指令。這些程序可以保存在驅動(dòng)器的非易失性存儲器中,驅動(dòng)可以脫離主機獨立運行這些程序。Q程序為系統設計提供了高度的靈活性和強大的功能。主要特點(diǎn)如下:• 運動(dòng)控制(例如FL、FP、SH等)
• 執行駐留程序
• 多任務(wù)處理(請參閱MT指令)
• 條件判斷(例如OI、TI等指令)
• 數學(xué)運算(例如R+、R-、R*、R/、R|、R&等指令)
• 寄存器操作(例如RX、RM等指令)
1個(gè)Q程序支持多達12個(gè)程序段,每個(gè)程序段最多可以編寫(xiě)62條指令。
Q Programmer 軟件下載
參考例程
以下內容給出了Q編程的參考例程,并對這些指令逐條進(jìn)行了解釋?zhuān)琎編程中所有指令均為緩存指令(Buffered Commands)點(diǎn)到點(diǎn)相對運動(dòng)(Feed to Length)
FL(Feed to Length)指令用來(lái)完成點(diǎn)到點(diǎn)相對位置運動(dòng),當執行該指令時(shí),電機將按照設定的加速度(AC),減速度(DE)及運行速度(VE),完成一段固定的相對位置距離(DI)。電機轉動(dòng)的方向由DI指令的正負極性決定。比如,DI32000 代表電機順時(shí)針轉動(dòng)32000步(或微步),而DI-32000代表電機逆時(shí)針轉動(dòng)32000步(或微步)。上圖中列出了一個(gè)參考例程,Q程序通過(guò)WI指令首先等待輸入口3接收一個(gè)下降沿觸發(fā)信號,如果條件滿(mǎn)足,電機將按照20 轉/秒的轉速,轉動(dòng)4圈;如果條件不滿(mǎn)足,程序將一直停留在WI指令處等待輸入口3接收正確的觸發(fā)信號為止 點(diǎn)到點(diǎn)絕對運動(dòng)(Feed to Position)
FP(Feed to Position)指令用來(lái)完成點(diǎn)到點(diǎn)絕對位置運動(dòng),當執行該指令時(shí),電機將按照設定的加速度(AC),減速度(DE)及運行速度(VE),完成一段絕對位置距離(DI)。DI指令代表目標絕對位置,電機轉動(dòng)方向不由其正負極性決定,而由電機當前絕對位置與目標絕對位置來(lái)決定。上圖中列出了一個(gè)參考例程,Q程序通過(guò)WI指令首先等待輸入口3接收一個(gè)下降沿觸發(fā)信號,如果條件滿(mǎn)足,電機將按照20 轉/秒的轉速,轉動(dòng)4圈,然后等待1秒(WT指令),然后電機以20 轉/秒的轉速回到絕對位置0點(diǎn);如果條件不滿(mǎn)足,程序將一直停留在WI指令處等待輸入口3接收正確的觸發(fā)信號為止。 SP(Set Position)指令用來(lái)設置電機當前的絕對位置,如發(fā)送“SP0”指令,將電機當前位置設為絕對位置零點(diǎn)。注意,SP指令設置的參數是以編碼器Encoder Counts作為基本單位的,比如一個(gè)裝有500線(xiàn)編碼器的電機,一圈有2000個(gè)Encoder Counts,如發(fā)送“SP5000”指令,將電機當前位置設為以絕對位置零點(diǎn)順時(shí)針?lè )较?.5圈的位置。 運動(dòng)到傳感器位置(Feed to Sensor)
FS(Feed to Sensor)指令使電機以一個(gè)固定速度轉動(dòng),直到一個(gè)輸入口的電平狀態(tài)滿(mǎn)足觸發(fā)條件,電機減速,運動(dòng)停止。運動(dòng)參數由AC,DE,VE及DI指令決定,注意DI指令在FS指令執行時(shí)代表輸入口電平狀態(tài)滿(mǎn)足觸發(fā)條件后,電機減速到0的運動(dòng)距離,注意DI設定的減速具體必須大于最小減速距離Dm,最小減速距離由DE,VE,EG指令決定,計算公式如下,其中V代表VE設定值,R代表EG設定值,D代表DE設定值:
注意:當DI設定值大于最小減速距離Dm時(shí),電機接收到輸入口觸發(fā)電平狀態(tài)(找到傳感器)后,會(huì )繼續以當前速度向前運動(dòng)(DI-Dm)的距離,然后以DE設定的減速度減速,直到完成Dm的減速距離。同時(shí),DI指令也決定了電機剛開(kāi)始運動(dòng)的方向,比如,DI8000 代表執行FS指令后,電機順時(shí)針轉動(dòng),而DI-8000代表執行FS指令后,電機逆時(shí)針轉動(dòng)。輸入口電平狀態(tài)分為H(高電平),L(低電平),R(上升沿),F(下降沿)這幾種狀態(tài)。 上圖中列出了一個(gè)參考例程,Q程序通過(guò)WI指令首先等待輸入口3接收一個(gè)下降沿觸發(fā)信號,如果條件滿(mǎn)足,取消限位功能,電機以5轉/秒的轉速順時(shí)針?lè )较蜣D動(dòng),直到輸入口7接收到一個(gè)高電平觸發(fā)狀態(tài),驅動(dòng)器找到了傳感器,于是以DE設定的減速度,DI設定的減速距離完成減速到0。然后電機等待1秒鐘,隨后以20轉/秒的速度運行到絕對位置零點(diǎn)處,打開(kāi)限位功能。 循環(huán)(Looping)
用戶(hù)可以通過(guò)兩種方式來(lái)實(shí)現程序的循環(huán)。第一種使用QG(Queue Goto)指令,設置QG參數使程序回到設定的行數。下圖中列出了一個(gè)參考例程,在FL指令后等待時(shí)間0.5秒(WT0.5),然后使用QG指令,使程序回到第一行重新執行,實(shí)現不斷循環(huán)。
第二種方法是使用QR(Queue Repeat)指令,QR指令指明跳轉到哪一行和循環(huán)次數。下圖中列出了一個(gè)參考例程,QR指令表示跳轉到第二行,參數為3,即循環(huán)次數由用戶(hù)自定義寄存器3中的值決定,在這里RX指令寫(xiě)入數值5到自定義寄存器3, 所以程序循環(huán)執行5次。
跳轉(Jumping)
程序跳轉由QJ(Queue Jump)指令實(shí)現,跳轉和循環(huán)不同,跳轉主要判斷條件是否滿(mǎn)足,即跳轉指令通常和TI(輸入檢測),TR(寄存器檢測),CR(寄存器比較)指令配合使用。下圖中列出了一個(gè)參考例程,有兩種可能的運動(dòng),順時(shí)針旋轉,當輸入信號5有效時(shí)(低電平有效)電機開(kāi)始逆時(shí)針旋轉,加速度300,減速度450,速度18.5,兩種運動(dòng)間有0.25秒的等待時(shí)間。然后,檢測X5信號的狀態(tài),當 X5信號有效時(shí)(True),程序跳轉到第10行,開(kāi)始逆時(shí)針旋轉,如果X5信號為高時(shí)程序直接到第7行進(jìn)行順時(shí)針旋轉,執行完后回到第一行進(jìn)行循環(huán)。
