ロボットの説明

「里」という字を書くロボットを制作した。

IMG_20150605_161430.jpg

ロボットによって書かれた字は下の写真

IMG_20150611_102348.jpg

ハードウェア

モーターを3つ搭載しておりそれぞれのモーターに縦方向、横方向、アーム(ペン)の上げ下げについての役割を割り当てた。そのため縦方向と横方向が独立しているので制御がやりやすくなった。マイコンは可動部分に置かず地面においた。縦方向にはタイヤで移動する。横方向には台車の上に設置した横移動用の機構(平面型のギアを台車に固定しアーム自体を移動するようにしたもの)を載せた。アームはモーターに直接つけるとペンの重さで滑ってしまうのでギアボックスを制作してトルクを大きくした。

ソフトウェア

サブルーチンを用いてプログラムを制作した。right()、left()は横方向に1単位量移動するプログラム、up()、down()は縦方向に単位量移動するプログラム、armup()、armdown()はアームを上げ下げするプログラムである。right()、left()、up()、down()を連続して書けば2倍、3倍の移動量にすることができる。repeat関数を用いてサブルーチン1つを繰り返すよりは、サブルーチンを2つ、3つ書いたほうがわかりやすいと感じたのでrepeat関数は使わなかった。アームを上げる前、アームを下げたあとは少し停止時間を入れて安定させた。

プログラムは以下

sub armup(){				//アームを上げる
	Off(OUT_ABC);
	Wait(50);
	OnFwd(OUT_B);
	Wait(10);
	Off(OUT_B);
}
sub armdown(){			//アームを下げる
	OnRev(OUT_B);
	Wait(10);
	Off(OUT_B);
	Wait(50);
}
sub left(){			//左へ移動
	OnRev(OUT_A);
	Wait(10);
	Off(OUT_A);
}
sub right(){			//右に移動
	OnFwd(OUT_A);
	Wait(10);
	Off(OUT_A);
}
sub up(){			//上に移動
	OnFwd(OUT_C);
	Wait(10);
	Off(OUT_C);
}
sub down(){			//下に移動
	OnRev(OUT_C);
	Wait(10);
	Off(OUT_C);
}
 
task main(){
	armdown();			//四角
	down();
	down();
	right();
	right();
	up();
	up();
	left();
	left();
	armup();		//四角終わり
	down();
	armdown();		//横1
	right();
	right();
	armup();		//横1終わり
	up();
	left();
	armdown();		//縦
	down();
	down();
	down();
	down();
	armup();		//縦終わり
	up();
	left();
	armdown();		//横2
	right();
	right();
	armup();		//横2終わり
	down();
	right();
	armdown();		//横3
	left();
	left();
	left();
	left();
	armup();		//おしまい
}

工夫した点

  1. 横方向と縦方向の移動を独立させたことによりプログラムを簡単にした。
  2. 長いコードを使用し、マイコン部分を車体から独立させてスペースを開けることにより設計が簡単になった。

苦労した点

  1. 横移動の機構の噛合がうまく行かなかったのでギアボックスにおもりとなるブロックを付けて重心の位置を調整した。
  2. 4輪の台車の時はギアボックスが左右の端に来た時に車体が傾いたため、三輪の台車にしたら傾かなくなった。
  3. ”里”の字はある長さの線の2倍、4倍の組み合わせで出来ているので上下左右単位量移動するサブルーチンを作ってそれを組み合わせて文字を書くプログラムを作った。

反省点

  1. アームをおろした時に斜めに侵入するので短い縦線が入ってしまったので垂直に上下する機構にすればよかった。
  2. アームを下ろしてすぐ移動をすると線がずれたので一定時間停止してから動き出すプログラムにしたが、丸い点ができてしまった。

添付ファイル: fileIMG_20150611_102348.jpg 116件 [詳細] fileIMG_20150605_161430.jpg 134件 [詳細]

トップ   編集 凍結 差分 バックアップ 添付 複製 名前変更 リロード   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS
Last-modified: 2015-07-24 (金) 15:39:46