2016a/Member

課題内容†

今回の課題は地点A・B・Cに紙コップが３個ずつ設置されそのコップを回収しコースの真ん中にある円の部分に運ぶという課題です。
またコップは同じ地点にあったものを連続で重ねてはいけなく、A・B・Cの順番に重ねなければなりません。

line01.jpg
↑

ロボットの仕組み†

今回この課題をクリアするために二つのロボットを作成することにしました。
１つ目は紙コップを各地点から回収するためのロボットです。
もう１つは紙コップを積み重ねるためのロボットです。

↑

１つ目†

１つ目は紙コップを各地点から回収してきて、一カ所に集めるためのロボットです。

robot3.jpg

このロボットは先端にある口のような形になった場所を開き閉じることでコップを挟み保持します。

robot4.jpg

またコップをつかむためにコップとの距離を測る必要があり、先端に赤外線センサーを設置しました。

↑

２つ目†

今回私たちのチームは履帯を使うという部分にこだわりました。
なぜなら他のチームにはないようなロボットを作成したいと思ったからです。

robot1.jpg
robot2.jpg

コップを履帯で持ち上がるために履帯に突起をつけてコップが引っかかりやすくしました。
コップを落とすための仕組みは右側の履帯の下の支えを右側に広げることにより
履帯と履帯の隙間をひろげ、落ちるようにしました。

↑

プログラム†

↑

１つ目†

#!/usr/bin/python

import ev3dev.ev3 as ev3
import time

ml = ev3.LargeMotor('outB')
mr = ev3.LargeMotor('outA')
mm = ev3.MediumMotor('outC')
cs = ev3.ColorSensor('in1')
de = ev3.InfraredSensor('in2')

def catch():
        while de.value() < 50:
                if de.value() < 10:
                        ml.run_forever(duty_cycle_sp=0)
                        mr.run_forever(duty_cycle_sp=0)
                        mm.run_forever(duty_cycle_sp=50)
                        time.sleep(4)
                        mm.run_forever(duty_cycle_sp=0)
                        ml.run_forever(duty_cycle_sp=-20)
                        mr.run_forever(duty_cycle_sp=-20)
                        time.sleep(1.5)
                        ml.run_forever(duty_cycle_sp=0)
                        mr.run_forever(duty_cycle_sp=0)
                        ml.run_forever(duty_cycle_sp=-50)
                        mr.run_forever(duty_cycle_sp=50)
                        time.sleep(1.6)
                        ml.run_forever(duty_cycle_sp=0)
                        mr.run_forever(duty_cycle_sp=0)
                else:
                        ml.run_forever(duty_cycle_sp=15)
                        mr.run_forever(duty_cycle_sp=15) 

def lineleft():
        t0 = time.time()
        while time.time() - t0 < 0.35:
                if cs.value () > 50 :
                        mr.run_forever(duty_cycle_sp=-30)
                        ml.run_forever(duty_cycle_sp=60)
                        t0 = time.time()
                else:
                        mr.run_forever(duty_cycle_sp=60)
                        ml.run_forever(duty_cycle_sp=-30) 



def cross(t,dl,dr):
       mr.run_forever(duty_cycle_sp=dr)
       ml.run_forever(duty_cycle_sp=dl)
       time.sleep(t/1000)
       ml.stop()
       mr.stop()

def toa():
        lineright()
        cross(1000,-20,20)
        cross(1000,13,13)
        lineright()
        cross(1000,0,0)
        cross(1000,-18,18)
        cross(1000,0,0)
        catch()
        cross(1400,30,-30)
        lineright()
        cross(1000,0,0)
        cross(1000,-20,20)
        cross(1000,10,10)
        lineright()
        cross(1000,0,0)
        cross(1000,-25,25)
        mm.run_forever(duty_cycle_sp=-50)
        time.sleep(3)
        mm.run_forever(duty_cycle_sp=0)
        cross(1000,-30,-30)
        cross(2000,-40,40) 

