久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3476|回復: 1
打印 上一主題 下一主題
收起左側

分享兩個用TMS320F228335實現SPWM的源程序

[復制鏈接]
跳轉到指定樓層
樓主
ID:629815 發表于 2019-10-25 09:02 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
分享兩個用228335實現SPWM的文檔
DSP28335實現SPWM.docx (161.92 KB, 下載次數: 20)
DSP采樣SPWM程序.doc (127.5 KB, 下載次數: 16)

源程序:
  1.     本例載波頻率為20KHz，或載波周期為50μs。DSP晶振10MHz，內部4倍頻，時鐘頻率為40MHz，計數周期為25ns。假設調制波頻率由外部輸入（1～50Hz），并轉換成合適的格式（本例為Q4格式）。調制系數M為0～0.9。死區時間1.6μs。最小刪除脈寬3μs。
  2.     主程序的工作是根據輸入的調制波頻率計算N、2N和M值。
  3.     定時器采用連續增減計數方式。利用下溢中斷，每個載波周期都產生一次中斷，在每次中斷都根據以下公式分別計算出下一個載波周期的三個比較值。并比較正負脈寬是否小于3μs，如果小于3μs則刪除該脈沖。
  4.     本例中的常數：
  5. π倍載波周期：π5010-6228=42166秒，Q28格式
  6. 載波頻率：20000Hz2=40000Hz，Q1格式；
  7. 定時器周期值：50μs/2/25ns=1000個計數周期；
  8. 調制系數對調制波頻率的比例系數：0.9/50=0.018221=37749，Q21格式；
  9. 最小正脈寬：3μs/25ns=120個計數周期；
  10. 最小負脈寬：47μs/25ns=1880個計數周期；
  11. 弧度換算成度系數：360/2π24=917，Q4格式；
  12. 2π/3212=8579弧度，Q12格式；
  13. 4π/3212=17157弧度，Q12格式；
  14. 2π212=25736弧度，Q12格式；
  15.   .include "240x.h"  ;寄存器地址
  16.   .global  _c_int0       ;全局化標號
  17. ;--------------------------------------以下定義變量-----------------------------------------------------------
  18. ST0 .set 0                    ;狀態寄存器ST0
  19. ST1 .set 1                    ;狀態寄存器ST1
  20.               .bss    TEMP,1          ;中間變量
  21.               .bss    TEMP1,1         ;中間變量
  22.               .bss    TEMP2,1         ;中間變量
  23.               .bss    TEMP3,1         ;中間變量
  24.               .bss    TEMP4,1         ;中間變量
  25.               .bss    TEMP5,1         ;中間變量
  26.               .bss    TEMP6,1         ;中間變量
  27.               .bss    K_,1            ;第K個采樣點
  28.               .bss    PITC,1          ;π乘載波周期=42166,Q28格式
  29.               .bss    F2M,1           ;調制系數對調制波頻率的比例系數, Q21格式
  30.               .bss    T_QUA,1        ; T_carr/4的定時器計數脈沖個數,Q0格式
  31.               .bss    F_CARR,1        ;載波頻率,Q1格式
  32.               .bss    PMIN,1          ;最小正脈寬(脈沖個數),Q0格式
  33.               .bss    PMAX,1          ;最小負脈寬(脈沖個數),Q0格式
  34.               .bss    F_MODU,1        ;調制波頻率,Q4格式
  35.               .bss    N_,1            ;每個調制波周期的載波脈沖數,Q0格式
  36.               .bss    M_,1             ;M值
  37.               .bss    KMAX,1          ;2N,Q0格式
  38.               .bss    ATOD,1           ;弧度換算成度系數917,Q4格式
  39.               .bss  ACCH,1                  ;ACC高字保存單元
  40.             .bss  ACCL,1                   ;ACC低字保存單元
  41.             .bss  AR0_SAVE,1              ;AR0保存單元
  42.             .bss  P_HI,1                   ;P寄存器高字保存單元
  43.             .bss  P_LO,1                   ;P寄存器低字保存單元
  44. ;--------------------------------------CONTEXT段,定義保護現場數據區----------------------------
  45. ST0_SAVE  .usect ".context",1   ;狀態寄存器ST0保存單元
  46. ST1_SAVE  .usect ".context",1   ;狀態寄存器ST1保存單元
  47. ;-------------------------------------- 定義主向量段---------------------------------------------
  48. .sect  ".vectors"              ;定義主向量段
  49. RESET  B  _c_int0          ;地址0000H，復位，優先級1
  50. INT1   B  PHANTOM        ;地址0002H，INT1，優先級4
  51. INT2   B  _C_INT2          ;地址0004H，INT2，優先級5
  52. INT3   B  PHANTOM        ;地址0006H，INT3，優先級6
  53. INT4   B  PHANTOM        ;地址0008H，INT4，優先級7
  54. INT5   B  PHANTOM        ;地址000AH，INT5，優先級8
  55. INT6   B  PHANTOM        ;地址000CH，INT6，優先級9
  56. RESERVED  B  PHANTOM                        ;地址000EH，測試，優先級10
  57. SW_INT8   B  PHANTOM                ;地址0010H，自定義軟中斷
  58. SW_INT9   B  PHANTOM                ;地址0012H，自定義軟中斷
  59. SW_INT10  B  PHANTOM                ;地址0014H，自定義軟中斷
  60. SW_INT11  B  PHANTOM                ;地址0016H，自定義軟中斷
  61. SW_INT12  B  PHANTOM                ;地址0018H，自定義軟中斷
  62. SW_INT13  B  PHANTOM                ;地址001AH，自定義軟中斷
  63. SW_INT14  B  PHANTOM                ;地址001CH，自定義軟中斷
  64. SW_INT15  B  PHANTOM                ;地址001EH，自定義軟中斷
  65. SW_INT16  B  PHANTOM                ;地址0020H，自定義軟中斷
  66. TRAP           B  PHANTOM                        ;地址0022H，TRAP矢量
  67. NMI                     B  PHANTOM                        ;地址0024H，NMI，優先級3
  68. EMU_TRAP B  PHANTOM                        ;地址0026H，仿真Trap，優先級2
  69. SW_INT20  B  PHANTOM                ;地址0028H，自定義軟中斷
  70. SW_INT21  B  PHANTOM                ;地址002AH，自定義軟中斷
  71. SW_INT22  B  PHANTOM                ;地址002CH，自定義軟中斷
  72. SW_INT23  B  PHANTOM                ;地址002EH，自定義軟中斷
  73. SW_INT24  B  PHANTOM                ;地址0030H，自定義軟中斷
  74. SW_INT25  B  PHANTOM                ;地址0032H，自定義軟中斷
  75. SW_INT26  B  PHANTOM                ;地址0034H，自定義軟中斷
  76. SW_INT27  B  PHANTOM                ;地址0036H，自定義軟中斷
  77. SW_INT28  B  PHANTOM                ;地址0038H，自定義軟中斷
  78. SW_INT29  B  PHANTOM                ;地址003AH，自定義軟中斷
  79. SW_INT30  B  PHANTOM                ;地址003CH，自定義軟中斷
  80. SW_INT31  B  PHANTOM                ;地址003EH，自定義軟中斷
  81. ;--------------------------------------定義子向量段----------------------------------------------------
  82. .sect  ".pvecs"                ;定義子向量段
  83. PVECTORS        B        PHANTOM                        ;偏移地址0000H
  84.                         B        PHANTOM                          ;偏移地址0001H
  85.                         B        PHANTOM                        ;偏移地址0002H
  86.                         B        PHANTOM                        ;偏移地址0003H
  87.                         B        PHANTOM                        ;偏移地址0004H
  88.                         B        PHANTOM                        ;偏移地址0005H
  89.                         B        PHANTOM                        ;偏移地址0006H
  90.                         B        PHANTOM                        ;偏移地址0007H
  91.                         B        PHANTOM                        ;偏移地址0008H
  92.                         B        PHANTOM                        ;偏移地址0009H
  93.                         B        PHANTOM                        ;偏移地址000AH
  94.                         B        PHANTOM                        ;偏移地址000BH
  95.                         B        PHANTOM                        ;偏移地址000CH
  96.                         B        PHANTOM                        ;偏移地址000DH
  97.                         B        PHANTOM                        ;偏移地址000EH
  98.                         B        PHANTOM                        ;偏移地址000FH
  99.                         B        PHANTOM                        ;偏移地址0010H
  100.                         B        PHANTOM                        ;偏移地址0011H
  101.                         B        PHANTOM                        ;偏移地址0012H
  102.                         B        PHANTOM                        ;偏移地址0013H
  103.                         B        PHANTOM                        ;偏移地址0014H
  104.                         B        PHANTOM                        ;偏移地址0015H
  105.                         B        PHANTOM                        ;偏移地址0016H
  106.                         B        PHANTOM                        ;偏移地址0017H
  107.                         B        PHANTOM                        ;偏移地址0018H
  108.                         B        PHANTOM                        ;偏移地址0019H
  109.                         B        PHANTOM                        ;偏移地址001AH
  110.                         B        PHANTOM                        ;偏移地址001BH
  111.                         B        PHANTOM                        ;偏移地址001CH
  112.                         B        PHANTOM                        ;偏移地址001DH
  113.                         B        PHANTOM                        ;偏移地址001EH
  114.                         B        PHANTOM                        ;偏移地址001FH
  115.                         B        PHANTOM                        ;偏移地址0020H
  116.                         B        PHANTOM                        ;偏移地址0021H
  117.                         B        PHANTOM                        ;偏移地址0022H
  118.                         B        PHANTOM                        ;偏移地址0023H
  119.                         B        PHANTOM                        ;偏移地址0024H
  120.                         B        PHANTOM                        ;偏移地址0025H
  121.                         B        PHANTOM                        ;偏移地址0026H
  122.                         B        PHANTOM                        ;偏移地址0027H
  123.                         B        PHANTOM                        ;偏移地址0028H
  124.                         B        WXM                            ;偏移地址0029H
  125.                         B        PHANTOM                        ;偏移地址002AH
  126.                         B        PHANTOM                        ;偏移地址002BH
  127.                         B        PHANTOM                        ;偏移地址002CH
  128.                         B        PHANTOM                        ;偏移地址002DH
  129.                         B        PHANTOM                        ;偏移地址002EH
  130.                         B        PHANTOM                        ;偏移地址002FH
  131.                         B        PHANTOM                        ;偏移地址0030H
  132.                         B        PHANTOM                        ;偏移地址0031H
  133.                         B        PHANTOM                        ;偏移地址0032H
  134.                         B        PHANTOM                        ;偏移地址0033H
  135.                         B        PHANTOM                        ;偏移地址0034H
  136.                         B        PHANTOM                        ;偏移地址0035H
  137.                         B        PHANTOM                        ;偏移地址0036H
  138.                         B        PHANTOM                        ;偏移地址0037H
  139.                         B        PHANTOM                        ;偏移地址0038H
  140.                         B        PHANTOM                        ;偏移地址0039H
  141.                         B        PHANTOM                        ;偏移地址003AH
  142.                         B        PHANTOM                        ;偏移地址003BH
  143.                         B        PHANTOM                        ;偏移地址003CH
  144.                         B        PHANTOM                        ;偏移地址003DH
  145.                         B        PHANTOM                        ;偏移地址003EH
  146.                         B        PHANTOM                        ;偏移地址003FH
  147.                         B        PHANTOM                        ;偏移地址0040H
  148.                         B        PHANTOM                    ;偏移地址0041H
  149. ;--------------------------------------以下是主程序-----------------------------------------------------
  150.   .text
  151. ;--------------------------------------系統初始化程序--------------------------------------------------
  152. _c_int0        SETC   INTM              ;禁止中斷
  153.   CLRC  CNF               ;B0為數據存儲區
  154.   LDP    #224
  155.   SPLK   #0000000000000100B,SCSR1 ;4倍頻,CLKOUT 40MHz
  156.   SPLK   #68H,WDCR        ;不用看門狗
  157.   LDP    #225
  158.   LACC  MCRA
  159.   OR     #0FC0H             ;設置PWM1-6引腳
  160.   SACL   MCRA
  161. ;--------------------------------------中斷初始化程序------------------------------------------------
  162.   LDP    #0  
  163.   SPLK   #0FFH,IFR          ;清所有系統中斷標志
  164.   SPLK   #00000010B,IMR     ;開INT2中斷
  165.   LDP    #232         
  166.   SPLK   #0FFFH,EVAIFRA    ;清事件管理器A所有中斷標志
  167.   SPLK   #0FH,EVAIFRB
  168.   SPLK   #0FH,EVAIFRC
  169.   SPLK   #0200H,EVAIMRA     ;開T1下溢中斷
  170.   SPLK   #0,EVAIMRB          ;屏蔽所有中斷
  171.   SPLK   #0,EVAIMRC          ;屏蔽所有中斷
  172. ;--------------------------------------初始化事件管理器A程序-----------------------------------------
  173.   SPLK   #1000,T1PR           ;T1周期值=1000
  174.   SPLK   #1000,CMPR1         ;占空比初值 0%
  175.   SPLK   #1000,CMPR2
  176.   SPLK   #1000,CMPR3
  177.   SPLK   #0000011001100110B,ACTRA ;引腳PWM1,3,5高有效,2,4,6低有效
  178.   SPLK   #01F4H,DBTCONA     ;死區時間1*32*50ns=1.6uμs
  179.   SPLK   #1000001000000000B,COMCONA ;允許比較,下溢重載
  180.   SPLK   #0000100001000010B,T1CON ;連續增減計數方式,預分頻=1
  181.   CLRC  INTM                 ;開總中斷

  183. ;--------------------------------------變量初始化---------------------------------------------------------
  184.               LDP     #6
  185.               SPLK    #0,K_           ;K=0
  186.               SPLK    #42166,PITC     ;π*T_carr =42166,Q28格式
  187.               SPLK    #37749,F2M      ;F-M轉換系數,Q21格式
  188.               SPLK    #250,T_QUA   ;T_carr/4的定時器計數脈沖個數,Q0格式
  189.               SPLK    #40000,F_CARR  ;載波頻率,Q1格式
  190.               SPLK    #120,PMIN       ;最小正脈寬(脈沖個數),Q0格式
  191.               SPLK    #1880,PMAX      ;最小負脈寬時的最大正脈寬,Q0格式
  192.               SPLK    #917,ATOD       ;Q4格式
  193.               SPLK    #480,F_MODU    ;調試數據,Q4格式
  194. ;--------------------------------------主循環-------------------------------------------------------------
  195. CYCLE       LDP     #6
  196.               CLRC   SXM
  197.               LACC   F_MODU,13       ;調制波頻率,Q4格式
  198.               SACH   TEMP            ;右移3位,Q1格式
  199.               LACC   F_CARR          ;載波頻率,Q1格式
  200.               RPT    #15
  201.               SUBC  TEMP             ;計算N=F_carr/F_modu
  202.               SACL   N_               ;保存N,Q0格式
  203.               LACC   N_,1             ;2N
  204.               SACL   KMAX           ;保存,Q0格式
  205.               LT      F2M             ; F-M轉換系數37749,Q21格式
  206.               MPYU   F_MODU         ;Q4格式
  207.               PAC
  208.               SACH    M_             ;保存M,Q9格式
  209.               B       CYCLE           ;循環
  210. ;--------------------------------------假中斷子程序---------------------------------------------------------
  211. PHANTOM    RET                       ;假中斷
  212. ;--------------------------------------T1下溢中斷處理子程序-----------------------------------------
  213. _C_INT2      SST   #ST0,ST0_SAVE      ;保存現場ST0
  214.   SST   #ST1,ST1_SAVE      ;保存ST1
  215.   LDP   #6
  216.   SACH  ACCH
  217.   SACL  ACCL              ;保存ACC
  218.   SPH    P_HI
  219.   SPL    P_LO              ;保存 P
  220.   MPY    #1                ;P<=T
  221.   SPL    T_SAVE            ;保存 T
  222.   LDP    #224  
  223.   LACC   PIVR,1            ;讀偏移地址
  224.   ADD    # PVECTORS       ;子向量表首地址
  225.               BACC
  226. WXM         LDP   #232
  227.               SPLK   #0FFFH,EVAIFRA     ;清中斷標志
  228.               LDP    #6
  229.               LT      PITC              ;π*T_carr =42166,Q28格式
  230.               MPYU    K_                ;Q0格式
  231.               PAC                       ;計算K*π*T_carr
  232.               SACH   TEMP1            ;保存乘積,Q12格式
  233.               LT      TEMP1
  234.               MPYU    F_MODU         ;乘調制波頻率,Q4格式
  235.               PAC                      ;計算K*π*T_carr*T_modu
  236.               RPT    #3
  237.               ROR                     ;右移4位,Q12格式
  238.               SACL   TEMP1           ;保存第1個角度值
  239.               LACC   TEMP1
  240.               ADD    #8579             ;加2π/3,Q12格式
  241.               SACL   TEMP2            ;保存第2個角度值
  242.               SUB     #25736            ;檢測是否小于2π,Q12格式
  243.               BCND   WXM1 ,LEQ       ;小于2π跳轉
  244.               SACL    TEMP2           ;否則保存
  245. WXM1        LACC    TEMP1
  246.               ADD     #17157           ;加4π/3,Q12格式
  247.               SACL    TEMP3           ;保存第3個角度值
  248.               SUB     #25736            ;檢測是否小于2π,Q12格式
  249.               BCND   WXM2 ,LEQ       ;小于2π跳轉
  250.               SACL    TEMP3           ; 否則保存
  251. WXM2        LT       TEMP1           ;開始將第1個角度轉換成度
  252.               MPYU    ATOD             ;乘轉換系數,Q4格式
  253.               PAC
  254.               SACH    TEMP1          ;保存第1個角度值,Q0格式
  255.               LACC    #SIN_ENTRY     ;SIN表入口地址
  256.               ADD     TEMP1           ;偏移量
  257.               TBLR    TEMP1           ;保存第1個SIN值,Q14格式有符號數
  258.               LT       TEMP1
  259.               MPY     M_              ;乘M,Q9格式
  260.               PAC                       ;Q23格式
  261.               SACH    TEMP1,7         ;相當于右移9位,Q14格式有符號數
  262.               LACC    TEMP1
  263.               ADD     #1,14            ;加+1
  264.               SACL    TEMP1           ;保存, Q14格式
  265.               LT       T_QUA          ;T_carr/4=250,Q0格式
  266.               MPYU     TEMP1
  267.               PAC
  268.               SACH    TEMP1,2         ;相當于右移14位,保存 為Q0格式
  269.               LT       TEMP2          ;開始將第2個角度轉換成度
  270.               MPYU    ATOD
  271.               PAC
  272.               SACH    TEMP2          ;保存第2個角度值,Q0格式
  273.               LACC    #SIN_ENTRY     ;SIN表入口地址
  274.               ADD     TEMP2          ;偏移量
  275.               TBLR    TEMP2           ;保存第2個SIN值,Q14格式有符號數
  276.               LT       TEMP2
  277.               MPY     M_              ;乘M,Q9格式
  278.               PAC                       ;Q23格式
  279.               SACH    TEMP2,7         ;相當于右移9位,Q14格式有符號數
  280.               LACC    TEMP2
  281.               ADD     #1,14            ;加+1
  282.               SACL    TEMP2           ;保存, Q14格式
  283.               LT       T_QUA          ;T_carr/4=250,Q0格式
  284.               MPYU    TEMP2
  285.               PAC
  286.               SACH    TEMP2,2         ;相當于右移14位,保存 為Q0格式
  287.               LT       TEMP3           ;開始將第3個角度轉換成度
  288.               MPYU    ATOD
  289.               PAC
  290.               SACH    TEMP3          ;保存第3個角度值,Q0格式
  291.               LACC    #SIN_ENTRY     ;SIN表入口地址
  292.               ADD     TEMP3          ;偏移量
  293.               TBLR    TEMP3           ;保存第3個SIN值,Q14格式有符號數
  294.               LT       TEMP3
  295.               MPY     M_              ;乘M,Q9格式
  296.               PAC                       ;Q23格式
  297.               SACH    TEMP3,7         ;相當于右移9位,Q14格式有符號數
  298.               LACC    TEMP3
  299.               ADD     #1,14            ;加+1
  300.               SACL    TEMP3           ;保存, Q14格式
  301.               LT       T_QUA          ;T_carr/4=250,Q0格式
  302.               MPYU    TEMP3
  303.               PAC
  304.               SACH    TEMP3,2         ;相當于右移14位,保存 為Q0格式
  305.               LACC    K_
  306.               ADD     #1               ;K+1
  307.               SACL    K_
  308.               LT      PITC              ;π*T_carr =42166,Q28格式
  309.               MPYU    K_                ;Q0格式
  310.               PAC                       ;計算K*π*T_carr
  311.               SACH   TEMP4            ;保存乘積,Q12格式
  312.               LT      TEMP4
  313.               MPYU   F_MODU         ;乘調制波頻率,Q4格式
  314.               PAC                      ;計算K*π*T_carr*T_modu
  315.               RPT    #3
  316.               ROR                     ;右移4位,Q12格式
  317.               SACL   TEMP4           ;保存第4個角度值
  318.               LACC   TEMP4
  319.               ADD    #8579             ;加2π/3,Q12格式
  320.               SACL   TEMP5            ;保存第5個角度值
  321.               SUB     #25736            ;檢測是否小于2π,Q12格式
  322.               BCND   WXM3 ,LEQ       ;小于2π跳轉
  323.               SACL    TEMP5           ;否則保存
  324. WXM3        LACC    TEMP4
  325.               ADD     #17157           ;加4π/3,Q12格式
  326.               SACL    TEMP6           ;保存第6個角度值
  327.               SUB     #25736            ;檢測是否小于2π,Q12格式
  328.               BCND   WXM4 ,LEQ       ;小于2π跳轉
  329.               SACL    TEMP6           ;否則保存
  330. WXM4        LT       TEMP4           ;開始將第4個角度轉換成度
  331.               MPYU    ATOD             ;乘轉換系數,Q4格式
  332.               PAC
  333.               SACH    TEMP4          ;保存第4個角度值,Q0格式
  334.               LACC    #SIN_ENTRY     ;SIN表入口地址
  335.               ADD     TEMP4           ;偏移量
  336.               TBLR    TEMP4           ;保存第4個SIN值,Q14格式有符號數
  337.               LT       TEMP4
  338.               MPY     M_              ;乘M,Q9格式
  339.               PAC                       ;Q23格式
  340.               SACH    TEMP4,7         ;相當于右移9位,Q14格式有符號數
  341.               LACC    TEMP4
  342.               ADD     #1,14            ;加+1
  343.               SACL    TEMP4           ;保存, Q14格式
  344.               LT       T_QUA          ;T_carr/4=250,Q0格式
  345.               MPYU     TEMP4
  346.               PAC
  347.               SACH    TEMP4,2         ;相當于右移14位,保存 為Q0格式
  348.               LT       TEMP5          ;開始將第5個角度轉換成度
  349.               MPYU    ATOD
  350.               PAC
  351.               SACH    TEMP5          ;保存第5個角度值,Q0格式
  352.               LACC    #SIN_ENTRY     ;SIN表入口地址
  353.               ADD     TEMP5          ;偏移量
  354.               TBLR    TEMP5           ;保存第5個SIN值,Q14格式有符號數
  355.               LT       TEMP5
  356.               MPY     M_              ;乘M,Q9格式
  357.               PAC                       ;Q23格式
  358.               SACH    TEMP5,7         ;相當于右移9位,Q14格式有符號數
  359.               LACC    TEMP5
  360.               ADD     #1,14            ;加+1
  361.               SACL    TEMP5           ;保存, Q14格式
  362.               LT       T_QUA          ;T_carr/4=250,Q0格式
  363.               MPYU     TEMP5
  364.               PAC
  365.               SACH    TEMP5,2         ;相當于右移14位,保存 為Q0格式
  366.               LT       TEMP6           ;開始將第6個角度轉換成度
  367.               MPYU    ATOD
  368.               PAC
  369.               SACH    TEMP6          ;保存第6個角度值,Q0格式
  370.               LACC    #SIN_ENTRY     ;SIN表入口地址
  371.               ADD     TEMP6          ;偏移量
  372.               TBLR    TEMP6           ;保存第6個SIN值,Q14格式有符號數
  373.               LT       TEMP6
  374.               MPY     M_              ;乘M,Q9格式
  375.               PAC                       ;Q23格式
  376.               SACH    TEMP6,7         ;相當于右移9位,Q14格式有符號數
  377.               LACC    TEMP6
  378.               ADD     #1,14            ;加+1
  379.               SACL    TEMP6           ;保存, Q14格式
  380.               LT       T_QUA          ;T_carr/4=250,Q0格式
  381.               MPYU     TEMP6
  382.               PAC
  383.               SACH    TEMP6,2         ;相當于右移14位,保存 為Q0格式
  384.               LACC    K_
  385.               ADD     #1               ;K+1
  386.               SACL    K_
  387.               SUB      KMAX           ;比較K是否小于2N
  388.               BCND   WXM5,LT         ;是則跳轉
  389.               SPLK    #0,K_             ;否則K=0
  390. WXM5        LACC   TEMP1
  391.               ADD    TEMP4            ;計算脈寬
  392.               SACL   TEMP1             ;暫存
  393.               SUB     PMIN              ;檢測是否小于最小正脈寬3微秒
  394.               BCND   WXM6,GT          ;不是繼續
  395.               SPLK    #0,TEMP1          ;是則刪除窄脈沖
  396.               B        WXM7
  397. WXM6        LACC   TEMP1             ;檢測是否小于最小負脈寬3微秒
  398.               SUB     PMAX
  399.               BCND   WXM7,LT          ;不是繼續
  400.               SPLK    #2000,TEMP1       ;是則刪除窄脈沖
  401. WXM7        LACC   #2000              ;2倍周期值
  402.               SUB     TEMP1            ;計算比較值1
  403.               ROR                       ;除2
  404.               LDP     #232               ;指向事件管理器A
  405.               SACL   CMPR1            ;保存比較值1
  406.               LDP     #6
  407.               LACC   TEMP2
  408.               ADD    TEMP5            ;計算脈寬
  409.               SACL   TEMP2             ;暫存
  410.               SUB     PMIN              ;檢測是否小于最小正脈寬3微秒
  411.               BCND   WXM8,GT          ;不是繼續
  412.               SPLK    #0,TEMP2          ;是則刪除窄脈沖
  413.               B        WXM9
  414. WXM8        LACC   TEMP2             ;檢測是否小于最小負脈寬3微秒
  415.               SUB     PMAX
  416.               BCND   WXM9,LT          ;不是繼續
  417.               SPLK    #2000,TEMP2       ;是則刪除窄脈沖
  418. WXM9        LACC   #2000              ;2倍周期值
  419.               SUB     TEMP2            ;計算比較值2
  420.               ROR                       ;除2
  421.               LDP     #232               ;指向事件管理器A
  422.               SACL   CMPR2            ;保存比較值2
  423.               LDP     #6
  424.               LACC   TEMP3
  425.               ADD    TEMP6            ;計算脈寬
  426.               SACL   TEMP3             ;暫存
  427.               SUB     PMIN              ;檢測是否小于最小正脈寬3微秒
  428.               BCND   WXM10,GT         ;不是繼續
  429.               SPLK    #0,TEMP3          ;是則刪除窄脈沖
  430.               B        WXM11
  431. WXM10       LACC   TEMP3             ;檢測是否小于最小負脈寬3微秒
  432.               SUB     PMAX
  433.               BCND   WXM11,LT          ;不是繼續
  434.               SPLK    #2000,TEMP3       ;是則刪除窄脈沖
  435. WXM11       LACC   #2000              ;2倍周期值
  436.               SUB     TEMP3            ;計算比較值3
  437.               ROR                       ;除2
  438.               LDP     #232               ;指向事件管理器A
  439.               SACL   CMPR3             ;保存比較值3
  440.               LDP     #6                 ;恢復現場
  441.   LT      P_LO               ;恢復P
  442.   MPY    #1  
  443.   LPH     P_HI  
  444.   LT      T_SAVE            ;恢復T
  445.   LACC   ACCH,16
  446.   ADDS   ACCL              ;恢復ACC
  447.   LDP     #0     
  448.   LST     #ST1,ST1_SAVE     ; 恢復ST1
  449.   LST     #ST0,ST0_SAVE     ; 恢復ST0
  450.   CLRC   INTM              ; 開中斷
  451.   RET                        ; 返回

  453.   .data                     
  454. ;--------------------------------------數據段-------------------------------------------------------------
  455. SIN_ENTRY  .word 0                   ;SIN值表,D1格式有符號數
  456.              .word 286,572,857,1143,1428
  457.              .word 1713,1997,2280,2563,2845
  458.              .word 3126,3406,3686,3964,4240
  459.              .word 4516, 4790,5063,5334,5604
  460.            .word 5872,6138,6402,6664, 6924
  461.            .word 7182,7438,7692,7943,8192
  462.            .word 8438,8682,8923,9162,9397
  463.            .word 9630,9860,10087,10311,10531
  464.            .word 10749,10963,11174,11381,11585
  465.            .word 11786,11982,12176,12365,12551
  466.            .word 12733,12911,13085,13255,13421
  467.            .word 13583,13741,13894,14044,14189
  468.            .word 14330,14466,14598,14726,14849
  469.            .word 14968,15082,15191,15296,15396
  470.            .word 15491,15582,15668,15749,15826
  471.            .word 15897,15964,16026,16083,16135
  472.            .word 16182,16225,16262,16294,16322
  473.            .word 16344,16362,16374,16382,16384            ;90

  475.            .word 16382,16374,16362,16344,16322
  476.            .word 16294,16262,16225,16182,16135
  477.            .word 16083,16026,15964,15897,15826
  478.            .word 15749,15668,15582,15491,15396
  479.            .word 15296,15191,15082,14968,14849
  480.            .word 14726,14598,14466,14330,14189
  481.            .word 14044,13894,13741,13583,13421
  482.            .word 13255,13085,12911,12733,12551
  483.            .word 12365,12176,11982,11786,11585
  484.            .word 11381,11174,10963,10749,10531
  485.            .word 10311,10087,9860,9630,9397
  486.            .word 9162,8923,8682,8438,8192
  487.            .word 7943,7692,7438,7182,6924
  488.            .word 6664,6402,6138,5872,5604
  489.            .word 5334,5063,4790,4516,4240  
  490.            .word 3964,3686,3406,3126,2845
  491.            .word 2563,2280,1997,1713,1428
  492.            .word 1143,857,572,286, 0                      ;180

  494.            .word 65250,64964,64679,64393,64108
  495.            .word 63823,63539,63256,62973,62691
  496.            .word 62410,62130,61850,61572,61296
  497.            .word 61020,60746,60473,60202,59932
  498.            .word 59664,59398,59134,58872,58612
  499.            .word 58354,58098,57844,57593,57344
  500.            .word 57098,56854,56613,56374,56139
  501.            .word 55906,55676,55449,55225,55005
  502.            .word 54787,54573,54362,54155,53951
  503.            .word 53750,53554,53360,53171,52985
  504.            .word 52803,52625,52451,52281,52115
  505.            .word 51953,51795,51642,51492,51347
  506.            .word 51206,51070,50938,50810,50687
  507.            .word 50568,50454,50345,50240,50140
  508.            .word 50045,49954, 49868,49787,49710
  509.            .word 49639,49572,49510,49453,49401
  510.            .word 49354,49311,49274,49242,49214
  511.            .word 49192,49174,49162,49154,49152                ;270

  513.            .word 49154,49162,49174,49192,49214
  514.            .word 49242,49274,49311,49354,49401
  515.            .word 49453,49510,49572,49639,49710
  516.            .word 49787,49868,49954,50045,50140
  517.            .word 50240,50345,50454,50568,50687
  518.            .word 50810,50938,51070,51206,51347
  519.            .word 51492,51642,51795,51953,52115
  520.            .word 52281,52451,52625,52803,52985
  521.            .word 53171,53360,53554,53750,53951
  522.            .word 54155,54362,54573,54787,55005
  523.            .word 55225,55449,55676,55906,56139
  524.            .word 56374,56613,56854,57098,57344
  525.            .word 57593,57844,58098,58354,58612
  526.            .word 58872,59134,59398,59664,59932
  527.            .word 60202,60473,60746,61020,61296
  528.            .word 61572,61850,62130,62410,62691
  529.            .word 62973,63256,63539,63823,64108
  530.            .word 64393,64679,64964,65250 ,0                    ;360
  531.            .end

復制代碼


評分

參與人數 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵！

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏1 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

沙發
ID:723508 發表于 2020-4-6 22:19 | 只看該作者
現在還有多少用匯編的，一看頭大了
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

手機版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 亚洲精视频 | 亚洲丝袜天堂 | 中文字幕成人在线 | 国产激情视频网站 | 欧美精品久久久久 | 欧美亚州综合 | 亚洲精品一区二区 | 久久一区二区三区四区 | 精品久久久久久红码专区 | 亚洲精品黄色 | 天堂在线免费视频 | 91中文| 亚洲啊v在线 | 艹逼网| 成人精品视频 | 成人亚洲视频 | 国产视频h| 亚洲一区二区三区免费视频 | 国产精品日韩欧美 | 国产美女一区 | 精品国产欧美一区二区三区成人 | 亚洲精品乱码久久久久久蜜桃91 | 日韩不卡视频在线观看 | 91欧美| 午夜国产一级 | 国产精品国产a级 | 国内精品久久久久久久影视简单 | 色综合久久天天综合网 | 久久久国产精品视频 | 亚洲一级视频在线 | 7777奇米影视 | 国产精品一区二区三区在线 | 久久午夜精品 | 伊人精品在线 | 国产乱码精品1区2区3区 | 久久国产精品久久久久久 | 久久久久久久久蜜桃 | 日本三级播放 | 国产情侣激情 | 99久热在线精品视频观看 | 青青草在线视频免费观看 |