aci_fe.lst

TI的digital motor control lib的源代码。了解TI的编程规范

     250                    ; ***** stationary d-axis *****
     251 003f 7390          LT              *-              ; TREG = K3_fe  (Q15)
     252                                                    ; ARP=AR2, AR0->FR1, AR2->flx_dr_s              
     253            ;----------------------------------------------------------------------------------
     254 0040 5480                  MPY             *               ; PREG = K3_fe*flx_dr_s  (Q30)
     255                                                            ; ARP=AR2, AR0->FR1, AR2->flx_dr_s              
     256            ;----------------------------------------------------------------------------------
     257 0041 be03                  PAC                             ; ACC = K3_fe*flx_dr_s  (Q30)
     258                                                            ; ARP=AR2, AR0->FR1, AR2->flx_dr_s 
     259            ;----------------------------------------------------------------------------------
     260 0042 7802                  ADRK    #2              ; ARP=AR2, AR0->FR1, AR2->K4_fe 
     261            ;----------------------------------------------------------------------------------
     262 0043 7380                  LT              *               ; TREG = K4_fe  (Q15)
     263                                    ; ARP=AR2, AR0->FR1, AR2->K4_fe
     264            ;----------------------------------------------------------------------------------
     265 0044 7c07                  SBRK    #7              ; ARP=AR2, AR0->FR1, AR2->i_ds_fe 
TMS320C1x/C2x/C2xx/C5x COFF Assembler Version 7.00  Tue May  6 12:41:25 2003
Copyright (c) 1987-1999  Texas Instruments Incorporated 
aci_fe.asm                                                           PAGE    6

     266            ;----------------------------------------------------------------------------------
     267 0045 5480                  MPY             *               ; PREG = K4_fe*i_ds_fe  (Q30)
     268                                                            ; ARP=AR2, AR0->FR1, AR2->i_ds_fe
     269            ;----------------------------------------------------------------------------------
     270 0046 be04                  APAC                    ; ACC = K3_fe*flx_dr_s + K4_fe*i_ds_fe  (Q30)
     271                                                            ; ARP=AR2, AR0->FR1, AR2->i_ds_fe
     272            ;----------------------------------------------------------------------------------
     273 0047 7808                  ADRK    #8              ; ARP=AR2, AR0->FR1, AR2->flx_ds_s
     274            ;----------------------------------------------------------------------------------
     275 0048 9980                  SACH    *,1             ; flx_ds_s = K3_fe*flx_dr_s + K4_fe*i_ds_fe  (Q15)
     276                                                            ; ARP=AR2, AR0->FR1, AR2->flx_ds_s
     277            ;----------------------------------------------------------------------------------
     278                    ; ***** stationary q-axis *****
     279 0049 7c02          SBRK    #2              ; ARP=AR2, AR0->FR1, AR2->K3_fe         
     280            ;----------------------------------------------------------------------------------
     281 004a 7380                  LT              *               ; TREG = K3_fe  (Q15)
     282                                                            ; ARP=AR2, AR0->FR1, AR2->K3_fe 
     283            ;----------------------------------------------------------------------------------
     284 004b 7c02          SBRK    #2              ; ARP=AR2, AR0->FR1, AR2->flx_qr_s      
     285            ;----------------------------------------------------------------------------------
     286 004c 5480          MPY             *               ; PREG = K3_fe*flx_qr_s  (Q30)
     287                                                    ; ARP=AR2, AR0->FR1, AR2->flx_qr_s
     288            ;----------------------------------------------------------------------------------
     289 004d be03                  PAC                             ; ACC = K3_fe*flx_qr_s  (Q30)
     290                                                    ; ARP=AR2, AR0->FR1, AR2->flx_qr_s
     291            ;----------------------------------------------------------------------------------
     292 004e 7803          ADRK    #3              ; ARP=AR2, AR0->FR1, AR2->K4_fe
     293            ;----------------------------------------------------------------------------------
     294 004f 7380                  LT              *               ; TREG = K4_fe  (Q15)
     295                                                            ; ARP=AR2, AR0->FR1, AR2->K4_fe
     296            ;----------------------------------------------------------------------------------
     297 0050 7c08                  SBRK    #8              ; ARP=AR2, AR0->FR1, AR2->i_qs_fe
     298            ;----------------------------------------------------------------------------------
     299 0051 5480                  MPY             *               ; PREG = K4_fe*i_qs_fe   (Q30)
     300                                                            ; ARP=AR2, AR0->FR1, AR2->i_qs_fe
     301            ;----------------------------------------------------------------------------------
     302 0052 be04          APAC                    ; ACC = K3_fe*flx_qr_s + K4_fe*i_qs_fe   (Q30)
     303                                                            ; ARP=AR2, AR0->FR1, AR2->i_qs_fe
     304            ;----------------------------------------------------------------------------------
     305 0053 780a                  ADRK    #10             ; ARP=AR2, AR0->FR1, AR2->flx_qs_s
     306            ;----------------------------------------------------------------------------------
     307 0054 9990          SACH    *-,1    ; flx_qs_s = K3_fe*flx_qr_s + K4_fe*i_qs_fe   (Q15)
     308                                                            ; ARP=AR2, AR0->FR1, AR2->flx_ds_s
     309            ;----------------------------------------------------------------------------------
     310            ; (5) Conventional PI controller section
     311            ;----------------------------------------------------------------------------------
     312                    ; ***** stationary d-axis *****
     313 0055 bf01          SPM             1               ; Set left shifted 1 bit
     314                                                    ; ARP=AR2, AR0->FR1, AR2->flx_ds_s
     315            ;----------------------------------------------------------------------------------
     316 0056 1f80                  LACC    *,15    ; ACC = flx_ds_s  (Q14)
     317                                                            ; ARP=AR2, AR0->FR1, AR2->flx_ds_s
     318            ;----------------------------------------------------------------------------------
     319 0057 7802          ADRK    #2              ; ARP=AR2, AR0->FR1, AR2->psi_ds_fe
