diff --git a/cflib/crazyflie/high_level_commander.py b/cflib/crazyflie/high_level_commander.py index 7966193e..90f573ff 100644 --- a/cflib/crazyflie/high_level_commander.py +++ b/cflib/crazyflie/high_level_commander.py @@ -41,12 +41,13 @@ class HighLevelCommander(): COMMAND_SET_GROUP_MASK = 0 COMMAND_STOP = 3 - COMMAND_GO_TO = 4 COMMAND_START_TRAJECTORY = 5 COMMAND_DEFINE_TRAJECTORY = 6 COMMAND_TAKEOFF_2 = 7 COMMAND_LAND_2 = 8 - + COMMAND_SPIRAL = 11 + COMMAND_GO_TO_2 = 12 + ALL_GROUPS = 0 TRAJECTORY_LOCATION_MEM = 1 @@ -131,7 +132,7 @@ def stop(self, group_mask=ALL_GROUPS): self.COMMAND_STOP, group_mask)) - def go_to(self, x, y, z, yaw, duration_s, relative=False, + def go_to(self, x, y, z, yaw, duration_s, relative=False, linear=False, group_mask=ALL_GROUPS): """ Go to an absolute or relative position @@ -142,15 +143,41 @@ def go_to(self, x, y, z, yaw, duration_s, relative=False, :param yaw: Yaw (radians) :param duration_s: Time it should take to reach the position (s) :param relative: True if x, y, z is relative to the current position + :param linear: True to use linear interpolation instead of a smooth polynomial :param group_mask: Mask for which CFs this should apply to """ - self._send_packet(struct.pack('