aci_fe.lst

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

     376            ;----------------------------------------------------------------------------------
     377 006b 6190                  ADDH    *-              ; ACC = ui_ds + Kp_fe*Ki_fe*error_ds (Q30)
     378                                                            ; ARP=AR2, AR0->FR1, AR2->ui_lo_ds
     379            ;----------------------------------------------------------------------------------
     380 006c 90a0                  SACL    *+              ; ui_ds = ui_ds + Kp_fe*Ki_fe*error_ds (Q30)
     381                                                            ; ARP=AR2, AR0->FR1, AR2->ui_hi_ds
     382            ;----------------------------------------------------------------------------------
     383 006d 9880          SACH    *               ; ui_ds = ui_ds + Kp_fe*Ki_fe*error_ds (Q30)
     384                                                            ; ARP=AR2, AR0->FR1, AR2->ui_hi_ds
     385            ;----------------------------------------------------------------------------------
     386                    ; ***** stationary q-axis *****
     387 006e bf01          SPM             1               ; Set left shifted 1 bit
     388                                                    ; ARP=AR2, AR0->FR1, AR2->ui_hi_ds
     389            ;----------------------------------------------------------------------------------
     390 006f 7803                  ADRK    #3              ; ARP=AR2, AR0->FR1, AR2->psi_qs_fe     
     391            ;----------------------------------------------------------------------------------
     392 0070 1f80          LACC    *,15    ; ACC = psi_qs_fe  (Q14)
     393                                                    ; ARP=AR2, AR0->FR1, AR2->psi_qs_fe                     
     394            ;----------------------------------------------------------------------------------
     395 0071 7c07                  SBRK    #7              ; ARP=AR2, AR0->FR1, AR2->flx_qs_s              
     396            ;----------------------------------------------------------------------------------
     397 0072 3f88                  SUB             *,15,AR0 ; ACC = psi_qs_fe - flx_qs_s  (Q14)
     398                                                            ; ARP=AR2, AR0->FR1, AR2->flx_qs_s, ARP=AR0
     399            ;----------------------------------------------------------------------------------
     400 0073 988a          SACH    *,AR2   ; FR1 = error_qs = psi_qs_fe - flx_qs_s  (Q14)
     401                                                            ; ARP=AR0, AR0->FR1, AR2->flx_qs_s, ARP=AR2     
     402            ;----------------------------------------------------------------------------------
     403 0074 7802                  ADRK    #2              ; ARP=AR2, AR0->FR1, AR2->Kp_fe 
     404            ;----------------------------------------------------------------------------------
     405 0075 7388                  LT              *,AR0   ; TREG = Kp_fe  (Q15)
     406                                                            ; ARP=AR2, AR0->FR1, AR2->Kp_fe, ARP=AR0
     407            ;----------------------------------------------------------------------------------
     408 0076 54a0                  MPY             *+              ; PREG = Kp_fe*error_qs  (Q29)
     409                                                            ; ARP=AR0, AR0->FR2, AR2->Kp_fe                 
     410            ;----------------------------------------------------------------------------------
     411 0077 be03                  PAC                             ; ACC = Kp_fe*error_qs  (Q30)
     412                                                            ; ARP=AR0, AR0->FR2, AR2->Kp_fe
     413            ;----------------------------------------------------------------------------------
     414 0078 988a          SACH    *,AR2   ; FR2 = tmp1_fe = Kp_fe*error_qs  (Q14)
     415                                                            ; ARP=AR0, AR0->FR2, AR2->Kp_fe, ARP=AR2
     416            ;----------------------------------------------------------------------------------
     417 0079 7806                  ADRK    #6              ; ARP=AR2, AR0->FR2, AR2->ui_lo_qs
     418            ;----------------------------------------------------------------------------------
     419 007a 62a0          ADDS    *+              ; ACC = Kp_fe*error_qs + ui_qs  (Q30)
     420                                                    ; ARP=AR2, AR0->FR2, AR2->ui_hi_qs 
     421            ;----------------------------------------------------------------------------------
     422 007b 61a0          ADDH    *+              ; ACC = Kp_fe*error_qs + ui_qs  (Q30)
     423                                                    ; ARP=AR2, AR0->FR2, AR2->ucomp_qs  
     424            ;----------------------------------------------------------------------------------
     425 007c a080          NORM    *               ; ACC = Kp_fe*error_qs + ui_qs  (Q31)
     426                                                    ; ARP=AR2, AR0->FR2, AR2->ucomp_qs  
     427            ;----------------------------------------------------------------------------------
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    9

     428 007d 9888          SACH    *,AR0   ; ucomp_qs = Kp_fe*error_qs + ui_qs  (Q15)
     429                                                    ; ARP=AR2, AR0->FR2, AR2->ucomp_qs, ARP=AR0
     430            ;----------------------------------------------------------------------------------
     431 007e bf03                  SPM             3               ; Set right shifted 6 bit
     432                                                            ; ARP=AR0, AR0->FR2, AR2->ucomp_qs
     433            ;----------------------------------------------------------------------------------
     434 007f 73aa                  LT              *+,AR2  ; TREG = FR2 = tmp1_fe = Kp_fe*error_qs  (Q14)
     435                                                            ; ARP=AR0, AR0->FR3, AR2->ucomp_qs, ARP=AR2
     436            ;----------------------------------------------------------------------------------
     437 0080 7c04                  SBRK    #4              ; ARP=AR2, AR0->FR3, AR2->Ki_fe         
     438            ;----------------------------------------------------------------------------------
     439 0081 5480          MPY             *               ; PREG = Kp_fe*Ki_fe*error_qs  (Q38)
     440                                                    ; ARP=AR2, AR0->FR3, AR2->Ki_fe  
     441            ;----------------------------------------------------------------------------------
     442 0082 be03          PAC                             ; ACC = Kp_fe*Ki_fe*error_qs  (Q32)
     443                                                    ; ARP=AR2, AR0->FR3, AR2->Ki_fe
     444            ;----------------------------------------------------------------------------------
     445 0083 be0a                  SFR                             ; ACC = Kp_fe*Ki_fe*error_qs  (Q31)
     446                                                    ; ARP=AR2, AR0->FR3, AR2->Ki_fe
     447            ;----------------------------------------------------------------------------------
     448 0084 be0a                  SFR                             ; ACC = Kp_fe*Ki_fe*error_qs  (Q30)
     449                                                    ; ARP=AR2, AR0->FR3, AR2->Ki_fe
     450            ;----------------------------------------------------------------------------------
     451 0085 7802          ADRK    #2              ; ARP=AR2, AR0->FR3, AR2->ui_lo_qs
     452            ;----------------------------------------------------------------------------------
     453 0086 62a0          ADDS    *+              ; ACC = ui_qs + Kp_fe*Ki_fe*error_qs  (Q30)
     454                                                    ; ARP=AR2, AR0->FR3, AR2->ui_hi_qs
     455            ;----------------------------------------------------------------------------------
     456 0087 6190                  ADDH    *-              ; ACC = ui_qs + Kp_fe*Ki_fe*error_qs  (Q30)
     457                                                    ; ARP=AR2, AR0->FR3, AR2->ui_lo_qs
     458            ;----------------------------------------------------------------------------------
     459 0088 90a0          SACL    *+              ; ui_qs = ui_qs + Kp_fe*Ki_fe*error_qs  (Q30)
     460                                                    ; ARP=AR2, AR0->FR3, AR2->ui_hi_qs
     461            ;----------------------------------------------------------------------------------
     462 0089 9880          SACH    *               ; ui_qs = ui_qs + Kp_fe*Ki_fe*error_qs  (Q30)
     463                                                    ; ARP=AR2, AR0->FR3, AR2->ui_hi_qs
     464            ;----------------------------------------------------------------------------------
     465            ; (6) Compute the estimated stator flux based on the integral of back emf       
     466            ;----------------------------------------------------------------------------------
     467                            ; ***** stationary d-axis *****
     468 008a bf01          SPM             1               ; Set left shifted 1 bit
     469                                                    ; ARP=AR2, AR0->FR3, AR2->ui_hi_qs
     470            ;----------------------------------------------------------------------------------
     471 008b 7802          ADRK    #2              ; ARP=AR2, AR0->FR3, AR2->emf_ds        
     472            ;----------------------------------------------------------------------------------
     473 008c 10a8                  LACC    *+,AR0  ; ACC = emf_ds  (Q15)
     474                                                            ; ARP=AR2, AR0->FR3, AR2->u_ds_fe, ARP=AR0
     475            ;----------------------------------------------------------------------------------
     476 008d 908a                  SACL    *,AR2   ; FR3 = tmp1_fe = emf_ds  (Q15)
     477                                                            ; ARP=AR0, AR0->FR3, AR2->u_ds_fe, ARP=AR2      
     478            ;----------------------------------------------------------------------------------
     479 008e 6aa0          LACC    *+,16   ; ACC = u_ds_fe  (Q31)
     480                                                    ; ARP=AR2, AR0->FR3, AR2->K5_fe 
     481            ;----------------------------------------------------------------------------------
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   10

     482 008f 7390                  LT              *-              ; TREG = K5_fe  (Q15)
     483                                    ; ARP=AR2, AR0->FR3, AR2->u_ds_fe       
     484            ;----------------------------------------------------------------------------------
     485 0090 7c07                  SBRK    #7              ; ARP=AR2, AR0->FR3, AR2->ucomp_ds
     486            ;----------------------------------------------------------------------------------
     487 0091 6580          SUB             *,16    ; ACC = u_ds_fe - ucomp_ds  (Q31)
     488                                                    ; ARP=AR2, AR0->FR3, AR2->ucomp_ds
     489            ;----------------------------------------------------------------------------------
     490 0092 7c0e                  SBRK    #14             ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     491            ;----------------------------------------------------------------------------------
     492 0093 5480          MPY             *               ; PREG = K5_fe*i_ds_fe  (Q30)
     493                                                ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     494            ;----------------------------------------------------------------------------------
     495 0094 be05          SPAC                    ; ACC = u_ds_fe-ucomp_ds-K5_fe*i_ds_fe (Q31)
     496                                                    ; ARP=AR2, AR0->FR3, AR2->i_ds_fe
     497            ;----------------------------------------------------------------------------------
     498 0095 7814          ADRK    #20             ; ARP=AR2, AR0->FR3, AR2->emf_ds
     499            ;----------------------------------------------------------------------------------
     500 0096 9880          SACH    *               ; emf_ds = u_ds_fe-ucomp_ds-K5_fe*i_ds_fe (Q15)
     501                                                    ; ARP=AR2, AR0->FR3, AR2->emf_ds
     502            ;----------------------------------------------------------------------------------
     503 0097 1f88          LACC    *,15,AR0 ; ACC = emf_ds/2   (Q15)
     504                                                    ; ARP=AR2, AR0->FR3, AR2->emf_ds, ARP=AR0 
     505            ;----------------------------------------------------------------------------------