|
|
@@ -0,0 +1,28 @@
|
|
|
+#!/usr/bin/env pybricks-micropython
|
|
|
+
|
|
|
+from pybricks.ev3devices import Motor, ColorSensor
|
|
|
+from pybricks.parameters import Port, Direction
|
|
|
+from pybricks.hubs import EV3Brick
|
|
|
+from pybricks.tools import wait, DataLog
|
|
|
+
|
|
|
+# create the AGV
|
|
|
+brick = EV3Brick()
|
|
|
+color_sensor = ColorSensor(Port.S4)
|
|
|
+left_motor = Motor(Port.A, Direction.COUNTERCLOCKWISE)
|
|
|
+right_motor = Motor(Port.D, Direction.COUNTERCLOCKWISE)
|
|
|
+
|
|
|
+log = DataLog("time", "left", "right", "color", "battery", name="exp", timestamp=True, extension="csv")
|
|
|
+
|
|
|
+# Run the experiments
|
|
|
+left_motor.run(1000)
|
|
|
+right_motor.run(1000)
|
|
|
+t = 0
|
|
|
+dt = 100
|
|
|
+while t < 10000:
|
|
|
+ c = color_sensor.reflection()
|
|
|
+ l = left_motor.speed()
|
|
|
+ r = right_motor.speed()
|
|
|
+ b = brick.battery.voltage()
|
|
|
+ log.log(t, l, r, c, b)
|
|
|
+ t += dt
|
|
|
+ wait(dt)
|