a.land()
a.motor.set_speed(2000.0)
for i in range(20):
b = a.refresh()
a.altitude.set_sensor_altitude_current(
a.altitude.get_altitude_current() - 3)
print a.altitude.get_altitudes(), b
def sim_ultrasound(a):
"""
Simulates Ultrasound detection
:param a:
:return:
"""
a.takeoff()
sensor_vals = [1, 2, 3, 4]
a.ultra.set_sensor_ultra_values(25, 60, 60, 60)
for i in range(20):
b = a.refresh()
if __name__ == '__main__':
import CustomLogger
a = Quadcopter(CustomLogger.pi_logger())
sim_ypr_change(a)
a = Quadcopter(CustomLogger.pi_logger())
sim_altitude(a)
# a = Quadcopter(CustomLogger.pi_logger())
# sim_ultrasound(a)
