from __future__ import print_function, division
import time
import MotionController
controller = MotionController.PyMotionController()
initialized = False
# Try to initialize the motion manager
try:
initialized = controller.initMotionManager()
except:
print('\nException occured')
if initialized:
print("Initialized")
# Walking demo
controller.initWalking()
time.sleep(1)
controller.walk(5, 0, 0)
time.sleep(1)
controller.walk(5, 10)
time.sleep(1)
controller.walk(5, -10)
time.sleep(1)
controller.walk(-1, 0, 2)
time.sleep(5)
