?? 5-6.asm
字號:
.mmregs
.def main
.def ad50_data
spsa0 .set 38h ; 緩沖串口0子地址地址寄存器
spcd0 .set 39h ; 緩沖串口0子地址數(shù)據(jù)寄存器
drr21 .set 40h ; 緩沖串口1數(shù)據(jù)1接收寄存器
drr11 .set 41h ; 緩沖串口1數(shù)據(jù)2接收寄存器
dxr21 .set 42h ; 緩沖串口1數(shù)據(jù)2發(fā)送寄存器
dxr11 .set 43h ; 緩沖串口1數(shù)據(jù)1發(fā)送寄存器
dxr10 .set 23h ; 緩沖串口0數(shù)據(jù)1發(fā)送寄存器
drr10 .set 21h ; 緩沖串口0數(shù)據(jù)1接收寄存器
spcr10 .set 00h ; 設(shè)置緩沖串口的所有寄存器的子地址
spcr20 .set 01h
rcr10 .set 02h
rcr20 .set 03h
xcr10 .set 04h
xcr20 .set 05h
srgr10 .set 06h
srgr20 .set 07h
mcr10 .set 08h
mcr20 .set 09h
rcera0 .set 0ah
rcerb0 .set 0bh
xcera0 .set 0ch
xcerb0 .set 0dh
pcr0 .set 0eh
k_iptr .set 000111000b<<07 ; 設(shè)置中斷向量表的地址，指向0x1C00
k_temp .set 1111111b
b1 .set 0557h ; 濾波器的參數(shù)b1
b2 .set 1067h ; 濾波器的參數(shù)b2
b3 .set 1067h ; 濾波器的參數(shù)b3
b4 .set 0557h ; 濾波器的參數(shù)b4
a1 .set 0EEFh ; 濾波器的參數(shù)a1
a2 .set 10DCh ; 濾波器的參數(shù)a2
a3 .set 0AF9h ; 濾波器的參數(shù)a3
k_a .set 3 ; 濾波器參數(shù)a的個數(shù)
k_b .set 4 ; 濾波器參數(shù)b的個數(shù)
k_buffer .set 8 ; 濾波器循環(huán)緩沖的大小
buffery .usect "filter_vars",k_buffer*2 ; 定義濾波器數(shù)據(jù)輸出緩沖區(qū)
bufferx .usect "filter_vars",k_buffer*2 ; 定義濾波器數(shù)據(jù)輸入緩沖區(qū)
data_dp .usect "filter_vars",0 ; 定義數(shù)據(jù)頁指針
main:
STM 4000h,sp ; 設(shè)置堆棧指針
LD #0h,dp ; 設(shè)置數(shù)據(jù)頁指針
LDM pmst,a ; 改變中斷向量表首地址
AND #k_temp,a
OR #k_iptr,a
STL a,ar6
MVDM ar6,pmst
NOP
NOP
NOP
STM #0ffffh,tcr ; 關(guān)閉定時器
STM #05h,prd ; 設(shè)置定時器周期寄存器
STM #08e0h,tcr ; 設(shè)置定時器控制寄存器
SSBX intm ; 關(guān)閉中斷
SSBX sxm
ST #2491h,swwsr ; 設(shè)置外設(shè)等待時間寄存器
NOP
NOP
SSBX xf ; 設(shè)置XF引腳為高
NOP ; 等待硬件完成高電平檢測
NOP
dss_init:
RSBX cpl ; 設(shè)置DSP的緩沖串口0的所有寄存器
NOP
NOP
STM spcr10,spsa0
NOP
STM 06h,spcd0 ; 寫入06h到spcr10寄存器
NOP
stm spcr20,spsa0
NOP
STM 200h,spcd0 ; 寫入200h到spcr20寄存器
NOP
STM pcr0,spsa0
NOP
STM 0eh,spcd0
NOP
STM rcr10,spsa0
NOP
STM 40h,spcd0
NOP
STM rcr20,spsa0
NOP
STM 4h,spcd0
NOP
STM xcr10,spsa0
NOP
STM 40h,spcd0
NOP
STM xcr20,spsa0
NOP
STM 4h,spcd0
NOP
LD #64h,a ; 等待一段時間
RPT #50
NOP
STM spcr10,spsa0
NOP
STM 07h,spcd0 ; 開啟緩沖串口
NOP
STM spcr20,spsa0
NOP
STM 201h,spcd0
NOP
RPT #50
NOP
aic_init: ; 初始化AD50
STM 0h,imr ; 設(shè)置中斷寄存器
ORM 10h,imr
STM 0ffffh,ifr ; 清上電復(fù)位可能影響的中斷標(biāo)志
PORTW 08h,02h
NOP
NOP
NOP
CALL wait
waitr$14$:
STM 0h,spsa0
NOP
LDM spcd0,a
NOP
NOP
NOP
AND #2h,0,a,a
BC waitr$14$,aeq ; 判斷是否可以寫數(shù)據(jù)到AD50
STM #101h,dxr10 ; 設(shè)置AD50的控制寄存器1
CALL wait
STM 0ffffh,ifr
waitr$17$:
STM 0h,spsa0
NOP
LDM spcd0,a
NOP
NOP
NOP
AND #2h,0,a,a
BC waitr$17$,aeq ; 判斷是否可以寫數(shù)據(jù)到AD50
STM #210h,dxr10 ; 設(shè)置AD50的控制寄存器2
CALL wait
STM 0ffffh,ifr
waitr$22$:
STM 0h,spsa0
NOP
LDM spcd0,a
NOP
NOP
NOP
AND #2h,0,a,a
BC waitr$22$,aeq ; 判斷是否可以寫數(shù)據(jù)到AD50
; STM #430h,dxr10 ; 設(shè)置20kHz采樣頻率
; STM #440h,dxr10 ; 設(shè)置15kHz采樣頻率
STM #400h,dxr10 ; 設(shè)置8kHz采樣頻率
CALL wait ; 設(shè)置AD50的控制寄存器4
STM 0ffffh,ifr
waitr$24$:
STM 0h,spsa0
NOP
LDM spcd0,a
NOP
NOP
NOP
AND #2h,0,a,a
BC waitr$24$,aeq ; 判斷是否可以寫數(shù)據(jù)到AD50
STM #301h,dxr10 ; 設(shè)置AD50的控制寄存器3
CALL wait
SSBX frct ; 設(shè)置數(shù)據(jù)的小數(shù)方式位
STM #buffery,ar4 ; 設(shè)置輸出數(shù)據(jù)指針
STM #bufferx, ar3 ; 設(shè)置輸入數(shù)據(jù)指針
STM #buffery, ar5
STM #k_buffer,bk ; 設(shè)置循環(huán)指針
STM #1, ar0
NOP
STM 0ffffh,ifr ; 清中斷標(biāo)志寄存器
NOP
RSBX xf
NOP
NOP
NOP
LDM drr10,a ; 清空緩沖串口0的數(shù)據(jù)接收寄存器
NOP
STM 0h,imr
ORM 10h,imr ; 設(shè)置緩沖串口0的接收中斷
NOP
NOP
RSBX intm ; 開啟總中斷
js:
NOP
NOP
B js
NOP
NOP
NOP
wait: ; 延時子程序
RPT #8048
NOP
RET
NOP
NOP
ad50_data: ; AD50接收數(shù)據(jù)中斷子程序
LDM drr10,a ; 接收數(shù)據(jù)送到累加器A
CALL filter ; 調(diào)用濾波子程序
NOP
NOP
RETE
NOP
NOP
filter: ; 濾波子程序
NOP
NOP
NOP
STL a,*ar3 ; 采樣數(shù)據(jù)送到ar3指向的數(shù)據(jù)空間
NOP
MAR *ar3-0% ; 調(diào)整指針ar3，適應(yīng)濾波器算法
MAR *ar3-0%
MAR *ar3-0%
; 開始做濾波算法
MPY *ar3+0%,#b4,b ; b=b4*x(i)
LD a,b
MPY *ar3+0%,#b3,b ; b=b3*x(i+1)
ADD a,b
MPY *ar3+0%,#b2,b ; b=b2*x(i+2)
ADD a,b
MPY *ar3+0%,#b1,b ; b=b1*x(i+3)
ADD a,b ; y(x+3)=a
MPY *ar4+0%,#a3,b ; b=y(i)*a3
ADD a,b ; a=a+b
MPY *ar4+0%,#a2,b ; b=y(i+1)*a2
ADD a,b ; a=a+b
MPY *ar4+0%,#a1,b ; a=y(i+2)*a1
ADD a,b ; y(x+3)=a+b
; STFA a,-2,b
STH b,*ar4-0% ; FILTER++
; STFA a,3,a
STH a,dxr10 ; 濾波后數(shù)據(jù)送到DA輸出
MAR *ar4-0% ; 調(diào)整濾波器數(shù)據(jù)指針，為下一次數(shù)據(jù)濾波做準(zhǔn)備
NOP
NOP
RET
NOP
NOP
?? 快捷鍵說明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -