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


