永磁无刷电动机及系统设计精编版.ppt

;**************************** ;D轴电流调节器 ;**************************** LACC IDREF ;D轴给定电流 Q14格式 SUB IDRFB ;D轴反馈电流 SACL GPR0 ;求偏差 LDP #IINTGDH ;求积分 ZALH IINTGDH ADDS IINTGDL LDP #GPR0 LT GPR0 MPY IICOFD ;Q9格式 D轴 APAC LDP #IINTGDH SACH IINTGDH SACL IINTGDL LDP #GPR0 ;求比例 LT GPR0 MPY IPCOFD ;Q9格式 D轴 APAC ;比例+积分 SACH VRD0, 7 2/2 ANTI-PARK CONVERT 坐标变换 ; alfa and beta axis voltages calculation ; (d,q) - (alfa,beta) transformation ; VAS= VRD0*cos - VRQ0*sin ; VBS= VRD0*sin + VRQ0*cos LT SINA MPY VRQ0 ;VRQ0 * SINA LTP COSA NEG MPY VRD0 ;VRD0 * COSA MPYA VRQ0 ; SACH GPR2, 1 ;VAS=VRD0*COS-VRQ0*SIN LTP SINA MPY VRD0 ;VRD0*SINA APAC SACH GPR1, 1 ;VBS=VRD0*SIN+VRQ0*COS 2/3 ANTI-CLARKE CONVERT 坐标变换 ;Phase a, b, c Voltage calculation ; Vref1=Vsq ; Vref2=(-Vsq + sqrt(3)*Vsd) /2 ; Vref3=(-Vsq - sqrt(3)*Vsd) /2 SPLK #376Dh, GPR0 ;Q14格式 SQRT(3)/2 LT GPR2 ;Vsd MPY GPR0 PAC SUB GPR1, 13 ;Vsq/2 SACH *+, 2 ;Vref2 344H PAC NEG SUB GPR1, 13 SACH *+, 2 ;Vref3 345H LACC GPR1 SACL * ;Vref1 346H NOP 扇区判别 ;****************************************** ; 60 degrees sector determination ; sector = r1 + 2*r2 + 4*r3 ; r1=1 if Va0 ; r2=1 if Vb0 ; r3=1 if Vc0 ;(W,V,U) 0-U000,U060;1-U060,U120;2-U120,U180; ; 3-U180,U240;4-U240,U300;2-U300,U000; ; U000-(0,0,1);U060-(0,1,1);U120-(0,1,0) ; U180-(1,1,0);U240-(1,0,0);U300-(1,0,1) ;****************************************** ZAC BIT *-, BIT15 ;Vref1 BCND NEXT662, TC OR #2 NEXT662：BIT *-, BIT15 ;Vref3 BCND NEXT661, TC OR #8 NEXT661 BIT *, BIT15 ;Vref2 BCND NEXT660, TC OR #4 NEXT660：SACL SECTOR ADD #CALTABC BACC CALTABC NOP NOP B SECTOR1 ;1;Vref10,Vref20,Vref30 B SECTOR2 ;5;Vref10,Vref20,Vref30 B SECTOR3 ;0;Vref10,Vref20,Vref30 B SECTOR3 ;3;Vref10,Vref20,Vref30 B SECTOR2 ;2;Vref10,Vref20,Vref30 B SECTOR1 ;4;Vref10,Vref20,Vref30 SECTOR1导通时间计算