def gotoZeroPos():
'''
Set all the joints to 0
Wait some time to reach the position
'''
solver.clear()
zeroPos = zeroPosition()
push(zeroPos)
time.sleep(5)
pop(zeroPos)
def gotoZeroPos():
'''
Set all the joints to 0
Wait some time to reach the position
'''
solver.clear()
zeroPos = zeroPosition()
push(zeroPos)
time.sleep(5)
pop(zeroPos)
def gotoSafePos():
'''
Go to the safe position
In this position the hands are away from the base
Wait some time to reach the position
'''
solver.clear()
safePos = safePosition()
push(safePos)
time.sleep(5)
pop(safePos)
def gotoSafePos():
'''
Go to the safe position
In this position the hands are away from the base
Wait some time to reach the position
'''
solver.clear()
safePos = safePosition()
push(safePos)
time.sleep(5)
pop(safePos)
