'PROPORTIONAL VARIABLES
Error_P Var Word
Kp Var Word
'---------------------------
Kp=$0900
Main:
Gosub Get_Sensor_Value ' Get value from sensor
' ----- PROPORTIONAL CONTROL----------
Error_P=Set_Point-Sensor
Drive_p=(ABS Error_P) */ Kp
If Error_P.15 then Drive_P=-Drive_P
'--------------------------------------
Drive_T=Drive_T+Drive_P '(I used DriveT=Drive_T+... to keep some level of drive)
Duty=Drive_T
Gosub Duty_Mosfet
Pause 250
Goto Main
Duty_Mosfet:
If Duty>255 then Duty=255
If Duty.15=1 then Duty=0
HPWM 1,Duty,500
Return
Bookmarks