![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
|
目次 課題3 † 上記のコース上の青のボールは青の缶に、赤のボールは赤の缶にそれぞれ乗せる。缶はロボット起動時にサイコロを振り、サイコロの出た目に対応した位置に置く。ボールを同じ領域内の缶に乗せたかどうか、ボールが缶に当たったか、ダミー缶を使用したかによって点数が付く。 使用ルート †自分たちのグループは以下のようなルート・手順を考えた。 
作成ロボット †ロボット全体像 † 今回は2グループ合同でのロボット作成だったのでNXTが2台あり、その片方でボールを掴んで持ち上げるアーム部分の操作、もう片方でライントレースを行うタイヤの操作を行った。 タイヤの操作、各センサの値の認識を行うNXTをマスター側、アームの操作を行うNXTをスレーブ側にしている。
右のモーターからタイヤへのギアのつながりを模式的に表すと以下のようになっている。  上記の図においてモーターとギアA、ギアBとギアC、ギアDとタイヤは棒でつながっており回転は連動する。そのためモーターを回転させるとギアAが連動して回転し、その回転がギアBに伝わることでギアCも回転し、ギアDを回転させタイヤが回転する、という流れで動力が伝わる。なおモーターとタイヤの回転比は6対1である。 ボール保持部分 †以下ボールをつかむ部分をハンド、ボールを持ち上げる部分をアームと呼称する。 ハンド †ハンド部分は上のギアを回転させることで下のギアに動力が伝わり開閉動作を行う。  アーム †モーターAの回転を橙丸部分の計5つのギアによってハンド部分に伝え、ハンドの開閉を行う。
下の写真の緑矢印の方向はハンドを閉じる方向である。  モーターB、Cを同時に同じ方向へ回転させることで、アームを上下させる。なおアーム部分の重量も大きいためモーターを2個使い、かかる重量を分散している。  図のように下の橙棒をモーターの回転によって傾きを変えることで、ハンドが繋がっている縦棒が上がりボールも上がる。 ハンドとアームの接合部分 †モーターAからアームを伝わってきた縦方向の回転は、ハンドのギアにより横回転に変換され開閉の動作を行う。  各種センサ †今回は超音波センサを2つ、光センサを1つ使用した。S1でラインの明暗を測定、S2で缶の距離を測定、S3でボールの距離を測定する。  試行錯誤 †ロボット作成当初はアームが長く、前輪タイヤが車体の前方やや外側についており、バランスが悪かった。そのため改善としてアームを短くし、前輪タイヤを中央寄りに取り付けたものを完成品とした。  動作説明 †今回の課題は前回の課題と類似点が多く存在するため類似点は簡略化し、相違点を詳しく説明する。類似点の詳しい説明は前回(Mission2)の動作説明を参照。
NXT間の通信 †今回は2つのNXTを使用しているので、片方をマスターとしもう片方のスレーブ側をBluetoothで繋げ、連携させている。今回はスレーブ側に｛アームを上げる｝｛アームを下げる｝｛ボールを掴む｝｛ボールを放す｝の4つの動作を行うプログラムを入れている。マスター側から [RemoteStartProgram(CONN,"スレーブ側のプログラム名.rxe");] を用いて命令を送ることで、スレーブ側に指定したプログラム名の動作を行わせる。 ライントレース †今回も前回と同様に線の境目をトレースするプログラムであるが、ライントレースを行う定義関数 follow_line(int bw_time,long min_t,int blk_cnt,string invert_info,string sensor_switch) において5つの引数を組み込むことで、変数の値によって行われる動作を変更している。以下に5つの変数による動作の変更点をまとめる。なお組み込んであるだけで今回の課題においては使用しておらず、動作の変更を行っていない関数もある。
線の境目のトレース方法は前回同様｛線外ならば線上に向かう｝｛線の境目ならば直進｝｛線上ならば線外に向かう｝の3つの動作を光センサの値によって制御することで行い、交差点・急カーブも同様に判断する。 缶の索敵 †缶の索敵に関しては相違点としてタイヤ間の距離と索敵範囲の変更がある。 タイヤ間の距離は単純にロボットが変わり、前回より大きくなったため長くなった。 索敵範囲は前回と違い360度一回転しなくてもよかったため、ライントレースと同様に缶を索敵する定義関数 search_throw(string side_select,float rotate_angle) に引数を組み込み、旋回方向と旋回角度を操作できるようにした。
 旋回角度を算出する式は前回同様 (タイヤ直径/前輪間の距離)*タイヤの回転角度=ロボットの旋回角度 であるが、今回はモーターとタイヤの間にギアをかませており回転比は1対6のため、タイヤの回転角は モーターの回転角/6 で算出される。 動作時間の測定 †動作時間の想定に関しては前回(Mission2)とほぼ同一であり変数名が異なるくらいである。前回のt00が今回のstart_tに対応し、t0,t1に関してはそのまま対応する。よって同様に｛t1-t0｝はロボットが右左折(旋回を含む)を継続して行っている時間を示し、｛start_t-t1｝はライントレースを開始してから何秒間経過したかを示す。 使用プログラム †スレーブ側 †
task main(){
RotateMotor(OUT_BC,-40,90); //ボールを持ち上げる
}
task main(){
RotateMotor(OUT_BC,10,90);
Wait(300);
Off(OUT_BC);
ResetTachoCount(OUT_BC);
}
task main(){
RotateMotor(OUT_A,-30,320); //ボールを掴む
Wait(300);
RotateMotor(OUT_BC,-40,15);
Off(OUT_ABC);
}
ハンドを閉じる（ボールを掴む）となぜかアームが下がってしまい、ハンド部分が地面にこすれてしまうので少しアームを上げている。
task main(){
RotateMotor(OUT_A,30,320); //ボールを放す
}
スレーブ側には上記の単純な4つのプログラムが入っている。 マスター側 †
NXT間の通信 † until(BluetoothStatus(CONN)==NO_ERR); //スレーブ側のアームを上げるプログラムを起動
RemoteStartProgram(CONN,"arm_up.rxe");
Wait(4000);
until(BluetoothStatus(CONN)==NO_ERR); //スレーブ側のアームを下げるプログラムを起動
RemoteStartProgram(CONN,"arm_down.rxe");
Wait(4000);
until(BluetoothStatus(CONN)==NO_ERR); //スレーブ側のハンドを閉じるプログラムを起動
RemoteStartProgram(CONN,"hand_close.rxe");
Wait(4000);
until(BluetoothStatus(CONN)==NO_ERR); //スレーブ側のハンドを開けるプログラムを起動
RemoteStartProgram(CONN,"hand_open.rxe");
Wait(4000);
[until(BluetoothStatus(CONN)==NO_ERR);]はNXT同士が繋がっていないと以下の動作を行わないように制限する条件文である。 ライントレース †
void follow_line(int bw_time,long min_t,int blk_cnt,string invert_info,string sensor_switch){
SetSensorLight(S1); //光センサ定義
int right_var; //光センサ値用変数
SetSensorLowspeed(S3); //超音波センサ定義
long t0,t1,start_t; // t0,t1,start_t 時間変数の定義
t1=CurrentTick(); // 今その時の時刻
t0=CurrentTick(); // 直進終了・右左折開始時刻
start_t=CurrentTick(); // ライントレース開始時刻
while(t1-start_t<min_t || min_t<0){ //ライントレース開始から指定した時間[min_t]以内で繰り返す
if(sensor_switch=="on"){ //sensor_switchにonを指定していたら
if(SensorUS(S3)<16){ //S3が16�儖米發望祿科�を探知したら
break; //while文から抜け出す
}
}
right_var = SENSOR_1; // 光センサ値代入
if(invert_info=="on"){ //invert_infoにoffを指定したら左の境目をトレースする
right_var = right_var*(-1)+91;} //onを指定したら光センサの値を反転させて右の境目をトレース
if (right_var>50){
if (t1-t0>bw_time){ // 右回で指定した時間[bw_time]以上のとき右旋回
if (blk_cnt>=0 && blk_cnt<=2 && invert_info=="on"){ //交差点の通過が停止か通過であり、右の境目をトレースしていたなら
blk_selection(blk_cnt); //blk_cntに指定された数字に適した動作を行い
break; //ライントレースを終了する
}else{
rrt;}
}else{ // 右回
rt;}
}else if (right_var>40){
fw;
t0=CurrentTick(); //直進終了・右左折開始時刻
}else{
if (t1-t0>bw_time){ // 左回で bw_time[ms] 以上のとき左旋回
if (blk_cnt>=0 && blk_cnt<=2 && invert_info!="on") {
blk_selection(blk_cnt);
break;
}else{
llt;}
}else{ // 左回
lt;}}
t1=CurrentTick(); //今その時の時刻
}Off(OUT_BC);
}
缶の索敵 † void search_throw(string side_select,float rotate_angle){
SetSensorLowspeed(S2); //超音波センサ定義
int d_min=1000,d_gosa=11,side_flag=0;
long ang_min=0,angle=0,d_angle=0;
if (side_select=="right"){ //rightを指定していれば右旋回
side_flag=1;
}else if(side_select=="left"){ //leftを指定していれば左旋回
side_flag=-1;
}
ResetTachoCount(OUT_BC);
OnFwdSync(OUT_BC,30,100*side_flag);
while(((tire_diameter/(tire_axis*gear_ratio))*MotorTachoCount(OUT_C)*side_flag)<=rotate_angle){ //指定した角度[rotate_angle]分旋回
if(d_min>SensorUS(S2)){
d_min=SensorUS(S2); //距離の最小値更新
angle=MotorTachoCount(OUT_C);
}
}
ang_min=MotorTachoCount(OUT_C)-angle;
Off(OUT_BC);
Wait(1000);
ResetTachoCount(OUT_BC);
RotateMotorEx(OUT_BC, 40, ang_min, -100*side_flag, true, true);//物体の方を向く
Off(OUT_BC);
ResetTachoCount(OUT_BC);
if(7<SensorUS(S2)){ //缶までの距離が7�儖焚爾砲覆�
OnFwd(OUT_BC,40); //物体の方に近づく
while(7<SensorUS(S2) || 40>(pi*tire_diameter*MotorTachoCount(OUT_C))/en*gear_ratio){距離が7�儖焚爾砲覆襪泙燭�40�竸覆爐泙�
d_angle=MotorTachoCount(OUT_C); //物体に近づいた分のモーターの回転角を記録
}
Off(OUT_BC);
RotateMotor(OUT_BC,30,en*2*gear_ratio/(pi*tire_diameter));
}
def_arm_up; //アームを上げる
RotateMotor(OUT_BC,30,en*d_gosa*gear_ratio/(pi*tire_diameter)); //距離の微調整
Wait(700);
def_hand_open; //ボールを放す
RotateMotor(OUT_BC,-30,en*d_gosa*gear_ratio/(pi*tire_diameter)+d_angle); //近づいた分戻る
def_arm_down; //アームを下げる
ResetTachoCount(OUT_BC);
RotateMotorEx(OUT_BC, 40, angle, -100*side_flag, true, true);//元の向きへ戻す
Off(OUT_BC);
}
プログラム全体 † task main(){
string invert_str="off";
int b_tyokusin=10,r_back=22; //直進する距離と後退する距離を定義
follow_line(1200, -1,1,invert_str,"off"); //Yから出て青ボールへ向かう
follow_line(800, -1,0,invert_str,"off");
def_hand_close; //青ボールを掴む
ResetTachoCount(OUT_BC);
RotateMotor(OUT_BC,30,en*b_tyokusin*gear_ratio/(pi*tire_diameter)); //円の中に入る
Off(OUT_BC);
search_throw("right",55.0); //右旋回角度55度で索敵
Wait(2000);
RotateMotor(OUT_BC,-30,en*b_tyokusin*gear_ratio/(pi*tire_diameter)); //円から出る
Off(OUT_BC);
def_arm_up; //アームを上げる
RotateMotor(OUT_BC,-30,en*r_back*gear_ratio/(pi*tire_diameter)); //Eの交差点まで後退する
follow_line(600,1200000,-1,invert_str,"on"); //EからFへ向かい急カーブへ行き、赤ボールを認識したらライントレースを終える
RotateMotor(OUT_BC,-30,en*3*gear_ratio/(pi*tire_diameter)); //3センチ下がる
def_arm_down; //アームを下げる
def_hand_close; //赤ボールを掴む
search_throw("left",270); //左旋回270度で索敵
Wait(1000);Off(OUT_BC);
}
結果 † 自分たちのグループ（N1N2）は本番では缶の索敵がずれる、ハンドが開かないなどの不具合が出て、缶に当てることすらできず基本点は0点だった。しかし技術点は多く貰え最終結果としては3位であった。 感想・反省 †ロボット本体に関しては大きく、重くなってしまったが、それによる悪影響を緩和できるような工夫を行え、技術点も多く貰えたので良いほうであるように感じる。しかし索敵角度のズレは缶が遠いところにあることで、超音波センサの反射に時間がかかったことによるものだと考えられる。実際試運転の時も、缶が1，2，3などの比較的近い位置の場合はほぼほぼ誤差なく缶の方向を向けていたのに対し、5，6などの遠い位置では同様にズレが生じていた。それを抑制するために旋回速度を落としてみようともしたが、ロボットが重いせいかモーターの馬力が足りず、タイヤが回転しない等の事態が起こってしまった。そのためいくら重量を緩和できるような工夫ができたからと言っても、やはりロボット本体の軽量化は大事であるように思う。 |
up-down.jpg 71件
[詳細]
bad-robot.jpeg 70件
[詳細]
result.jpg 68件
[詳細]
sensor.jpeg 65件
[詳細]
robot-over.jpeg 69件
[詳細]
arm-hand.jpeg 92件
[詳細]
arm.jpeg 30件
[詳細]
gear.jpeg 70件
[詳細]
ball-arm.jpeg 35件
[詳細]
hand.jpeg 58件
[詳細]
back-tire.jpeg 77件
[詳細]
gear-tire.png 71件
[詳細]
center-tire.jpeg 67件
[詳細]
robot.jpeg 64件
[詳細]
root.png 65件
[詳細]
2018b-mission3.png 63件
[詳細]
