rotmat: fixed rotation init

ArduPilot · May 6, 2022 · 1f08426 · 1f08426
1 parent 0f72670
commit 1f08426
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/rotmat.py b/rotmat.py
@@ -24,7 +24,7 @@
 '''
 from __future__ import print_function
 
-from math import sin, cos, sqrt, asin, atan2, pi, acos
+from math import sin, cos, sqrt, asin, atan2, pi, acos, radians
 
 
 class Vector3(object):
@@ -423,7 +423,7 @@ def __init__(self, name, roll, pitch, yaw):
         self.pitch = pitch
         self.yaw = yaw
         self.r = Matrix3()
-        self.r.from_euler(self.roll, self.pitch, self.yaw)
+        self.r.from_euler(radians(self.roll), radians(self.pitch), radians(self.yaw))
         self.rt = self.r.transposed()
 
 # the rotations used in APM