TMS320C1x/C2x/C2xx/C5x COFF Assembler Version 7.00  Tue May  6 12:41:25 2003
Copyright (c) 1987-1999  Texas Instruments Incorporated 
aci_fe.asm                                                           PAGE    7

     320            ;----------------------------------------------------------------------------------
     321 0058 3fa8                  SUB             *+,15,AR0 ; ACC = flx_ds_s - psi_ds_fe  (Q14)
     322                                                            ; ARP=AR2, AR0->FR1, AR2->Kp_fe, ARP=AR0
     323            ;----------------------------------------------------------------------------------
     324 0059 be02          NEG                             ; ACC = psi_ds_fe - flx_ds_s (Q14)
     325                                                            ; ARP=AR0, AR0->FR1, AR2->Kp_fe
     326            ;----------------------------------------------------------------------------------
     327 005a 988a          SACH    *,AR2   ; FR1 = error_ds = psi_ds_fe - flx_ds_s (Q14)
     328                                                            ; ARP=AR0, AR0->FR1, AR2->Kp_fe, ARP=AR2
     329            ;----------------------------------------------------------------------------------
     330 005b 73a8                  LT              *+,AR0  ; TREG = Kp_fe  (Q15)
     331                                                            ; ARP=AR2, AR0->FR1, AR2->ui_lo_ds, ARP=AR0
     332            ;----------------------------------------------------------------------------------
     333 005c 54a0          MPY             *+              ; PREG = Kp_fe*error_ds  (Q29)
     334                                                    ; ARP=AR0, AR0->FR2, AR2->ui_lo_ds
     335            ;----------------------------------------------------------------------------------
     336 005d be03          PAC                             ; ACC = Kp_fe*error_ds  (Q30)
     337                                                    ; ARP=AR0, AR0->FR2, AR2->ui_lo_ds
     338            ;----------------------------------------------------------------------------------
     339 005e 988a          SACH    *,AR2   ; FR2 = tmp1_fe = Kp_fe*error_ds  (Q14)
     340                                                    ; ARP=AR0, AR0->FR2, AR2->ui_lo_ds, ARP=AR2     
     341            ;----------------------------------------------------------------------------------
     342 005f 62a0          ADDS    *+              ; ACC = Kp_fe*error_ds + ui_ds  (Q30)
     343                                                    ; ARP=AR2, AR0->FR2, AR2->ui_hi_ds      
     344            ;----------------------------------------------------------------------------------
     345 0060 61a0                  ADDH    *+              ; ACC = Kp_fe*error_ds + ui_ds  (Q30)
     346                                                    ; ARP=AR2, AR0->FR2, AR2->ucomp_ds
     347            ;----------------------------------------------------------------------------------
     348 0061 a080          NORM    *               ; ACC = Kp_fe*error_ds + ui_ds  (Q31)
     349                                                    ; ARP=AR2, AR0->FR2, AR2->ucomp_ds
     350            ;----------------------------------------------------------------------------------
     351 0062 98a8          SACH    *+,AR0  ; ucomp_ds = Kp_fe*error_ds + ui_ds  (Q15)
     352                                                    ; ARP=AR2, AR0->FR2, AR2->Ki_fe, ARP=AR0
     353            ;----------------------------------------------------------------------------------
     354 0063 bf03                  SPM             3               ; Set right shifted 6 bit
     355                                                            ; ARP=AR0, AR0->FR2, AR2->Ki_fe
     356            ;----------------------------------------------------------------------------------
     357 0064 739a          LT              *-,AR2  ; TREG = FR2 = tmp1_fe = Kp_fe*error_ds (Q14)
     358                                                    ; ARP=AR0, AR0->FR1, AR2->Ki_fe, ARP=AR2
     359            ;----------------------------------------------------------------------------------
     360 0065 5480                  MPY             *               ; PREG = Kp_fe*Ki_fe*error_ds (Q38)
     361                                                            ; ARP=AR2, AR0->FR1, AR2->Ki_fe         
     362            ;----------------------------------------------------------------------------------
     363 0066 be03          PAC                             ; ACC = Kp_fe*Ki_fe*error_ds (Q32)
     364                                                            ; ARP=AR2, AR0->FR1, AR2->Ki_fe  
     365            ;----------------------------------------------------------------------------------
     366 0067 be0a                  SFR                             ; ACC = Kp_fe*Ki_fe*error_ds (Q31)
     367                                                            ; ARP=AR2, AR0->FR1, AR2->Ki_fe 
     368            ;----------------------------------------------------------------------------------
     369 0068 be0a                  SFR                             ; ACC = Kp_fe*Ki_fe*error_ds (Q30)
     370                                                            ; ARP=AR2, AR0->FR1, AR2->Ki_fe 
     371            ;----------------------------------------------------------------------------------
     372 0069 7c03          SBRK    #3              ; ARP=AR2, AR0->FR1, AR2->ui_lo_ds
     373            ;----------------------------------------------------------------------------------
TMS320C1x/C2x/C2xx/C5x COFF Assembler Version 7.00  Tue May  6 12:41:25 2003
Copyright (c) 1987-1999  Texas Instruments Incorporated 
aci_fe.asm                                                           PAGE    8

     374 006a 62a0                  ADDS    *+              ; ACC = ui_ds + Kp_fe*Ki_fe*error_ds (Q30)
     375                                                            ; ARP=AR2, AR0->FR1, AR2->ui_hi_ds