from pythymiodw import ThymioSimPG
from groundworld import thymio_world
robot = ThymioSimPG(thymio_world, scale=3)
robot.wheels(100, 100)
robot.sleep(2)
delta = robot.prox_ground.delta
delta = sum(delta) / 2.0
print(delta)
while delta > 500:
print(delta)
robot.sleep(2)
delta = robot.prox_ground.delta
delta = sum(delta) / 2.0
print(delta)
robot.quit()
from pythymiodw import ThymioSimPG
from pgworld import *
robot=ThymioSimPG(thymio_world, scale = 3)
robot.sleep(1)
print('move')
robot.wheels(200,200)
count = 0
while count < 15:
#print(robot.heading)
print(robot.robot._position)
robot.sleep(1)
count += 1
print('stop')
robot.wheels(0,0)
robot.quit()