def tob():
        lineleft()
        cross(1000,-10,10)
        lineright()
        cross(1000,-20,20)
        cross(1000,13,13)
        lineright()
        cross(1000,-20,20)
        cross(1000,13,13)
        lineright()
        cross(1000,0,0)
        cross(1000,-17,17)
        cross(1000,0,0)
        catch()
        lineleft()
        cross(1000,20,-20)
        cross(1000,13,13)
        lineleft()
        cross(1000,20,-20)
        cross(1000,40,13)
        lineright()
        cross(1000,0,0)
        cross(1000,36,-36)
        lineright()
        cross(1000,0,0)
        cross(1000,-20,20)
        mm.run_forever(duty_cycle_sp=-50)
        time.sleep(3)
        mm.run_forever(duty_cycle_sp=0)
        cross(1000,-30,-30) 

def toc():
        lineright()
        cross(1000,-17,17)
        cross(1000,30,-30)
        cross(1000,10,10)
        lineright()
        cross(1000,-20,20)
        cross(1000,13,13)
        lineright()
        cross(1000,-20,20)
        cross(1000,13,13)
        catch()
        lineright()
        cross(1000,0,0)
        cross(1000,17,-17)
        cross(1000,13,13)
        lineright()
        cross(1000,0,0)
        cross(1000,-22,22)
        cross(1000,0,0)
        lineright()
        cross(1000,0,0)
        cross(1000,-25,25)
        mm.run_forever(duty_cycle_sp=-50)
        time.sleep(3)
        mm.run_forever(duty_cycle_sp=0)
        cross(1000,-30,-30)
        cross(1500,-50,50) 

mm.run_forever(duty_cycle_sp=-50)
time.sleep(3.5)
mm.run_forever(duty_cycle_sp=0)
tob()
cross(1000,-13,13)
tob()
↑

２つ目†

#!/usr/bin/python
import ev3dev.ev3 as ev3
import time

m1 = ev3.LargeMotor('outA')
m2 = ev3.MediumMotor('outB')
m3 = ev3.MediumMotor('outC')
m4 = ev3.LargeMotor('outD')
us = ev3.UltrasonicSensor('in1')

def search(p):
        t0 = time.time()
        while time.time() - t0 < 0.001:
                if us.value() > p:
                        m4.run_forever(duty_cycle_sp=50)
                        t0 = time.time()
                else:
                        m4.stop()

def bring(x,y):
        m4.run_forever(duty_cycle_sp=x)
        time.sleep(y)
        m4.stop() 

def close():
        m1.run_forever(duty_cycle_sp=-37.5)
        time.sleep(0.32)
        m1.stop()

def up():
        m3.run_forever(duty_cycle_sp=-50)
        m2.run_forever(duty_cycle_sp=50)
        time.sleep(2.25)
        m2.stop()
        m3.stop()

def down():
        m3.run_forever(duty_cycle_sp=50)
        m2.run_forever(duty_cycle_sp=-50)
        time.sleep(1.5)
        m2.stop()
        m3.stop()

def open(a,b):
        m1.run_forever(duty_cycle_sp=a)
        time.sleep(b)
        m1.stop() 


search(60)
bring(45,0.2)
close()
up()
search(60)
open(20,0.275)
bring(45,0.2)
down()
open(27.5,0.325)
bring(-40,7.5)
↑

最後に†

今回の私たちの班の結果は失敗です。
コップを回収するロボットがライントレースを失敗してしまいコップを回収することができませんでした。
理由はロボット本体を動かして調整する時間がおおくとれなかったからです。
作業が遅れた原因はセンサー類の調節が上手くできなかったことです。
実験段階では何回かコップを積むことができました。

添付ファイル: filerobot4.jpg 191件 [詳細] filerobot3.jpg 261件 [詳細] filerobot2.jpg 203件 [詳細] filerobot1.jpg 242件 [詳細] fileline01.jpg 251件 [詳細]
トップ   編集 凍結 差分 履歴 添付 複製 名前変更 リロード   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS
Last-modified: 2016-08-11 (木) 16:45:17