[[2014b/Member]]

目次
#contents

*はじめに [#h65b02b1]
課題は書道ロボットの作成である。
詳しい内容として、
各自の名前の中の一文字をA4用紙の中に書きなさい。 ただし7画以上の文字を選ぶこと。もし7画以上の文字がない場合には合計7画以上になるように複数の文字を書きなさい。
マクロや関数などを使い、main関数はなるべく単純になるようにプログラムを作ること。
([[2014年後期/課題１:http://yakushi.shinshu-u.ac.jp/robotics/?2014b%2FMission1]]より)

今回は「香」という文字をロボットに書かせる。


*ロボットの説明 [#l6d65f52]
#ref(2014b/Member/arisyka/Mission1/IMG_3305 p.gif,30%)

ペンを持たせるために赤で囲まれた部分を基礎となる車体に取り付け、ペンを輪ゴムで固定しただけのシンプルな構造である。

*ロボットの動作・プログラミングの説明 [#yb48396e]

ロボットに求める動きは

・必要な角度を回転させる

・ペンの上げ下げ

の２つが主となる。

全体で使う定義としてSPEED=50、モーターB、Cをそれぞれ右、左のタイヤの動きとして考える。

今回は距離からタイヤの回転角を計算するfloat型の関数を使ったプログラミングを元にロボットを動かしていく。


 float GetAngle(float d)
 {
 const float diameter=5.45;　　　　//タイヤの直径(��)
 const float pi=3.1415;　　　　　　//円周率(π)
 float ang = d/(diameter*pi)*360.0;　　//角度を計算する
 return ang;　　　　　　　　　　//角度を返す　
 }



**ロボットを回転させる [#q9d8bfe3]
文字を書くためには、ロボット本体を回転させる必要がある。ここではペンで書いた線と線を繋げるためにタイヤを片方だけ動かすだけではなく、前後の動きも必要となる。

タイヤとタイヤの長さ（r）が10.5�僂任△襪�ら、これを元にfloat型の関数を利用してタイヤの辿る円周の長さ（L=2πrX/360）求める。（X=角度）
また、ペンを上げた位置と同じ場所に持っていくために、実際にロボットを回転させ、縦と横の長さの差を定規で測り、その差をロボットに前後移動させる。


***90度回転 [#aca1e640]
90度回転させるための円周の長さは、

L＝2×3.1415×10.5×90/360＝16.5��

また、90度回転した後に10�儻紊蹐鵬爾欧襪噺気離撻鵑琉銘屬砲い�。


 #define Ninety  GetAngle(16.5)
 #define Ten GetAngle(10)

 #define　NBB　RotateMotor(OUT_B,SPEED,Ninety);RotateMotor(OUT_BC,-50,Ten);　　　　//右のタイヤを16.5�竸覆泙察�10�冖瓩襤�右に90度回転
 #define　NBC RotateMotor(OUT_C,SPEED,Ninety);RotateMotor(OUT_BC,-50,Ten);　　　　//左に90度回転


***60度回転 [#ff4fe7c6]
90度回転と同じやり方で、

L=2×3.1415×10.5×60/360≒10.995��

また、3�兪阿某覆鵑生紂�60度回転し、10.494�儻紊蹐鵬爾欧襪噺気琉銘屬砲い�。

 #define Sixty GetAngle(10.995)
 #define Three RotateMotor(OUT_BC,SPEED,GetAngle(3));

 #define SixtyBackB Three;RotateMotor(OUT_B,SPEED,Sixty);RotateMotor(OUT_BC,-50,GetAngle(10.494));　　　　//3�竸覆瓠�右のタイヤを10.494�竸覆泙擦晋紂�10.494�儻緤�へ→右に60度回転
 #define SixtyBackC Three;RotateMotor(OUT_C,SPEED,Sixty);RotateMotor(OUT_BC,-50,GetAngle(10.494));　　　　//左に60度回転


***20度回転 [#afd6aa67]
90度回転と同じやり方で

L=2×3.1415×10.5×20/360≒3.665��

また、5�竸覆鵑生紂�20度回転し、後ろに6.146（3.646+2.5）�儻紊蹐鵬爾欧襪噺気琉銘屬砲い�。

 #define Twenty GetAngle(3.665)
 #define Five RotateMotor(OUT_BC,SPEED,GetAngle(5));
 #define TwoFiveB RotateMotor(OUT_BC,-50,GetAngle(2.5));

 #define TwentyBackB Five;RotateMotor(OUT_B,SPEED,Twenty);RotateMotor(OUT_BC,-50,GetAngle(3.646));TwoFiveB;　　　　//5�竸覆瓠�右のタイヤを3.665�竸覆泙擦晋紂�6.146�儻緤�へ→右に20度回転
 #define TwentyBackC Five;RotateMotor(OUT_C,SPEED,Twenty);RotateMotor(OUT_BC,-50,GetAngle(3.646));TwoFiveB;　　　　//左に20度回転


**ペンの動作 [#x33b61aa]

ここでは唯一float型の関数を使わずにモーターの回転角度を指定してモーターを回転させることでペンの上げ下げの動作を行う。

 #define UP RotateMotor(OUT_A,SPEED,-50);　　　　//ペンを上げる
 #define DOWN RotateMotor(OUT_A,SPEED,50);　　　//ペンを下げる

#ref(2014b/Member/arisyka/Mission1/down up ループ.gif,40%)


*字を書く [#h20e4079]
**書く順番 [#o48f3095]
「香」を書くために、

1、�　崕宗廚鮟颪�→�◆崙�」を書く（「口」→「一」）→��「八」を書く→�ぁ屮痢廚鮟颪� 
#ref(2014b/Member/arisyka/Mission1/nxc senn 1.2.gif,50%)

2、�　屮痢廚鮟颪�→��横線4本を書く→��縦線3本書く→�ぁ嵌�」を書く 
#ref(2014b/Member/arisyka/Mission1/nxc senn 3.gif,50%) 


順番を3つ考え、プログラミングし、試してみた結果、2の方がまだ上手くかけたので2の書く順番を紹介する。



**プログラム [#qc6c67ee]
始めに長さを定理しますが、前へ進む距離を英語で表記し、後ろに進む動きは英語で表記したすぐ後ろに”Back”という意味で「B」と表記してあります。

 #define Two RotateMotor(OUT_BC,SPEED,GetAngle(2));　　　//2�兪阿某覆燹�
 #define TwoFive RotateMotor(OUT_BC,SPEED,GetAngle(2.5));　　//2.5�兪阿某覆燹憤焚捨�）
 #define ThreeFive RotateMotor(OUT_BC,SPEED,GetAngle(3.5));
 #define Four RotateMotor(OUT_BC,SPEED,GetAngle(4));　
 #define FiveFive RotateMotor(OUT_BC,SPEED,GetAngle(5.5));
 #define Six RotateMotor(OUT_BC,SPEED,GetAngle(6));
 #define Seven RotateMotor(OUT_BC,SPEED,GetAngle(7));
 #define Eight RotateMotor(OUT_BC,SPEED,GetAngle(8));
 #define Eleven RotateMotor(OUT_BC,SPEED,GetAngle(11));

 #define OneB RotateMotor(OUT_BC,-50,GetAngle(1));　　　//1�儻紊蹐某覆燹憤焚捨�）
 #define ThreeB RotateMotor(OUT_BC,-50,GetAngle(3));
 #define SixB RotateMotor(OUT_BC,-50,GetAngle(6));

-「ノ」を書く

 task main ()
 {
 Wait(2000);

 DOWN;
 Eight;　　　　//「ノ」を書く

-横線4本引く

 UP;
 Two;
 SixtyBackB;
 Two;
 NBB;

 DOWN;
 Eleven;　//「十」の「一」を書く
 UP;　　　

 NBC;
 TwoFive;
 NBC;
 Two;

 DOWN;
 Seven;　　　//「日」の上の「一」を書く
 UP;

 NBB;
 Two;
 NBB;

 DOWN;
 Seven;　　　//「日」の真ん中の「一」を書く
 UP;

 NBC;
 Two;
 NBC;

 DOWN;
 Seven;　　　//「日」の下の「一」を書く
 UP;

-縦線3本引く

 NBC;

 DOWN;
 Four;　　　//「日」の左の「｜」を書く
 UP;

 NBC;
 Seven;
 NBC;

 DOWN;
 Four;　　　//「日」の右の「｜」を書く
 UP;

 NBC;
 ThreeFive;
 NBC;
 Four;
 TwentyBackC;
 TwentyBackC;

 DOWN;
 Five;　　　//「十」の「｜」を書く
 UP;

-「八」を書く

 ThreeB;
 OneB;
 OneB;
 NBC;
 Three;
 NBB;

 DOWN;
 RotateMotor(OUT_B,SPEED,Sixty);　　　//10.494�僂慮未鯢舛�ことで「八」を表現する
 UP;
 }


*感想 [#nc23b398]
トップ   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS