RobotIA/10metres.py at master · gobgob/RobotIA · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
#!/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())