diff --git a/code/track_path.py b/code/track_path.py index 3524404be0effeed27fc9ea90773e01241ec283d..eb058e5b62caa95772c1d2637d42de86d54c8caa 100644 --- a/code/track_path.py +++ b/code/track_path.py @@ -168,12 +168,12 @@ class CrazyLogger: def x(self): """ Return x-position of robot center""" # Note that the offset of the crazyflie mount position is included - return self._state[0] - np.sin(self._state[3])*self._position_offset + return self._state[0] - np.sin(np.deg2rad(self._state[3]))*self._position_offset def y(self): """ Return y-position of robot center""" # Note that the offset of the crazyflie mount position is included - return self._state[1] + np.cos(self._state[3])*self._position_offset + return self._state[1] + np.cos(np.deg2rad(self._state[3]))*self._position_offset def z(self): """ Return z-position of robot center"""