设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › DSP论坛 › 分享两个用TMS320F228335实现SPWM的源程序
返回列表 发新帖
查看: 2780|回复: 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 | 只看该作者
现在还有多少用汇编的，一看头大了
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表