10metres.py

#!/usr/bin/python3

from class_robot import *
from class_table import *
from math import *
from math import *
from proxi_serial import *
from time import sleep
import threading

table = Table();
proxy = Proxy_serial()
robot = Robot(table,proxy);

#define DEFAULT_TICK_PER_METERS (4798.0)
#define DEFAULT_TICK_PER_RADS (515.678044375)

# robot.setTickRatio(25500,4356);
robot.setTickRatio(27793,4125);
robot.setTicks(0,0)
robot.setX(0)
robot.setY(0)
robot.setAngle(0)


robot.distanceHard()
robot.rotationHard()

# robot.moveForward(480)
# robot.moveBackward(1340)
# robot.rotate(30*2*pi,timeout=120)


robot.goto(1500,0)
# robot.goto(400,400,pi)
# robot.goto(0,400,3*pi/2)
# robot.goto(0,0,0)
robot.distanceSoft()
robot.rotationSoft()
while True:
	print(robot.getX())
	print(robot.getY())
	print(robot.getAngle())
	print(robot.getTicks())