如題

我想要寫一個
XK1=A*XK+U
YK=XK

起始我先設定XK=0
A＝1(固定不變)
U=給予一個電壓值(3V) 再使用AD轉換存成AD_variable

我的作法是先將A暫存器的值和XK暫存器的值作相乘再加上AD_variable暫存器的值=>存入XK1暫存器 =>作一次PWM輸出(頻率=20kHz)

輸出完之後我馬上再將XK暫存器清除
將輸出的XK1值放入XK暫存器中
再作一次相乘相加 在作一次PWM輸出
.
.......不斷繼續累加
.
理論上的PWM訊號 波形應該是不斷累加變大
但是我的波形都相同

我想應該是在之中要作一個Holding的動作
Hold一個輸入(U)-運算-輸出(PWM)的時間
固定一段時間 運算一次

請問有那位專家大大能夠幫我解惑.... 麻煩了....
我的程式如下

;========程式宣告=============
;=======定義自訂變數暫存器名稱=====
;=======設定程式組譯起始位置======
org 0x00
nop
goto mainprogram
;=========主程式=========
mainprogram
call Initial
MainLoop
call ADtrans
call Oper
goto MainLoop

;==========初始化副程式=======
Initial
movlw B'00000000'
movwf XK
....略
;======================
Oper
movlw B'00000001'
movwf A
call MuxABXY
movf Mux_L,W
addwf AD_variable,0
movwf XK1
call PWM_Out

movwf XK ;XK1放回XK
return

;======A/D轉換副程式=======
ADtrans
banksel ADCON0
bsf ADCON0,GO
Wait
btfsc ADCON0,GO
goto Wait
movf ADRESL,W
movwf AD_variable
return

;=========================
MuxABXY ;累加A暫存器，共累加XK次
clrf Mux_H
clrw
MuxLoop
addwf A,W
btfsc STATUS,C
incf Mux_H,f
decfsz XK,f
goto MuxLoop
movwf Mux_L ;A*XK的值我取相乘完之低八位元Mux_L
return

;====PWM訊號產生及輸出副程式=====
PWM_Out
movf XK1,W
banksel CCPR1L
movwf CCPR1L
return

END

我目前希望安裝一個轉移函數(濾波器)到PIC單晶片中
我希望自己寫一個乘法器/加法器/延遲器模組
當要使用到相加或相乘的時候 能夠直接call這幾個模組來運算
但我該如何著手去設計這幾個模組
因為設計這幾個模組應該不是單純的撰寫程式
該如何去設計撰寫
並且設計完要放在哪裡 才能夠用PIC原本的complier來使用

麻煩各位前輩指導 小弟為此煩惱已久 謝謝

如題
我希望利用MPLAB來complier我的程式
而我希望將程式像MATLAB一樣
放在MPLAB的目錄下
就像是放在自己所設的toolbox中
不知道可不可行
不知道該從何下手 去了解設計步驟及方法
*我現在使用的單晶片為16F877

===麻煩各位大大===