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

標題: 分享兩個用TMS320F228335實現SPWM的源程序 [打印本頁]
作者: 原罪學者    時間: 2019-10-25 09:02
標題: 分享兩個用TMS320F228335實現SPWM的源程序
分享兩個用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

復制代碼


作者: fgdzypf    時間: 2020-4-6 22:19
現在還有多少用匯編的，一看頭大了



歡迎光臨 (http://m.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 欧美日韩国产一区二区三区 | www.com国产 | 日韩手机看片 | 天堂色av | 97超碰资源 | 欧美性大战xxxxx久久久 | 中文字幕麻豆 | 永久免费看片在线播放 | 国产99热 | 天天草天天射 | 久久999 | 国产一级黄色大片 | 婷婷丁香激情 | 国产成人片| 亚洲69视频 | 成人av一区二区三区在线观看 | 欧美黄色免费网站 | 亚洲精品免费看 | 天天做夜夜爽 | 黄色av大全 | 女教师合集乱500篇小说 | 亚洲视频在线免费观看 | 黄色一级片网站 | 丁香六月激情 | 亚洲成人免费 | 日韩一级片 | 天天搞天天搞 | 日本三级大片 | 欧美三级又粗又硬 | 亚洲福利影院 | 日韩视频一区二区三区 | 日韩欧美精品在线 | 爱福利视频 | 成人超碰在线 | 日韩国产中文字幕 | 国产精品免费一区二区三区 | 国产日韩在线视频 | 欧美黑粗大 | 欧美性猛交xxxx免费看久久久 | 欧美xx孕妇 | 色片网址|