from RobotControl import RobotControl
if __name__ == "__main__":
RC = RobotControl()
RC.link(fileName="shm_VS.bin")
RC.setSpeed([10, 10, 10])
RC.setAcce([10, 10, 10, 10, 0, 0])
print '[350,153.8,121.0,51.5,0,0] isPoseOK?', RC.isPoseOK(
[350, 153.8, 121.0, 51.5, 0, 0])
print RC.getCurPos()
RC.sendRobotPos(robotPos=[350, 153.8, 121.0, 51.5, 0, 0],
type="MOVE",
error=0.5)
print RC.getCurPos()
raw_input('input anykey to next')
RC.sendRobotPos(robotPos=[299, 154, 76, 82, 0, 0], type="GO")
print RC.getCurPos()
from RobotControl import RobotControl
if __name__ == "__main__":
RC = RobotControl()
RC.link(fileName="shm_VS.bin")
RC.setSpeed([10, 10, 10])
RC.setAcce([10, 10, 10, 10, 0, 0])
# zx, oi, begin
#print '[350,153.8,121.0,51.5,0,0] isPoseOK?', RC.isPoseOK([350,153.8,121.0,51.5,0,0])
#print RC.getCurPos()
RC.sendRobotPos(robotPos=[350, 153.8, 121.0, 51.5, 0, 0],
type="MOVE",
error=0.5)
# zx, oi, end
#RC.sendRobotPos(robotPos=[200.0, -226.0, 395.07, -37.89, 0.0, 89.92], type="MOVE", error=0.5)
print RC.getCurPos()
raw_input('input anykey to next')
# zx, oi, begin
#RC.sendRobotPos(robotPos=[299,154,60,82,0,0],type="GO")
# zx, oi, end
#RC.sendRobotPos(robotPos=[221.13211468, 144.40044912, 60, 82, 0, 0], type="GO")
#RC.sendRobotPos(robotPos=[364.29494662, -52.58334555, 54.57142639, 0.66162154, 0.0, 0.0], type="GO") # p0
#RC.sendRobotPos(robotPos=[340.12691049, -55.48038278, 54.57142639, 0.66162154, 0.0, 0.0], type="GO") # p1
#RC.sendRobotPos(robotPos=[337.16612335, -30.80669559, 54.57142639, 0.66162154, 0.0, 0.0], type="GO") # p8
#RC.sendRobotPos(robotPos=[239.50279732, -42.36209227, 54.57142639, 0.66162154, 0.0, 0.0], type="GO") # p12
#RC.sendRobotPos(robotPos=[233.35125407, 7.32913015, 54.57142639, 0.66162154, 0.0, 0.0], type="GO") # p26
#RC.sendRobotPos(robotPos=[223.98607617, 82.37886273, 54.57142639, 0.66162154, 0.0, 0.0], type="GO") # p47
