21 lines
365 B
Python
21 lines
365 B
Python
def get_gonio(force=False):
|
|
"""
|
|
"""
|
|
print "get_gonio: ", force
|
|
|
|
#Initial checks
|
|
robot.assert_no_task()
|
|
robot.reset_motion()
|
|
robot.wait_ready()
|
|
robot.assert_cleared()
|
|
#robot.assert_in_known_point()
|
|
|
|
#Enabling
|
|
enable_motion()
|
|
|
|
|
|
if not robot.is_gonio():
|
|
robot.move_gonio()
|
|
|
|
robot.get_gonio()
|