if (success):
# get the state information
print("sleeping")
mambo.smart_sleep(2)
mambo.ask_for_state_update()
mambo.smart_sleep(2)
print("taking off!")
mambo.safe_takeoff(5)
if (mambo.sensors.flying_state != "emergency"):
print("flying state is %s" % mambo.sensors.flying_state)
print("Flying direct: going up")
mambo.fly_direct(roll=0,
pitch=0,
yaw=0,
vertical_movement=20,
duration=1)
print("flip left")
print("flying state is %s" % mambo.sensors.flying_state)
success = mambo.flip(direction="left")
print("mambo flip result %s" % success)
mambo.smart_sleep(5)
print("flip right")
print("flying state is %s" % mambo.sensors.flying_state)
success = mambo.flip(direction="right")
print("mambo flip result %s" % success)
mambo.smart_sleep(5)
print("trying to connect")
success = mambo.connect(num_retries=3)
print("connected: %s" % success)
if (success):
# get the state information
print("sleeping")
mambo.smart_sleep(2)
mambo.ask_for_state_update()
mambo.smart_sleep(2)
print("taking off!")
mambo.safe_takeoff(5)
print("Flying direct: going forward (positive pitch)")
mambo.fly_direct(roll=0, pitch=50, yaw=0, vertical_movement=0, duration=1)
print("Showing turning (in place) using turn_degrees")
mambo.turn_degrees(90)
mambo.smart_sleep(2)
mambo.turn_degrees(-90)
mambo.smart_sleep(2)
print("Flying direct: yaw")
mambo.fly_direct(roll=0, pitch=0, yaw=50, vertical_movement=0, duration=1)
print("Flying direct: going backwards (negative pitch)")
mambo.fly_direct(roll=0,
pitch=-50,
yaw=0,
vertical_movement=0,