![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
自作したコース(下図)に沿って一周するロボットを作成せよ。
(授業で示されたコース図）
筆者は反時計回りを担当した。
→小回りがきくようになった。
→可動部を減らし、故障しうる箇所を減らした。
(ドライブベースの写真)
(ロボットの写真)
/*マクロ・定数*/
#define THRESHOLD 45 //ライントレースの閾値
#define set_H SetPower(OUT_AC,7); //直進用速度
#define set_L SetPower(OUT_AC,1); //カーブ用速度
#define turn_l1 set_L;OnFwd(OUT_C);OnRev(OUT_A); //反時計回り旋回
#define turn_l0 set_L;OnFwd(OUT_C);Off(OUT_A); //反時計回り移動
#define turn_r0 set_L;OnFwd(OUT_A);Off(OUT_C); //時計回り移動
#define turn_r1 set_L;OnFwd(OUT_A);OnRev(OUT_C); //時計回り旋回
#define go_fwd set_H;OnFwd(OUT_AC); //前進
#define go_rev set_H;OnRev(OUT_AC); //後退
#define STEP 1 //ライントレースの各動作時間
#define C1 1000 //最初の交差点に近づくまでの時間
#define LAST_C 3000 //最後の交差点に近づくまでの時間
#define TURN_T 74 //90°回転するための所要時間
#define CAN_T 61 //ドライブ長だけ進むのに必要な時間
#define Clock FastTimer(0)-AFT+BEF //缶を動かすのに使った時間を除いた時刻
#define NCROSS 5 //交差点を判断するための閾値
#define MOR 100 //交差点を検知したあと、次の交差点を検知し始めるまでの猶予
/*グローバル変数*/
int nline=0; //交差点横断用のカウンタ
int BEF=0; //缶を動かす前の時刻を記録する変数
int AFT=0; //缶を動かした後の時刻を記録する変数
int RCH=0; //反転カウンタ
/*インライン関数*/
void line(){ //通常ライントレース
if(SENSOR_2<THRESHOLD-7){turn_l1;} //黒い部分を感知したら反時計回り旋回
else if(SENSOR_2<THRESHOLD-5){turn_l0;} //黒寄りの境界を感知したら反時計回り移動
else if(SENSOR_2<THRESHOLD+3){go_fwd;} //境界を探知したら直進
else if(SENSOR_2<THRESHOLD+5){turn_r0;} //白寄りの境界を感知したら時計回り移動
else{turn_r1;} //白い部分を感知したら時計回り旋回
Wait(STEP); //決定した動作を一定時間行う
}
void line_r(){ //各動作の方向を反転したライントレース
if(SENSOR_2<THRESHOLD-7){turn_r1;}
else if(SENSOR_2<THRESHOLD-5){turn_r0;}
else if(SENSOR_2<THRESHOLD+3){go_fwd;}
else if(SENSOR_2<THRESHOLD+5){turn_l0;}
else{turn_l1;}
Wait(STEP);
}
void line_c(){ //交差点探索を含むライントレース
if(SENSOR_2<THRESHOLD-7){turn_l1;nline++;} //黒い場所を検知したらカウンタに１加える
else{ //その他の場合はカウンタを０に戻す
if(SENSOR_2<THRESHOLD-5){turn_l0;}
else if(SENSOR_2<THRESHOLD+3){go_fwd;}
else if(SENSOR_2<THRESHOLD+5){turn_r0;}
else{turn_r1;}
nline=0;
}
Wait(STEP);
}
/*サブルーチン*/
sub cross(){ //交差点横断サブルーチン
Off(OUT_AC);PlaySound(2);Wait(10); //交差点を渡り始めることを知らせる
turn_r1;Wait(TURN_T/2); //方向修正
go_fwd;Wait(40); //交差点を渡る
if(Clock<LAST_C){turn_r1;until(SENSOR_2<THRESHOLD+5);} //ライン上に戻す
else{turn_l1;until(SENSOR_2<THRESHOLD+5);RCH++;} //最後の交差点は逆回転でライン上に戻す
nline=0; //カウンタをリセット
ClearTimer(1); //一定時間は交差点を検知しないようにする。
}
sub canturn(){ //缶移動サブルーチン
BEF=FastTimer(0); //実行前の時刻を記録
Off(OUT_AC);PlaySound(5);Wait(10); //缶を動かし始めることを知らせる
go_fwd;Wait(CAN_T); //缶と一緒にドライブ長だけ進む
turn_l1;Wait(2*TURN_T); //缶と一緒に180°反時計回り旋回
go_rev;Wait(CAN_T);turn_r1;Wait(2*TURN_T); //缶を置いてライントレースの位置へ戻る
AFT=FastTimer(0)+CAN_T; //実行後の時刻+αを記録
}
/*メインタスク*/
task main(){
SetSensor(SENSOR_1,SENSOR_TOUCH);
SetSensor(SENSOR_2,SENSOR_LIGHT);
ClearTimer(0); //走行時間タイマー
ClearTimer(1); //交差点検知を停止させるためのタイマー
/*初期動作*/
go_fwd;until(SENSOR_2>=THRESHOLD+4);PlaySound(2);Off(OUT_AC);
//スタート直後の交差点を超えるまで前進
turn_r1;until(SENSOR_2<=THRESHOLD-5);PlaySound(2);Off(OUT_AC);
//黒いところを感知するまで時計回り旋回
/*その後の動作*/
while(true){
/*状態��:ライントレース開始後一定時間経っていないor交差点横断後一定時間経っていないとき*/
while(Clock<C1||FastTimer(1)<MOR){
if(SENSOR_1==0){line();} //ライントレース
else{canturn();} //缶を検知したら移動させる
}
/*状態��:ライントレース開始後一定時間経っており、交差点横断後一定時間経っており、
さらに反転カウンタに値が入っていないとき*/
while(Clock>=C1&&RCH==0&&FastTimer(1)>=MOR){
if(SENSOR_1==0){
if(nline>=NCROSS){cross();}
//黒い部分を一定以上連続で検知したら交差点を渡る
else{line_c();} //交差点を探しながらライントレース
}
else{canturn();} //缶を検知したら移動させる
}
/*状態��:反転カウンタに値が入っているとき(=最後の交差点を超えた後)*/
while(RCH>=1){
if(SENSOR_1==0){line_r();} //反転ライントレース
else{canturn();} //缶を検知したら移動させる
}
}
}
 |
1．まず白い部分を検知するまで前進する。
2．その後黒い部分を検知するまで時計回り旋回を行う。
この部分で通常のライントレースをすると、ロボットの初期位置によっては時計回りコースへ進入してしまうので、
確実に反時計回りコースに侵入するようにこのような方法をとった。
1. 開始後１０秒経過するまでは状態�，覇虻遒垢襦�
2．１０秒経過したら、状態�△飽楾圓垢襦�
3．黒い部分を５回連続で検知したら、交差点横断サブルーチンを実行する。
4．実行後１秒以内は状態�，覇虻遒垢襦�
5．１秒経過後は再び状態�△飽楾圓垢襦�
開始後１０秒以内・交差点横断後１秒以内に状態�，覇虻遒垢襪里蓮�交差点でない部分を誤って交差点と認識してコースから外れてしまうのを防ぐためである。
なお、交差点横断サブルーチンの内容は次項に譲る。
1．停止して、音を発して交差点横断を始めることを知らせる。
2．ロボットがコースに対しておよそ平行になるように、４５°だけ時計回り旋回をする。
3．0.4秒直進する。
4．ラインからずれている場合はライン上に乗るまで時計回り旋回する。
5．黒い部分を連続で検知した回数を記録するカウンタをリセットする。
6．実行後１秒は交差点探索を行わないようにするため、タイマーを開始する。
ポイントBの前まで(状態� Ν�)は進行方向左側の境界に沿ってライントレースを行っていることをご留意いただきたい。
1．まず交差点横断サブルーチンの１〜３までを行う。
2．このときロボットは進行方向右側にずれるので、４を逆回転(反時計回り)で行う。
3．反転カウンタに+1加える。(状態��のトリガー)
4．５・６を行う。
5．状態��で動作する。
ここで行っているのは、ライントレースに用いる境界の切り替えである。
境界の切り替えを行わなかった場合、進行方向左側の境界にはゴールの目印となるものはないため、
ゴールを探索する手段を別に講じる必要があった。
しかし境界を切り替えることにより、ゴールするときに特別の工程は不要となる。
このプログラムは基本的に次の3つの状態を遷移しながら動作する。
状態��:進行方向左側の境界に沿ったライントレース
状態��:交差点認識を含む進行方向左側の境界に沿ったライントレース
状態��:進行方向右側の境界に沿ったライントレース
このほかに、「初期動作」、缶を移動する工程が存在する。
 |
文書1.png 280件
[詳細]
image-22ma.jpg 273件
[詳細]
image_2.jpeg 275件
[詳細]
image_1.jpeg 304件
[詳細]
image.jpeg 273件
[詳細]
zu.jpg 309件
[詳細]
