aci_fe.lst

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

     506 0098 2f80          ADD             *,15    ; ACC = emf_ds/2 + emf_ds/2  (Q15)
     507                                                    ; ARP=AR0, AR0->FR3, AR2->emf_ds
     508            ;----------------------------------------------------------------------------------
     509 0099 988a          SACH    *,AR2   ; FR3 = tmp1_fe = emf_ds/2 + emf_ds/2  (Q15)
     510                                                    ; ARP=AR0, AR0->FR3, AR2->emf_ds, ARP=AR2
     511            ;----------------------------------------------------------------------------------
     512 009a 7803                  ADRK    #3              ; ARP=AR2, AR0->FR3, AR2->K6_fe
     513            ;----------------------------------------------------------------------------------
     514 009b 73a8                  LT              *+,AR0  ; TREG = K6_fe  (Q15)
     515                                                            ; ARP=AR2, AR0->FR3, AR2->psi_ds_lo, ARP=AR0
     516            ;----------------------------------------------------------------------------------
     517 009c 548a                  MPY             *,AR2   ; PREG = K6_fe*(emf_ds/2 + emf_ds/2)  (Q30)
     518                                                            ; ARP=AR0, AR0->FR3, AR2->psi_ds_lo, ARP=AR2
     519            ;----------------------------------------------------------------------------------
     520 009d be03          PAC                             ; ACC = K6_fe*(emf_ds/2 + emf_ds/2)  (Q31)
     521                                                            ; ARP=AR2, AR0->FR3, AR2->psi_ds_lo
     522            ;----------------------------------------------------------------------------------
     523 009e 6280          ADDS    *               ; ACC = psi_ds + K6_fe*(emf_ds/2 + emf_ds/2)  (Q31)
     524                                                            ; ARP=AR2, AR0->FR3, AR2->psi_ds_lo     
     525            ;----------------------------------------------------------------------------------
     526 009f 7c0e                  SBRK    #14             ; ARP=AR2, AR0->FR3, AR2->psi_ds_fe
     527            ;----------------------------------------------------------------------------------
     528 00a0 6180                  ADDH    *               ; ACC = psi_ds + K6_fe*(emf_ds/2 + emf_ds/2)  (Q31)
     529                                                            ; ARP=AR2, AR0->FR3, AR2->psi_ds_fe
     530            ;----------------------------------------------------------------------------------
     531 00a1 9880                  SACH    *               ; psi_ds = psi_ds + K6_fe*(emf_ds/2 + emf_ds/2)  (Q31)
     532                                                            ; ARP=AR2, AR0->FR3, AR2->psi_ds_fe                             
     533            ;----------------------------------------------------------------------------------
     534 00a2 780e          ADRK    #14             ; ARP=AR2, AR0->FR3, AR2->psi_ds_lo
     535            ;----------------------------------------------------------------------------------
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   11

     536 00a3 90a0                  SACL    *+              ; psi_ds = psi_ds + K6_fe*(emf_ds/2 + emf_ds/2)  (Q31)
     537                                                            ; ARP=AR2, AR0->FR3, AR2->emf_qs
     538            ;----------------------------------------------------------------------------------
     539                    ; ***** stationary q-axis *****
     540 00a4 10a8          LACC    *+,AR0  ; ACC = emf_qs  (Q15)
     541                                                    ; ARP=AR2, AR0->FR3, AR2->u_qs_fe, ARP=AR0   
     542            ;----------------------------------------------------------------------------------
     543 00a5 908a          SACL    *,AR2   ; FR3 = tmp1_fe = emf_qs  (Q15)
     544                                                    ; ARP=AR0, AR0->FR3, AR2->u_qs_fe, ARP=AR2
     545            ;----------------------------------------------------------------------------------
     546 00a6 6a80                  LACC    *,16    ; ACC = u_qs_fe  (Q31)
     547                                                            ; ARP=AR2, AR0->FR3, AR2->u_qs_fe       
     548            ;----------------------------------------------------------------------------------
     549 00a7 7c07          SBRK    #7              ; ARP=AR2, AR0->FR3, AR2->ucomp_qs
     550            ;----------------------------------------------------------------------------------
     551 00a8 6580          SUB             *,16    ; ACC = u_qs_fe - ucomp_qs (Q31)
     552                                                    ; ARP=AR2, AR0->FR3, AR2->ucomp_qs
     553            ;----------------------------------------------------------------------------------
     554 00a9 7803          ADRK    #3              ; ARP=AR2, AR0->FR3, AR2->K5_fe
     555            ;----------------------------------------------------------------------------------
     556 00aa 7380                  LT              *               ; TREG = K5_fe  (Q15)
     557                                                            ; ARP=AR2, AR0->FR3, AR2->K5_fe
     558            ;----------------------------------------------------------------------------------
     559 00ab 7c17          SBRK    #23             ; ARP=AR2, AR0->FR3, AR2->i_qs_fe
     560            ;----------------------------------------------------------------------------------
     561 00ac 5480                  MPY             *               ; PREG = K5_fe*i_qs_fe  (Q30)
     562                                                            ; ARP=AR2, AR0->FR3, AR2->i_qs_fe
     563            ;----------------------------------------------------------------------------------
     564 00ad be05          SPAC                    ; ACC = u_qs_fe-ucomp_qs-K5_fe*i_qs_fe  (Q31)
     565                                                    ; ARP=AR2, AR0->FR3, AR2->i_qs_fe
     566            ;----------------------------------------------------------------------------------
     567 00ae 781a                  ADRK    #26             ; ARP=AR2, AR0->FR3, AR2->emf_qs                
     568            ;----------------------------------------------------------------------------------
     569 00af 9880          SACH    *               ; emf_qs = u_qs_fe-ucomp_qs-K5_fe*i_qs_fe  (Q15)
     570                                                    ; ARP=AR2, AR0->FR3, AR2->emf_qs
     571            ;----------------------------------------------------------------------------------
     572 00b0 1f88          LACC    *,15,AR0 ; ACC = emf_qs/2   (Q15)
     573                                                    ; ARP=AR2, AR0->FR3, AR2->emf_qs, ARP=AR0  
     574            ;----------------------------------------------------------------------------------
     575 00b1 2f80                  ADD             *,15    ; ACC = emf_qs/2 + emf_qs/2  (Q15)
     576                                                            ; ARP=AR0, AR0->FR3, AR2->emf_qs
     577            ;----------------------------------------------------------------------------------
     578 00b2 988a          SACH    *,AR2   ; FR3 = tmp1_fe = emf_qs/2 + emf_qs/2  (Q15)
     579                                                            ; ARP=AR0, AR0->FR3, AR2->emf_qs, ARP=AR2 
     580            ;----------------------------------------------------------------------------------
     581 00b3 7c02          SBRK    #2              ; ARP=AR2, AR0->FR3, AR2->K6_fe
     582            ;----------------------------------------------------------------------------------
     583 00b4 7388          LT              *,AR0   ; TREG = K6_fe  (Q15)
     584                                                    ; ARP=AR2, AR0->FR3, AR2->K6_fe, ARP=AR0
     585            ;----------------------------------------------------------------------------------
     586 00b5 548a          MPY             *,AR2   ; PREG = K6_fe*(emf_qs/2 + emf_qs/2)  (Q30)
     587                                                    ; ARP=AR0, AR0->FR3, AR2->K6_fe, ARP=AR2
     588            ;----------------------------------------------------------------------------------
     589 00b6 be03          PAC                             ; ACC = K6_fe*(emf_qs/2 + emf_qs/2)  (Q31)
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   12

     590                                                    ; ARP=AR2, AR0->FR3, AR2->K6_fe
     591            ;----------------------------------------------------------------------------------
     592 00b7 7804          ADRK    #4              ; ARP=AR2, AR0->FR3, AR2->psi_qs_lo
     593            ;----------------------------------------------------------------------------------
     594 00b8 6280          ADDS    *               ; ACC = psi_qs + K6_fe*(emf_qs/2 + emf_qs/2)  (Q31)
     595                                                    ; ARP=AR2, AR0->FR3, AR2->psi_qs_lo
     596            ;----------------------------------------------------------------------------------
     597 00b9 7c0b          SBRK    #11             ; ARP=AR2, AR0->FR3, AR2->psi_qs_fe
     598            ;----------------------------------------------------------------------------------
     599 00ba 6180                  ADDH    *               ; ACC = psi_qs + K6_fe*(emf_qs/2 + emf_qs/2)  (Q31)
     600                                                    ; ARP=AR2, AR0->FR3, AR2->psi_qs_fe 
     601            ;----------------------------------------------------------------------------------
     602 00bb 9880                  SACH    *               ; psi_qs = psi_qs + K6_fe*(emf_qs/2 + emf_qs/2)  (Q31)
     603                                                    ; ARP=AR2, AR0->FR3, AR2->psi_qs_fe 
     604            ;----------------------------------------------------------------------------------
     605 00bc 780b                  ADRK    #11             ; ARP=AR2, AR0->FR3, AR2->psi_qs_lo 
     606            ;----------------------------------------------------------------------------------
     607 00bd 90a0                  SACL    *+              ; psi_qs = psi_qs + K6_fe*(emf_qs/2 + emf_qs/2)  (Q31)
     608                                                    ; ARP=AR2, AR0->FR3, AR2->K8_fe
     609            ;----------------------------------------------------------------------------------
     610            ; (7) Compute the estimated rotor flux based on the stator from the integral of back emf
     611            ;----------------------------------------------------------------------------------
     612                    ; ***** stationary d-axis *****
     613 00be bf00          SPM             0               ; Reset product mode
     614                                                    ; ARP=AR2, AR0->FR3, AR2->K8_fe 
     615            ;----------------------------------------------------------------------------------
     616 00bf 7380          LT              *               ; TREG = K8_fe  (Q15)
     617                                                    ; ARP=AR2, AR0->FR3, AR2->K8_fe
     618            ;----------------------------------------------------------------------------------
     619 00c0 7c1c          SBRK    #28             ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     620            ;----------------------------------------------------------------------------------
     621 00c1 5480                  MPY             *               ; PREG = K8_fe*i_ds_fe   (Q30)
     622                                                            ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     623            ;----------------------------------------------------------------------------------
     624 00c2 be03          PAC                             ; ACC = K8_fe*i_ds_fe   (Q30)
     625                                                            ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     626            ;----------------------------------------------------------------------------------
     627 00c3 be02          NEG                             ; ACC = -K8_fe*i_ds_fe   (Q30)
     628                                                            ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     629            ;----------------------------------------------------------------------------------
     630 00c4 be0a          SFR                             ; ACC = -K8_fe*i_ds_fe   (Q29)
     631                                                            ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     632            ;----------------------------------------------------------------------------------
     633 00c5 781d          ADRK    #29             ; ARP=AR2, AR0->FR3, AR2->K7_fe
     634