Kann jemand bitte sagen ob der Code funktioniert oder was ich falsch gemacht habe.
Durch das Programm sollte der Mbot2 eine Linie verfolgen und wenn die Linie vorbei ist, dass der Mbot2 gerade aus fahrt.
import event, time, cyberpi, mbot2, mbuild
import time
# initialize variables
base_power = 0
kp = 0
left_power = 0
right_power = 0
@event.is_press('a')
def is_btn_press():
global base_power, kp, left_power, right_power
cyberpi.stop_other()
mbot2.drive_power(0, 0)
@event.is_press('b')
def is_btn_press1():
global base_power, kp, left_power, right_power
cyberpi.stop_other()
base_power = 30
kp = 0.8
while True:
offset = mbuild.quad_rgb_sensor.get_offset_track(1)
if offset == 0:
mbot2.drive_power(0, 0)
time.sleep(0.1)
mbot2.EM_set_speed(50, 1)
mbot2.EM_set_speed(-50, 2)
else:
left_power = (base_power - kp * offset)
right_power = -1 * ((base_power + kp * offset))
mbot2.drive_power(left_power, right_power)