|
|
|
@ -218,7 +218,7 @@ class Gimbal3Axis(object):
@@ -218,7 +218,7 @@ class Gimbal3Axis(object):
|
|
|
|
|
self.last_print_t = now |
|
|
|
|
# calculate joint angles (euler312 order) |
|
|
|
|
Euler312 = Vector3(*self.dcm.to_euler312()) |
|
|
|
|
print('312 Euler Angles ', Euler312) |
|
|
|
|
print("Euler Angles 312 %6.1f %6.1f %6.1f" % (degrees(Euler312.z), degrees(Euler312.x), degrees(Euler312.y))) |
|
|
|
|
|
|
|
|
|
def send_report(self): |
|
|
|
|
'''send a report to the vehicle control code over MAVLink''' |
|
|
|
|