?? qep.lst
字號:
C:\tic2xx\c2000\cgtools\bin\dspa.exe QEP.asm QEP.obj -gls -v2xx
TMS320C1x/C2x/C2xx/C5x COFF Assembler Version 7.00 Wed Jun 8 17:23:51 2005
Copyright (c) 1987-1999 Texas Instruments Incorporated
QEP.asm PAGE 1
1 ;=====================================================================
2 ; File : QEP.asm
3 ; Module Name : QEP
4 ; Initialization Routine : QEP_INIT
5 ; Description : 通過計算QEPA,QEPB,QEPZ得到轉(zhuǎn)子實際轉(zhuǎn)速OmigaR0，和轉(zhuǎn)向QEP_dir。
6 ; 當(dāng)通過原點的時候有正脈沖，通過捕捉功能來產(chǎn)生中斷，
7 ; 給計數(shù)器重新賦初值。
8 ; OmigaR0 = ( POS0 - POS1 ) / Tpwm,單位（1/mS）變換成可以被其它模塊用的形式，OmigaR0=OmigaR0*7FFFH/2pi
9 ;
10 ; |~~~~~~~~~~~~~~~~~~|
11 ; POS0 o------> | |
12 ; POS1 o------> | QEP |----->o OmigaR0
13 ; Tpwm o------> | |----->o QEP_dir
14 ; | |
15 ; |------------------|
16 ;
17 ; 編碼器為1000線，每360度產(chǎn)生4000個脈沖。每個PWM開關(guān)周期進(jìn)行一次計算。
18 ; Modify: 2004.6.16
19 ;=====================================================================
20 .include "f2407.h"
21 .global QEP,QEP_INIT ; function call
22
23 .global POS0,POS1 ; Inputs
24 .global OmigaR0,QEP_dir ; Outputs
25 .global TEMP
26 .global QEP_C ; constant
27
28 ;=====================================================================
29 0000 QEP_INIT:
30 ;=====================================================================
31 0000 bce8 LDP #DP_EVA
32 0001 ae20 SPLK #0000H,CAPCONA ; 使能QEP
0002 0000
33 0003 ae08 SPLK #1830H,T2CON ; 還沒有使能timer2。
0004 1830
34 0005 ae05 SPLK #4000H,T2CNT ; 計數(shù)器初值?？紤]到要增減計數(shù)，取個中間值。（不用超過8000，為負(fù)
0006 4000
35
36 0007 bc04 LDP #DP_DATA
37 0008 ae00! SPLK #0,POS1 ; 存第一個值。
0009 0000
38 000a ae00! SPLK #41,QEP_C ; 計算OmigaR0用到的常量
000b 0029
39 000c bce8 LDP #DP_EVA
40 000d ae08 SPLK #1870H,T2CON ; 使能timer2。
000e 1870
41 000f ef00 RET
42 ;=====================================================================
43 0010 QEP:
44 ;=====================================================================
45 0010 bf00 SPM 0 ;相乘為無符號數(shù)相乘，不需要移位。
46 ;----------------------------------------------------
47 ; calculate QEP_dir
48 0011 bce8 LDP #DP_EVA ;檢測轉(zhuǎn)向
TMS320C1x/C2x/C2xx/C5x COFF Assembler Version 7.00 Wed Jun 8 17:23:51 2005
Copyright (c) 1987-1999 Texas Instruments Incorporated
QEP.asm PAGE 2
49 0012 4100 BIT GPTCONA,1 ;通用定時器2的狀態(tài)，1為增計數(shù)。
50 0013 e100 BCND CONVER,TC ;增計數(shù)時轉(zhuǎn)移
0014 0018'
51 0015 b900 LACL #0 ;減計數(shù)，反向旋轉(zhuǎn)。
52 0016 7980 B END_QEP_dir
0017 0019'
53 0018 CONVER:
54 0018 b901 LACL #1 ;增計數(shù)，正向旋轉(zhuǎn)。
55 0019 END_QEP_dir:
56 0019 bc04 LDP #DP_DATA
57 001a 9000! SACL QEP_dir
58 ;----------------------------------------------------
59 ; calculate OmigaR0
60 ; OmigaR0 = ( POS0 - POS1 ) / Tpwm 增減計數(shù)算式一樣
61 ; 轉(zhuǎn)換成CAL_FLUX可用＝(POS0 - POS1)*5*(7FFFH/4000)=(POS0 - POS1)*41,（單位1/mS，7FFFh為360度）按Tpwm=0.2mS
62 ; 令QEP_C=41,
63 ; T2CNT>=4000+初值（增計數(shù)）或T2CNT<=-4000+初值（減計數(shù)）時重新裝載計數(shù)值。
64 ; 判斷是否超過4000線。
65 001b e388 BCND DOWNCOUNT,EQ ; ACC=0時轉(zhuǎn)移,減計數(shù)。
001c 0035'
66 ; 增計數(shù)時
67 001d bce8 LDP #DP_EVA
68 001e 1005 LACC T2CNT
69 001f bc04 LDP #DP_DATA
70 0020 9000! SACL POS0 ; 存當(dāng)前位置
71 0021 3000! SUB POS1
72 0022 9000! SACL TEMP ; 存差值
73 0023 7300! LT TEMP
74 0024 5400! MPY QEP_C ; 按5K開關(guān)頻率、電機1500r/min、則相乘不會超出16位。
75 0025 be03 PAC
76 0026 bfb0 AND #7FFFH ;保證不會為負(fù)數(shù)
0027 7fff
77 0028 9000! SACL OmigaR0 ;求得OmigaR0
78 ; 判斷是否超過4000線
79 0029 1000! LACC POS0
80 002a bfa0 SUB #4FA0H ; 4FA0H-4000H=4000
002b 4fa0
81 002c e344 BCND END_DIS,LT ; 4000線以后就重新計數(shù)。
002d 004e'
82 002e bf90 ADD #4000H
002f 4000
83 ; SACL POS0
84 0030 9000! SACL POS1 ; 下一次計算的POS1
85 0031 bce8 LDP #DP_EVA
86 0032 9005 SACL T2CNT ; COUNTER=POS1
87 0033 7980 B END_QEP
0034 0050'
88 ; 減計數(shù)時
89 0035 DOWNCOUNT:
90 0035 bce8 LDP #DP_EVA
91 0036 1005 LACC T2CNT
92 0037 bc04 LDP #DP_DATA
93 0038 9000! SACL POS0 ; 存當(dāng)前位置
94 0039 3000! SUB POS1
TMS320C1x/C2x/C2xx/C5x COFF Assembler Version 7.00 Wed Jun 8 17:23:51 2005
Copyright (c) 1987-1999 Texas Instruments Incorporated
QEP.asm PAGE 3
95 003a be00 ABS ; 減計數(shù)，相減為負(fù),取絕對值
96 003b 9000! SACL TEMP ; 存差值
97 003c 7300! LT TEMP
98 003d 5400! MPY QEP_C ; 按5K開關(guān)頻率、電機1500r/min、則相乘不會超出16位。
99 003e be03 PAC
100 003f bfb0 AND #7FFFH ;保證不會為負(fù)數(shù)
0040 7fff
101 0041 9000! SACL OmigaR0 ;求得OmigaR0
102 ; 判斷是否超過4000線
103 0042 1000! LACC POS0
104 0043 bfa0 SUB #3060H ; 4000h－3060h＝4000
0044 3060
105 0045 e304 BCND END_DIS,GT ; 4000線以后就重新計數(shù)。
0046 004e'
106 0047 bf90 ADD #4000H ; 加上初值4000H,重新一輪循環(huán)
0048 4000
107 ; SACL POS0
108 0049 9000! SACL POS1 ; 下一次計算的POS1
109 004a bce8 LDP #DP_EVA
110 004b 9005 SACL T2CNT ; COUNTER=POS1
111 004c 7980 B END_QEP
004d 0050'
112 004e END_DIS:
113 004e 1000! LACC POS0
114 004f 9000! SACL POS1 ; 下一次計算的POS1
115 0050 END_QEP:
116 ;正反轉(zhuǎn)的處理。
117 ;----------------------------------------------------
118 0050 bf00 SPM 0 ; 復(fù)位
119 0051 ef00 RET
No Errors, No Warnings
?? 快捷鍵說明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -