駆動配分について
今回は駆動配分について書いていきます。
速度制御は前回書いたとおりです。
基本的には前回書いたプログラムのiSpeedPwmにdiff関数を用いて駆動配分を制御しています。
diff関数についてはマイコンカーのマニュアルに載っていたと思うのでそちらを参照してください。
通常トレースの場合は駆動配分はdiff関数で自動的に制御しています。
通常トレースの場合はこれでいいのですがどうしても駆動配分を固定したい場合などが有ります。
そういう場合には以下のプログラムを使っています。
void running_distribution( int speed, int fl, int fr, int rl, int rr){
int fl_ret;
int fr_ret;
int rl_ret;
int rr_ret;
int Calculate_speed;
Xspeed = speed;
Calculate_speed = speed - iEncoder3;
fl_ret = fl * iSpeedPwm / 100;
fr_ret = fr * iSpeedPwm / 100;
rl_ret = rl * iSpeedPwm / 100;
rr_ret = rr * iSpeedPwm / 100;
if(fl_ret >= 100) fl_ret = 100;
if(fl_ret <= -100) fl_ret = -100;
if(fr_ret >= 100) fr_ret = 100;
if(fr_ret <= -100) fr_ret = -100;
if(rl_ret >= 100) rl_ret = 100;
if(rl_ret <= -100) rl_ret = -100;
if(rr_ret >= 100) rr_ret = 100;
if(rr_ret <= -100) rr_ret = -100;
if(Calculate_speed >= 0){
motor_f( fl_ret, fr_ret );
motor_r( rl_ret, rr_ret );
}
else{
motor_f( fr_ret, fl_ret );
motor_r( rr_ret, rl_ret );
}
}
speed:目標速度
fl:左前駆動配分(上限100%)
fr:右前駆動配分(上限100%)
rl:左後駆動配分(上限100%)
rr:右後駆動配分(上限100%)
という感じで指定しています。
中身としてはiSpeedPwmに指定の値/100を掛けて配分を決めて減速時は左右逆にするというものになってます。
もしかしたら左右逆にするのはあまりよろしくないかも。