- 追加された行はこの色です。
- 削除された行はこの色です。
目次
#contents
* 書道ロボット [#kc6aef55]
プログラムを起動すると、自分で字を書くロボットを製作した。
#ref(2015b/Member/rmsun/Mission1/IMG_1057.JPG,360*480,高(固定))
#ref(2015b/Member/rmsun/Mission1/IMG_1078.JPG,360*480,高(本番))
* ロボット本体 [#cec79a4d]
サンプルロボットの後ろにペンをつけた。
サンプルロボットの後ろにペンをつけた構造。
#ref(2015b/Member/rmsun/Mission1/IMG_1060.JPG,360*270,書道ロボット正面)
#ref(2015b/Member/rmsun/Mission1/IMG_1061.JPG,360*480,書道ロボット側面)
*プログラム [#m32e30bc]
このプログラムでは、サーボモータを使い、モータの回転する角度を指定して、ロボットを動かす。
**メイン関数以外のプログラム [#wb572dc0]
***マクロの定義 [#ca3c85e6]
方向変換時のスピードは、タイヤの摩擦を減らすことばかり考えた結果、100になった(せざるを得なかった)。このおかげで、紙をおさえなければ、字が書けなくなってしまった。
#define SPEED 30 //前転後転時のスピード
#define WRITE_SPEED 20 //字を書くときのスピード
#define TURN_SPEED 100 //方向変換時のスピード
#define PUT_ANGLE 91 //ペンを上げ下げする時、モータが回転する角度
ペンの上げ下げを行うマクロ「down」と「up」。モータの回転する角度を指定しているだけあって、ペンの上下する角度は安定している。ペンを二段階に分けて下ろす。一段階目(down1)で「残り20度で接地する」ところまで素早く下ろし、二段階目(down2)で「残りの20度」ゆっくり下ろす。上げるとき(up)は、素早く、一気に一段階で。
#define down1() RotateMotor(OUT_A,-30,PUT_ANGLE-20)
//ペンを素早く下げる(地面にはつけない)
#define down2() RotateMotor(OUT_A,-5,20)
//ペンをゆっくり地面につける
#define up() RotateMotor(OUT_A,70,PUT_ANGLE);
//ペンを上げる
***文字の倍率を設定するための変数「magni」 [#y2c1419e]
「magni×移動距離」移動する、と置くことで、好きな大きさで文字を書けるようにする。
移動にはサブルーチンを使っているため、magniをあちこちにつける必要は無く、3つのサブルーチンにつけるだけで済んだ。
float magni=1.0; //倍率を設定 例:magni=2.0 → 文字の大きさが2.0倍
***タイヤの回転数を計算する関数「GetAngle_d」「GetAngle_s」 [#rbfc594a]
タイヤの回転数を計算するために使う変数
float pen_to_center=17.0; //回転の中心(左右のタイヤの中間)からペンまでの距離
float diameter=5.45; //タイヤの直径(cm)
float pi=3.1415; //円周率
float tire_ang; //距離(cm)進むときに必要な、タイヤの回転する角度
float tire_ang; //タイヤの回転する角度(返り値用)
進みたい距離(cm)から、タイヤの回転数を計算する関数「GetAngle_d」（http://yakushi.shinshu-u.ac.jp/robotics-jr/robotics-jr-2013.pdfの31ページのプログラムを参考にしました）
float GetAngle_d(float distance) {
//進みたい距離(cm)「distance」から、タイヤの回転数を計算する関数
tire_ang=(distance)/(diameter*pi)*360.0; //角度を計算する
return tire_ang; //角度を返す(float型)
}
方向変換したい角度から、タイヤの回転数を計算する関数「GetAngle_s」(http://yakushi.shinshu-u.ac.jp/robotics-jr/robotics-jr-2013.pdfの31ページにある練習問題62を参考にしました)
float GetAngle_s(float spin_ang) {
//方向変換したい角度「spin_ang」から、タイヤの回転数を計算する関数
const float spin_dia=11.4;
//ロボットがその場で1周回転した時に、タイヤが地面に描く円の直径spin_dia(cm)
//spin_dia...左右のタイヤの間隔
tire_ang=(spin_dia*spin_ang)/(diameter);
//方向変換したい角度から、タイヤの回転する角度を計算する
/*約分前の式は tire_ang=(spin_dia*pi*(spin_ang/360.0)*360.0)/
(diameter*pi) */
return tire_ang; //角度を返す(float型)
}
***ロボットを動かすサブルーチン「forward」「reverse」「turn」 [#k7fa5963]
サブルーチン「forward」...指定した距離(cm)だけ前転する
sub forward(float fwd){
RotateMotorEx(OUT_BC,SPEED,GetAngle_d(fwd)*magni,0,true,true);
//fwd(cm)*magni(倍率)前転
}
サブルーチン「reverse」...指定した距離(cm)だけ後転する
sub reverse(float rev) {
RotateMotorEx(OUT_BC,-SPEED,GetAngle_d(rev)*magni,0,true,true);
//rev(cm)*magni(倍率)後転
}
GetAngle_dを用いることで、サブルーチン「forward」「reverse」は前転後転する距離(cm)を、そのまま引数にとれる
GetAngle_dを用いることで、サブルーチン「forward」「reverse」は「前転後転する距離(cm)」をそのまま引数にとることができる
例:3.0cm進みたいとき → forward(3.0)
5.0cm下がりたいとき → reverse(5.0)
サブルーチン「turn」...指定した角度ロボットが回転する
sub turn(float tn,int pl_mi) {
//tn(度)方向変換
/*pl_mi=1 → 右まわりに回転
pl_mi=-1 → 左まわりに回転*/
RotateMotorEx(OUT_BC,TURN_SPEED,GetAngle_s(tn),100*pl_mi,true,true);
//左右のタイヤの逆向きに回すことで方向変換
Off(OUT_BC);
Wait(100);
}
GetAngle_sを用いることで、サブルーチン「turn」は回転する角度を、そのまま引数にとれる
GetAngle_sを用いることで、サブルーチン「turn」は「回転する角度」をそのまま引数にとることができる
例:90度右回転させたいとき → turn(90,1);
***ペンの位置を変えずに方向変換するサブルーチン「spin_re」 [#d4c2619e]
引数pl_miは、ロボットが右回転するか左回転するかを決める
sub spin_re(float spin_ang,int pl_mi) {
//「ペンを中心に、spin_ang度回転する」(ときと同じ結果になる)関数
/*右に回転するとき...pl_mi=1
左に回転するとき...pl_mi=-1*/
「ロボットが回転する時に生じる誤差」を修正するための「gosa1」「gosa2」
float gosa1=0; //右に回転するときの誤差「gosa1」
float gosa2=0; //左に回転するときの誤差「gosa2」
if (pl_mi>0) { //pl_mi>0(右への方向変換のとき)
gosa1=0.5; //右へ回転するときの誤差を修正する
}
else { //左への方向変換のとき
gosa2=0.5; //左へ回転するときの誤差を修正する
}
実際の方向変換の動作
RotateMotorEx(OUT_BC,-50,GetAngle_d(pen_to_center-gosa1),0,true,true);
//pen_to_center-gosa1(cm)後転(gosaは回転の時のズレを調節するため)
turn(spin_ang,pl_mi); //spin_ang(度)回転
RotateMotorEx(OUT_BC,20,GetAngle_d(pen_to_center-gosa2-gosa1),0,true,true);
//pen_to_center-gosa2-gosa1(cm)前転
***字を書くときに使うサブルーチン「write」 [#x81c3f00]
ペンを二段階に分けて下げるのが特徴。一段階目では速いスピードで下ろし、二段階目ではゆっくりペンを地面につけることで、ペンには安定した接地をしてもらう。ペン接地後は、指定された距離だけ進んで、ペンを上げるサブルーチンになっている。
ペンを二段階に分けて下ろすのが特徴。一段階目(down1)では「あと20度で接地するところ」まで素早く下ろし、そこで0.1秒停止する。二段階目(down2)では、「残りの20度」だけゆっくりペンを下ろす。ペンが接地するときに発生する力は、二段階目の「20度分だけゆっくり下ろした」ときの力なので、ペンは安定した接地が可能。
ペン接地後、指定された距離だけ進む(このとき字を書く)。その後、ペンを上げる。このとき、ペンを素早く、一気に(一段階で)上げることで、無駄なインクが紙に付くのを防ぐ。
sub write(float kaku) //ペンで線を引く
{
down1(); //ペンを素早く下げる(地面にはつけない)
Wait(100);
down2(); //ペンをゆっくり地面につける
Wait(10);
RotateMotorEx(OUT_BC,WRITE_SPEED,GetAngle_d(kaku)*magni,0,true,true);
//WRITE_SPEEDの速さでkaku(cm)進む → kaku(cm)の線を書く
up(); //ペンを上げる
}
***「口」を書くためのサブルーチン「kuti」 [#k0ad77bc]
sub kuti(float tate, float yoko) //口の字を書く
//口の縦の長さ(tate)と、横の長さ(yoko)を引数にとる
{
write(tate); //tate(cm)書く
spin_re(90.0,-1); //ペンを中心に90度左回転
write(yoko); //yoko(cm)書く
spin_re(90.0,-1); //ペンを中心に90度左回転
write(tate); // ↓ここから上の繰り返し(repeatを使ったら誤差が出た)
spin_re(90.0,-1);
write(yoko);
spin_re(90.0,-1);
}
**方向変換するときの動作を詳しく [#f0fe2ef5]
サブルーチン「spin_re」を使ったとき、ロボットが実際にどのような動作をするのかの説明
「spin_re」は、ロボットを回転させつつ、ペンの位置を最初と同じにするのが目的
回転の中心は、モータBとモータCの間にある
#ref(2015b/Member/rmsun/Mission1/IMG_1078.JPG,360*480,回転の中心)
ペンの初期位置
#ref(2015b/Member/rmsun/Mission1/IMG_1082.JPG,360*480,ペンの初期位置)
***� 峅鹽召涼羶粥廚函屮撻鵑琉銘屐廚竜�離分だけ後転する [#v6e2c55b]
このとき使ったプログラム↓↓
RotateMotorEx(OUT_BC,-50,GetAngle_d(pen_to_center-gosa1),0,true,true);
//pen_to_center-gosa1(cm)後転(gosaは回転の時のズレを調節するため)
#ref(2015b/Member/rmsun/Mission1/IMG_1085.JPG,360*480,後退)
***�▲蹈椒奪箸鮖慊蠅粒囘找鹽召気擦� [#b0a71654]
実際に方向変換したい角度分、回転させる
このとき使ったプログラム↓↓
turn(spin_ang,pl_mi); //spin_ang(度)回転
#ref(2015b/Member/rmsun/Mission1/IMG_1086.JPG,360*480,後退時のペンの位置)
回転↓↓
#ref(2015b/Member/rmsun/Mission1/IMG_1089.JPG,360*480,回転)
***��「回転の中心」と「ペンの位置」の距離分だけ前転する [#a584e47f]
このときのペンの位置は、最初のペンの位置と同じ
このとき使ったプログラム↓↓
RotateMotorEx(OUT_BC,20,GetAngle_d(pen_to_center-gosa2-gosa1),0,true,true);
//pen_to_center-gosa2-gosa1(cm)前転
#ref(2015b/Member/rmsun/Mission1/IMG_1094.JPG,360*480,進む)
***�し覯� [#h5e0c8c4]
「最初の位置から、ペンを中心にして回転したとき」と同じ結果が得られる
#ref(2015b/Member/rmsun/Mission1/IMG_1095.JPG,360*480,結果)
**メイン関数 [#m0a26da1]
task main()
{
up(); //ペンを地面につけたままスタート
write(1.0); //１画目
//２画目の位置まで移動
spin_re(90.0,-1); //ペンを中心に90度左回転
reverse(2.0); //2.0(cm)後転
write(4.0); //２画目
//３画目（口の部分）まで移動
reverse(3.0); //3.0(cm)後転
spin_re(90.0,1); //ペンを中心に90度右回転
forward(0.5); //0.5(cm)前転
kuti(1.0, 2.25); //「口」の字を書く(４，５，６画目)
//７画目（「高」の左下の「|」の部分）まで移動
forward(1.5); //1.5(cm)前転
spin_re(90.0,-1); //ペンを中心に90度左回転
reverse(1.25); //1.25(cm)後転
spin_re(90.0,1); //ペンを中心に90度右回転
write(3.0); //７画目
//８画目(真ん中を通る「一」の部分)まで移動
reverse(3.0); //3.0(cm)後転
spin_re(90.0,-1); //ペンを中心に90度左回転
write(4.75); //８画目
//９画目(右下の「｜」の部分)まで移動
spin_re(90.0,1); //ペンを中心に90度右回転
write(3.0); //９画目
spin_re(90.0,1); //ロボットの向きを７画目の「ー」と平行にする
//最後の「口」の部分まで移動
forward(3.5); //3.5(cm)前転
spin_re(90.0,-1); //ペンを中心に90度左回転
reverse(2.5); //2.5(cm)後転
kuti(1.0, 2.25); //最後の「口」を書く
}
*感想、反省点 [#y108e50d]
プログラムがかなり長くなってしまった。必要以上にサブルーチンを使っているので、サブルーチン同士をまとめたりして、さらに減らすべきだった。ロボット製作が苦手で、ロボット作りでは全く貢献できなかった。今度からは、苦手なりに貢献できるように頑張りたい。
![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
