今回は黒の線をライントレースするロボットを作りました

#ref(): File not found: "IMG_20171227_175558.jpg" at page "Top/2017b/ember/hakuwa/Mission2"

ロボットの全容 紙コップをとるためのアームは振り下ろし式にした

概要

ロボット

IMG_20171227_175558.jpg
    ↑ロボットの全容 今回は紙コップをつかむためのアームを振り下ろし式にした
      また安定性を出すために真上ではなく斜め後ろに振り上げるようにした
IMG_20171227_175634 (2).jpg
     ↑アームを下した状態 紙コップが倒れずかつ多少誤差が出ても
    アームの中に紙コップを入れ運べるように幅を調節した
IMG_20171227_175725 (2).jpg
      ↑センサの位置をモータのやや前にすることで誤差を軽減した
    しかしそのせいでセンサが少し上についてしまったため
    ライントレースに誤差が生じてしまった

コース

2017b-mission2[1].png

今回は上記もコースを下記のようなルートでライントレースをした

1,Aをスタート
2,Bを直進
3,Cを右折
4,Fを直進
5,Rを左折(一時停止)
6,Pを直進
7,X地点の紙コップを取得してコースに戻る
8,Qを左折
9,Sを直進(一時停止)
10,Y地点に紙コップを置いてコースに戻る
11,Sを直進(一時停止)
12,Fを左折(一時停止)
13,Cを右折(一時停止)
14,D地点へ(ゴール)

プログラミング

ライントレース

 今回は下記図のようにジグザグに動き白か黒の継続時間によって停止するようにした

ru-to.png

 またプログラミングをtの関数で定義することで同じ色にいた時間を適宜変更することが可能になり急なカーブでも緩やかなカーブでも対応できるようにした  

def line_follow(t):
       t0 = time.time()
       t1 = time.time()
       while t0 - t1 < t: # 規定時間以上同じ色にいた時停止するようにする
               t1=time.time()
               if cs.value() >= 15: # 白の時
                       while cs.value() >= 15:
                               mA.run_forever(speed_sp= 250)
                               mD.run_forever(speed_sp= -80)
                               t0=time.time()
               elif cs.value() < 15: # 黒の時
                       while cs.value() <=15:
                               mA.run_forever(speed_sp= -80)
                               mD.run_forever(speed_sp= 250)
                               t0=time.time()
        mA.stop()
        mD.stop()
        sleep(2)
def line_follow_slow(): #緩やかなカーブでの動き
       line_follow(0.6)
       mA.run_forever(speed_sp= 100)
       mD.run_forever(speed_sp= -100)
       sleep(1.3)
       mA.stop()
       mD.stop()
       sleep(2)
def line_follow_sharp(): #急なカーブでの動き
       line_follow(0.4)
       mA.run_timed(time_sp=500, speed_sp=200, stop_action='brake')
       mD.run_timed(time_sp=500, speed_sp=-80, stop_action='brake')
       line_follow(0.4)
       mD.run_timed(time_sp=200, speed_sp=200, stop_action='brake')
       line_follow(0.6)
def line_follow_circle(): #円での動き
       line_follow()
       mA.run_forever(speed_sp=100)
       mD.run_forever(speed_sp=-100)
       sleep(0.25)
       mA.stop()
       mD.stop()
       sleep(1)
       line_follow_slow()

交差点での動作

def forward(): #直進
       mA.run_forever(speed_sp=100)
       mD.run_forever(speed_sp=100)
       sleep(0.5)
       mA.stop()
       mD.stop()
       sleep(1)
def left(): #左折
       mA.run_forever(speed_sp=200)
       mD.run_forever(speed_sp=-80)
       sleep(1)
       mA.stop()
       mD.stop()
       sleep(1)
def right(): #右折
       mA.run_forever(speed_sp=-80)
       mD.run_forever(speed_sp=200)
       sleep(1)
       mA.stop()
       mD.stop()
       sleep(1)

紙コップの処理

def get_cop(): #紙コップをつかむ
       right()
       mB.run_timed(time_sp=500, speed_sp=-200, stop_action='brake')
       sleep(1)
       left()
def release_cop(): #紙コップを置く
       mB.run_timed(time_sp=500, speed_sp=200, stop_action='brake')
       sleep(1)
       mA.run_forever(speed_sp=-80)
       mD.run_forever(speed_sp=200)
       sleep(0.4)
       mA.stop()
       mD.stop()
       sleep(1)

実際の動作

line_follow_slow()#1の動作
forward()
line_follow_slow()#2の動作 
right()
line_follow_slow()#3の動作
forward()
line_follow_sharp()#4の動作
right()
line_follow_slow()#5の動作
sleep(3)
left()
line_follow_slow()#6,7の動作
get_cop()
line_follow_circle()#8,9,10の動作
release_cop()
line_follow_slow()#11の動作
sleep(2)
forward()
line_follow_slow()#12の動作
sleep(2)
left()
line_follow_slow()#13の動作
sleep(2)
right()
line_follow_slow()#14の動作
mA.run_timed(time_sp=1000,speed_sp=200,stop_action='brake')
mD.run_timed(time_sp=1000,speed_sp=200,stop_action='brake')

総括

今回は誤差を少なくするためにセンサを近づけたのだがそのために少しセンサが浮いたため黒の判定が難しくなり結果誤差を生んでしまった。このため成功率が下がってしまったためもう少し地面に近づけるように改良できればよかった


添付ファイル: fileru-to.png 40件 [詳細] file2017b-mission2[1].png 34件 [詳細] fileライントレース.mdp 55件 [詳細] file2017b-mission2.png 19件 [詳細] fileIMG_20171227_175725 (2).jpg 41件 [詳細] fileIMG_20171227_175634 (2).jpg 33件 [詳細] fileIMG_20171227_175558.jpg 42件 [詳細]

トップ   編集 凍結 差分 バックアップ 添付 複製 名前変更 リロード   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS
Last-modified: 2018-01-26 (金) 20:21:06