|
|
|
@ -383,8 +383,8 @@ void SoloGimbal::update_target(const Vector3f &newTarget)
@@ -383,8 +383,8 @@ void SoloGimbal::update_target(const Vector3f &newTarget)
|
|
|
|
|
|
|
|
|
|
void SoloGimbal::write_logs() |
|
|
|
|
{ |
|
|
|
|
AP_Logger *dataflash = AP_Logger::get_singleton(); |
|
|
|
|
if (dataflash == nullptr) { |
|
|
|
|
AP_Logger *logger = AP_Logger::get_singleton(); |
|
|
|
|
if (logger == nullptr) { |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -409,7 +409,7 @@ void SoloGimbal::write_logs()
@@ -409,7 +409,7 @@ void SoloGimbal::write_logs()
|
|
|
|
|
joint_angles_y : _measurement.joint_angles.y, |
|
|
|
|
joint_angles_z : _measurement.joint_angles.z |
|
|
|
|
}; |
|
|
|
|
dataflash->WriteBlock(&pkt1, sizeof(pkt1)); |
|
|
|
|
logger->WriteBlock(&pkt1, sizeof(pkt1)); |
|
|
|
|
|
|
|
|
|
struct log_Gimbal2 pkt2 = { |
|
|
|
|
LOG_PACKET_HEADER_INIT(LOG_GIMBAL2_MSG), |
|
|
|
@ -425,7 +425,7 @@ void SoloGimbal::write_logs()
@@ -425,7 +425,7 @@ void SoloGimbal::write_logs()
|
|
|
|
|
target_y: _att_target_euler_rad.y, |
|
|
|
|
target_z: _att_target_euler_rad.z |
|
|
|
|
}; |
|
|
|
|
dataflash->WriteBlock(&pkt2, sizeof(pkt2)); |
|
|
|
|
logger->WriteBlock(&pkt2, sizeof(pkt2)); |
|
|
|
|
|
|
|
|
|
_log_dt = 0; |
|
|
|
|
_log_del_ang.zero(); |
|
|
|
|