⭐ 欢迎来到虫虫下载站! | 📦 资源下载 📁 资源专辑 ℹ️ 关于我们
⭐ 虫虫下载站

📄 aci_fe.lst

📁 TI的digital motor control lib的源代码。了解TI的编程规范
💻 LST
📖 第 1 页 / 共 5 页
字号:
     123                                                    ; ARP=AR0, AR0->FR0, AR2->theta_r_fe
     124            ;----------------------------------------------------------------------------------
     125 0014 bf80          LACC    #SINTAB_360 ; ACC = &SINTAB_360
         0015 0000! 
     126                                                    ; ARP=AR0, AR0->FR0, AR2->theta_r_fe    
     127            ;----------------------------------------------------------------------------------
     128 0016 20a0          ADD             *+              ; ACC = &SINTAB_360 + ptr_fe
     129                                                    ; ARP=AR0, AR0->FR1, AR2->theta_r_fe 
     130            ;----------------------------------------------------------------------------------
     131 0017 a69a          TBLR    *-,AR2  ; FR1 = cos_fe = cos(theta_e_fe)   (Q15)
     132                                                    ; ARP=AR0, AR0->FR0, AR2->theta_r_fe, ARP=AR2 
     133            ;----------------------------------------------------------------------------------
     134 0018 19a8                  LACC    *+,9,AR0        ; ACC = (theta_r_fe)/128
     135                                                            ; ARP=AR2, AR0->FR0, AR2->i_qs_fe, ARP=AR0      
     136            ;----------------------------------------------------------------------------------
     137 0019 9880                  SACH    *               ; FR0 = ptr_fe = Table pointer for sin
     138                                                    ; ARP=AR0, AR0->FR0, AR2->i_qs_fe
     139            ;----------------------------------------------------------------------------------
     140 001a bf80          LACC    #SINTAB_360 ; ACC = &SINTAB_360
         001b 0000! 
     141                                                    ; ARP=AR0, AR0->FR0, AR2->i_qs_fe       
     142            ;----------------------------------------------------------------------------------
     143 001c 2080          ADD             *               ; ACC = &SINTAB_360 + ptr_fe
     144                                                    ; ARP=AR0, AR0->FR0, AR2->i_qs_fe 
     145            ;----------------------------------------------------------------------------------
     146 001d 7802          ADRK    #2              ; ARP=AR0, AR0->FR2, AR2->i_qs_fe
     147            ;----------------------------------------------------------------------------------
     148 001e a68a          TBLR    *,AR2   ; FR2 = sin_fe = sin(theta_e_fe)   (Q15)
     149                                                    ; ARP=AR0, AR0->FR2, AR2->i_qs_fe, ARP=AR2 
     150            ;----------------------------------------------------------------------------------
     151                   ; ***** d-axis *****
     152 001f bf01          SPM             1               ; ARP=AR2, AR0->FR2, AR2->i_qs_fe 
     153            ;----------------------------------------------------------------------------------
     154 0020 b900                  ZAC                             ; Reset ACC
     155                                                            ; ARP=AR2, AR0->FR2, AR2->i_qs_fe
     156            ;----------------------------------------------------------------------------------
     157 0021 73a8          LT              *+,AR0  ; TREG = i_qs_fe  (Q15)
     158                                                    ; ARP=AR2, AR0->FR2, AR2->i_ds_fe, ARP=AR0  
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    4

     159            ;----------------------------------------------------------------------------------
     160 0022 549a          MPY             *-,AR2  ; PREG = i_qs_fe*sin_fe   (Q30)
     161                                                    ; ARP=AR0, AR0->FR1, AR2->i_ds_fe, ARP=AR2
     162            ;----------------------------------------------------------------------------------
     163 0023 7098          LTA             *-,AR0  ; ACC = i_qs_fe*sin_fe  (Q31), TREG = i_ds_fe (Q15)
     164                                                    ; ARP=AR2, AR0->FR1, AR2->i_qs_fe, ARP=AR0 
     165            ;----------------------------------------------------------------------------------
     166 0024 54a0                  MPY             *+              ; PREG = i_ds_fe*cos_fe  (Q30)
     167                                                            ; ARP=AR0, AR0->FR2, AR2->i_qs_fe               
     168            ;----------------------------------------------------------------------------------
     169 0025 50a0          MPYA    *+              ; ACC = i_qs_fe*sin_fe+i_ds_fe*cos_fe (Q31)
     170                                                    ; PREG = i_ds_fe*sin_fe  (Q30)
     171                                                    ; ARP=AR0, AR0->FR3, AR2->i_qs_fe               
     172            ;----------------------------------------------------------------------------------
     173 0026 988a                  SACH    *,AR2   ; FR3 = i_ds_e = i_qs_fe*sin_fe+i_ds_fe*cos_fe (Q15)
     174                                                            ; ARP=AR0, AR0->FR3, AR2->i_qs_fe, ARP=AR2
     175            ;----------------------------------------------------------------------------------
     176                            ; ***** q-axis *****
     177 0027 bf80                  LACC    #0              ; Clear ACC
         0028 0000  
     178                                    ; ARP=AR2, AR0->FR3, AR2->i_qs_fe
     179            ;----------------------------------------------------------------------------------
     180 0029 7388                  LT              *,AR0   ; TREG = i_qs_fe  (Q15)
     181                                                            ; ARP=AR2, AR0->FR3, AR2->i_qs_fe, ARP=AR0              
     182            ;----------------------------------------------------------------------------------
     183 002a 7c02          SBRK    #2              ; ARP=AR0, AR0->FR1, AR2->i_qs_fe
     184            ;----------------------------------------------------------------------------------
     185 002b 5180                  MPYS    *               ; ACC = -i_ds_fe*sin_fe (Q31), PREG = i_qs_fe*cos_fe (Q30)
     186                                                            ; ARP=AR0, AR0->FR1, AR2->i_qs_fe
     187            ;----------------------------------------------------------------------------------
     188 002c be04          APAC                    ; ACC = i_qs_fe*cos_fe-i_ds_fe*sin_fe (Q31)
     189                                                    ; ARP=AR0, AR0->FR1, AR2->i_qs_fe 
     190            ;----------------------------------------------------------------------------------
     191 002d 7803                  ADRK    #3              ; ARP=AR0, AR0->FR4, AR2->i_qs_fe
     192            ;----------------------------------------------------------------------------------
     193 002e 989a                  SACH    *-,AR2  ; FR4 = i_qs_e = i_qs_fe*cos_fe-i_ds_fe*sin_fe (Q15)
     194                                                    ; ARP=AR0, AR0->FR3, AR2->i_qs_fe, ARP=AR2 
     195            ;----------------------------------------------------------------------------------
     196            ; (2) The current model section (Classical Rotor Flux Vector Control Eq.)               
     197            ;----------------------------------------------------------------------------------
     198 002f bf00          SPM             0               ; Reset Product mode
     199                                                    ; ARP=AR2, AR0->FR3, AR2->i_qs_fe
     200            ;----------------------------------------------------------------------------------
     201 0030 7802                  ADRK    #2              ; ARP=AR2, AR0->FR3, AR2->K1_fe         
     202            ;----------------------------------------------------------------------------------
     203 0031 73a0          LT              *+              ; TREG = K1_fe  (Q15)
     204                                    ; ARP=AR2, AR0->FR3, AR2->flx_dr_e      
     205            ;----------------------------------------------------------------------------------
     206 0032 54a0                  MPY             *+              ; PREG = K1_fe*flx_dr_e  (Q30)
     207                                                            ; ARP=AR2, AR0->FR3, AR2->K2_fe 
     208            ;----------------------------------------------------------------------------------
     209 0033 be03          PAC                             ; ACC = K1_fe*flx_dr_e  (Q30)
     210                                                            ; ARP=AR2, AR0->FR3, AR2->K2_fe
     211            ;----------------------------------------------------------------------------------
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    5

     212 0034 7398                  LT              *-,AR0  ; TREG = K2_fe   (Q15)
     213                                                            ; ARP=AR2, AR0->FR3, AR2->flx_dr_e, ARP=AR0
     214            ;----------------------------------------------------------------------------------
     215 0035 549a                  MPY             *-,AR2  ; PREG = K2_fe*i_ds_e  (Q30)
     216                                                            ; ARP=AR0, AR0->FR2, AR2->flx_dr_e, ARP=AR2 
     217            ;----------------------------------------------------------------------------------
     218 0036 be05          SPAC                    ; ACC = K1_fe*flx_dr_e - K2_fe*i_ds_e  (Q30) 
     219                                    ; ARP=AR2, AR0->FR2, AR2->flx_dr_e
     220            ;----------------------------------------------------------------------------------
     221 0037 9980                  SACH    *,1             ; flx_dr_e = K1_fe*flx_dr_e - K2_fe*i_ds_e  (Q15) 
     222                                    ; ARP=AR2, AR0->FR2, AR2->flx_dr_e
     223            ;----------------------------------------------------------------------------------
     224            ; (3) Inverse park transformation on the rotor flux from the current model
     225            ;----------------------------------------------------------------------------------
     226                    ; ***** q-axis *****
     227 0038 7388          LT              *,AR0   ; TREG = flx_dr_e  (Q15)
     228                                                    ; ARP=AR2, AR0->FR2, AR2->flx_dr_e, ARP=AR0     
     229            ;----------------------------------------------------------------------------------
     230 0039 549a                  MPY             *-,AR2  ; PREG = flx_dr_e*sin_fe  (Q30)
     231                                                            ; ARP=AR0, AR0->FR1, AR2->flx_dr_e, ARP=AR2 
     232            ;----------------------------------------------------------------------------------
     233 003a be03                  PAC                             ; ACC = flx_dr_e*sin_fe  (Q30)
     234                                                            ; ARP=AR2, AR0->FR1, AR2->flx_dr_e
     235            ;----------------------------------------------------------------------------------
     236 003b 7802                  ADRK    #2              ; ARP=AR2, AR0->FR1, AR2->flx_qr_s
     237            ;----------------------------------------------------------------------------------
     238 003c 99a8                  SACH    *+,1,AR0 ; flx_qr_s = flx_dr_e*sin_fe  (Q15)
     239                                                            ; ARP=AR2, AR0->FR1, AR2->flx_dr_s, ARP=AR0
     240            ;----------------------------------------------------------------------------------
     241                            ; ***** d-axis *****
     242 003d 548a                  MPY             *,AR2   ; PREG = flx_dr_e*cos_fe  (Q30)
     243                                                            ; ARP=AR0, AR0->FR1, AR2->flx_dr_s, ARP=AR2             
     244            ;----------------------------------------------------------------------------------
     245 003e 99a0                  SACH    *+,1    ; flx_dr_s = flx_dr_e*cos_fe  (Q15)
     246                                                            ; ARP=AR2, AR0->FR1, AR2->K3_fe
     247            ;----------------------------------------------------------------------------------
     248            ; (4) Compute the stator flux based on the rotor flux from current model
     249            ;----------------------------------------------------------------------------------

⌨️ 快捷键说明

复制代码 Ctrl + C
搜索代码 Ctrl + F
全屏模式 F11
切换主题 Ctrl + Shift + D
显示快捷键 ?
增大字号 Ctrl + =
减小字号 Ctrl + -