PID制御計算用ライブラリ
Dependents: ROBOCON2017_archan ROBOCON2017_suchan
Diff: cal_PID.cpp
- Revision:
- 2:e340bdcb9bca
- Parent:
- 1:f1f6c98a4b12
diff -r f1f6c98a4b12 -r e340bdcb9bca cal_PID.cpp --- a/cal_PID.cpp Wed Sep 28 01:42:33 2016 +0000 +++ b/cal_PID.cpp Mon Sep 18 11:31:45 2017 +0000 @@ -32,8 +32,8 @@ past_error=0; integral_error=0; } -signed long cal_pid::get_pid(signed long position,signed long targ,int rd){ - error=targ-position; +signed long cal_pid::get_pid(signed long position,signed long targ, int out_dir){ + error = targ - position; integral_error+=error*control_period; differential_error=(error-past_error)/control_period; past_error=error; @@ -41,7 +41,7 @@ i_part=integral_error*i_gain; d_part=differential_error*d_gain; operate=p_part+i_part+d_part; - operate*=rd; + operate *= out_dir; if(operate<output_min)operate=output_min; else if(operate>output_max)operate=output_max;