diff --git a/software/roboter/ev3/drive_plant_gc.py b/software/roboter/ev3/drive_plant_gc.py new file mode 100644 index 0000000..242e0f7 --- /dev/null +++ b/software/roboter/ev3/drive_plant_gc.py @@ -0,0 +1,65 @@ +#!/usr/bin/env pybricks-micropython +from pybricks.hubs import EV3Brick +from pybricks.ev3devices import (Motor, TouchSensor, ColorSensor, + InfraredSensor, UltrasonicSensor, GyroSensor) +from pybricks.parameters import Port, Stop, Direction, Button, Color +from pybricks.tools import wait, StopWatch, DataLog +from pybricks.robotics import DriveBase +from pybricks.media.ev3dev import SoundFile, ImageFile + +import sys + + +def fun_1(ev3): + pass + + +def fun_2(a,b): + return 1 + +def move_1(mo_forward_1, mo_forward_2, mo_le_ri, mo_up_down): + wait(2000) + #move forward + mo_forward_1.run_target(500, 1250,wait=False) + mo_forward_2.run_target(500, 1250) + + #move arm + mo_le_ri.run_target(200,-50) + + #move sensors + mo_up_down.run_target(500,2500) + wait(2000) + mo_up_down.run_target(500,0) + + #move arm + mo_le_ri.run_target(200,0) + + #move backwards + mo_forward_1.run_target(500, 0,wait=False) + mo_forward_2.run_target(500, 0) + + + + +def move_2(): + pass +def move_3(): + pass + + + + +ev3 = EV3Brick() + +motor_forward_1 = Motor(Port.A) +motor_forward_2 = Motor(Port.D) +motor_le_ri = Motor(Port.B, Direction.COUNTERCLOCKWISE, [8, 56]) #with gear for angle +motor_up_down = Motor(Port.C) + +#n = int(sys.argv[1]) + +#if n == 1: +move_1(motor_forward_1,motor_forward_2,motor_le_ri,motor_up_down) + + +