產(chǎn)品詳情
角度控制元件 ISI222 主程序
LD SM0.1 //掃描為1
R Q0.0，1 //復位映像寄存器位
CALL 0 //調(diào)用子程序0，初始化粗定位相關參數(shù)
LD M0.0 //粗定位完成
R Q0.0，1
CALL 1 //調(diào)用子程序1，初始化精定位相關參數(shù)
//子程序0，粗定位
LD SM0.0
MOVB 16#A0，SMB67 //設定控制字：允許PTO操作，選擇ms增量，選擇多段操作
MOVW 500，SMW168 //包絡表起始地址為V500
MOVB 3，VB500 //設定包絡表段數(shù)是3
MOVW 500，VW501 //設定第一段初始周期為500ms
MOVW -2，VD503 //設定第一段周期增量為-2ms
MOVD 200，VD505 //設定第一段脈沖個數(shù)為200
MOVW 100，VW509 //設定第二段初始周期為100ms
MOVW 0，VD511 //設定第二段周期增量為0ms
MOVD 1360，VD513 //設定第二段脈沖個數(shù)為1360
MOVW 100，VW517 //設定第三段初始周期為100ms
MOVW 1，VD519 //設定第三段周期增量為1ms
MOVD 400，VD521 //設定第三段脈沖個數(shù)為400
ATCH 2，19 //定義中斷程序2處理PTO完成中斷
角度控制元件 ISI222
