6-2 步进电动机实现两轴联动直线运动程序(3)
发布时间:2021-06-08
发布时间:2021-06-08
电动机,dsPIC,自动控制,程序
Mov ACCAL, w0 Mov #68,w1
Mul.uu w0,w1,w2 Clr w4 Clr w5
Ff1l w3,w4 Bra nc,TB3 Ff1l w2,w5 Bra c,TB5 Mov #-16, w4
Subr w5,#1,w5 Mov w2,ACCAL Mov w3,ACCAH Clr ACCAU
Sftac A,w4 Sftac A,w5 Mov ACCAH,w6 Mov tL,w2 Mov tH,w3
Repeat #17
div.ud w2,w6 mov w0,ACCAL clr ACCAH
sftac A,w4
sftac A,w5
Goto TB4
TB3:
Subr w4,#1,w4 Mov w2,ACCAL Mov w3,ACCAH Clr ACCAU
Sftac A,w4 Mov ACCAH,w6 Mov tL,w2 Mov tH,w3
Repeat #17
div.ud w2,w6 mov w0,ACCAL clr ACCAH
sftac A,w4
TB4:
Mov ACCAH,w0 mov w0,Tx goto TB6