from pioneer_sdk import Pioneer
import time
mini = Pioneer(logger=False)
mini.arm()
time.sleep(3)
mini.takeoff()
points = [(0, 0, 0.5),
(0, 0.7, 0.5),
(0, 0, 0.5)]
for [x, y, z] in points:
mini.go_to_local_point(x, y, z, 0)
while not mini.point_reached():
time.sleep(0.1)
time.sleep(4)
mini.land()
# mini.disarm()
mini.close_connection()
del mini 