![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
目次
今回の課題は書道ロボットで、名前の中の一文字をA4用紙の中に書くロボットを作るというものでした。僕は「谷」という漢字を書きました。
はじめは左右に旋回できる基本形の車体のロボットに上下できるだけのペンを付けたもので書くつもりで作りましたが、いざ動かすと旋回したときにペンの位置がずれてしまい、綺麗な角を書くことができませんでした。その改善策として、前後に進む車体にアームを付けたものに一から作り直すことで目的の文字をかけました。
画像の様に前後に進む車体に横方向に動くアームを付けた形になっています。前後の動きがギア比を変えてもちょうどいい距離にならなかったので、車輪を大きいものから小さいものにすることで調整しました。アームにはモーターが一つ載っているため、車体が浮かないようにアームの逆側に重り用のタイヤを付けています。
モーター１つが載るので、なるべく頑丈な土台の上を動くようにしました。軽量化のためになるべく少ない部品でできるようにしました。
ギザギザのついたパーツによって動くようにしています。
ペンの上下のモジュールには苦労しました。
まず、ペンの固定ですが、ちょうどアームのようなものがあったのでそれとゴムを使ってはさんで固定しました。上下の動作には図書館で借りた本に書いてあったものを少し応用して形にすることができました。
#define XbackYforward(t) OnRev(OUT_B);OnFwd(OUT_A);Wait(t);Off(OUT_AB); //左上
#define XbackYback(t) OnRev(OUT_AB);Wait(t);Off(OUT_AB); //左下
#define XforwardYforward(t) OnFwd(OUT_AB);Wait(t);Off(OUT_AB); //右上
#define XforwardYback(t) OnRev(OUT_A);OnFwd(OUT_B);Wait(t);Off(OUT_AC); //右下
#define Yforward(t) OnFwd(OUT_A);Wait(t);Off(OUT_A); //上
#define Yback(t) OnRev(OUT_A);Wait(t);Off(OUT_A); //下
#define Xforward(t) OnFwd(OUT_B);Wait(t);Off(OUT_B); //右
#define Xback(t) OnRev(OUT_B);Wait(t);Off(OUT_B); //左
#define writeon OnFwd(OUT_C);Wait(5);Off(OUT_C); //書き始め
#define writeoff OnRev(OUT_C);Wait(5);Off(OUT_C); //書き終わり
#define movetime 20 //一辺の長さ
task main ()
{
writeon;
XbackYforward(movetime);
writeoff;
Xback(movetime*2);
writeon;
XbackYback(movetime);
writeoff;
Yback(movetime*2);
writeon;
XforwardYforward(movetime*2);
XforwardYback(movetime*2);
writeoff;
Xback(movetime);
writeon;
Xback(movetime*2);
Yback(movetime*2);
Xforward(movetime*2);
Yforward(movetime*2);
writeoff;
}
まずは以下の通り全方向に動くための定義をしました。
#define XbackYforward(t) OnRev(OUT_B);OnFwd(OUT_A);Wait(t);Off(OUT_AB); //左上 #define XbackYback(t) OnRev(OUT_AB);Wait(t);Off(OUT_AB); //左下 #define XforwardYforward(t) OnFwd(OUT_AB);Wait(t);Off(OUT_AB); //右上 #define XforwardYback(t) OnRev(OUT_A);OnFwd(OUT_B);Wait(t);Off(OUT_AC); //右下 #define Yforward(t) OnFwd(OUT_A);Wait(t);Off(OUT_A); //上 #define Yback(t) OnRev(OUT_A);Wait(t);Off(OUT_A); //下 #define Xforward(t) OnFwd(OUT_B);Wait(t);Off(OUT_B); //右 #define Xback(t) OnRev(OUT_B);Wait(t);Off(OUT_B); //左
それからペンの上下の定義をしました。
#define writeon OnFwd(OUT_C);Wait(5);Off(OUT_C); //書き始め #define writeoff OnRev(OUT_C);Wait(5);Off(OUT_C); //書き終わり
そして、この形のロボットでは横、斜め、縦の動きをすることしかできないので、マス目を意識してプログラムをするために、一辺の長さ(一辺分動く時間)を定義しました。
#define movetime 20 //一辺の長さ
右の図の様な書き順で書きました。オレンジの部分でペンが降り、水色の部分でペンが上がります。
writeon; XbackYforward(movetime); writeoff;
Xback(movetime*2); writeon; XbackYback(movetime); writeoff;
writeon; XforwardYforward(movetime*2); XforwardYback(movetime*2); writeoff;
writeon; Xback(movetime*2); Yback(movetime*2); Xforward(movetime*2); Yforward(movetime*2); writeoff;
少し歪みはありますが、目的の字を書くことはできました。マス目を意識することによってだいぶ簡単にプログラムをすることができたのがとてもよかったと思いました。
グループで製作ということで、３人で相談しあいながらなんとか形にできたのは大きな達成感を得ることになりました。
今回はアーム式だったので45°の斜め線で統一することになりましたが、SetPower関数というものがあるそうなのでそれを今度使ってみたいと思いました。
おまけで、写真はありませんが、「熊」を書くプログラムも書きました。容量が大きく、defineではコンパイルができなかったので関数を使っています。最後の点3つは繰り返しを使っています。
プログラムはこちら
S__32784393.jpg 226件
[詳細]
谷.png 206件
[詳細]
S__9723906.jpg 115件
[詳細]
S__9723911.jpg 403件
[詳細]
S__9723908.jpg 334件
[詳細]
