|
|
|
@ -157,92 +157,6 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
@@ -157,92 +157,6 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
|
|
|
|
|
emit voltageChanged(message.sysid, state.vbat/1000.0f); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
/*
|
|
|
|
|
case MAVLINK_MSG_ID_SYSTEM: |
|
|
|
|
// std::cerr << std::endl;
|
|
|
|
|
// std::cerr << "System Message received" << std::endl;
|
|
|
|
|
currentVoltage = message_system_get_voltage(message.payload)/1000.0f; |
|
|
|
|
filterVoltage(currentVoltage); |
|
|
|
|
if (startVoltage == 0) startVoltage = currentVoltage; |
|
|
|
|
timeRemaining = calculateTimeRemaining(); |
|
|
|
|
//qDebug() << "Voltage: " << currentVoltage << " Chargelevel: " << getChargeLevel() << " Time remaining " << timeRemaining;
|
|
|
|
|
emit batteryChanged(this, filterVoltage(), getChargeLevel(), timeRemaining); |
|
|
|
|
|
|
|
|
|
emit voltageChanged(message.acid, message_system_get_voltage(message.payload)/1000.0f); |
|
|
|
|
emit loadChanged(this, message_system_get_cpu_usage(message.payload)/100.0f); |
|
|
|
|
emit valueChanged(uasId, "Battery", message_system_get_voltage(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "CPU Load", message_system_get_cpu_usage(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
break; |
|
|
|
|
case MAVLINK_MSG_ID_ACTUATORS: |
|
|
|
|
emit actuatorChanged(this, 0, message_actuator_get_act1(message.payload)); |
|
|
|
|
emit valueChanged(this->getUASID(), "Top Rotor", message_actuator_get_act1(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit actuatorChanged(this, 1, message_actuator_get_act2(message.payload)); |
|
|
|
|
emit valueChanged(this->getUASID(), "Bottom Rotor", message_actuator_get_act2(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit actuatorChanged(this, 2, message_actuator_get_act3(message.payload)); |
|
|
|
|
emit valueChanged(this->getUASID(), "Left Servo", message_actuator_get_act3(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit actuatorChanged(this, 3, message_actuator_get_act4(message.payload)); |
|
|
|
|
emit valueChanged(this->getUASID(), "Right Servo", message_actuator_get_act4(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
// Calculate thrust sum
|
|
|
|
|
thrustSum = (message_actuator_get_act1(message.payload) + message_actuator_get_act2(message.payload)) / 2; |
|
|
|
|
emit thrustChanged(this, thrustSum); |
|
|
|
|
break; |
|
|
|
|
case MAVLINK_MSG_ID_STATE: |
|
|
|
|
emit valueChanged(uasId, "State", message_state_get_state(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
getStatusForCode(message_state_get_state(message.payload), uasState, stateDescription); |
|
|
|
|
emit statusChanged(this, uasState, stateDescription); |
|
|
|
|
break; |
|
|
|
|
case MAVLINK_MSG_ID_POSITION: |
|
|
|
|
// Position message is displayed in meters and degrees
|
|
|
|
|
{ |
|
|
|
|
quint64 time = MG::TIME::getGroundTimeNow();//message_position_get_msec(message.payload);
|
|
|
|
|
emit valueChanged(this, "x", message_position_get_posX(message.payload), time); |
|
|
|
|
emit valueChanged(this, "y", message_position_get_posY(message.payload), time); |
|
|
|
|
emit valueChanged(this, "z", message_position_get_posZ(message.payload), time); |
|
|
|
|
emit valueChanged(this, "roll", message_position_get_roll(message.payload), time); |
|
|
|
|
emit valueChanged(this, "pitch", message_position_get_pitch(message.payload), time); |
|
|
|
|
emit valueChanged(this, "yaw", message_position_get_yaw(message.payload), time); |
|
|
|
|
emit valueChanged(this, "x speed", message_position_get_speedX(message.payload), time); |
|
|
|
|
emit valueChanged(this, "y speed", message_position_get_speedY(message.payload), time); |
|
|
|
|
emit valueChanged(this, "z speed", message_position_get_speedZ(message.payload), time); |
|
|
|
|
emit valueChanged(this, "roll speed", message_position_get_speedRoll(message.payload), time); |
|
|
|
|
emit valueChanged(this, "pitch speed", message_position_get_speedPitch(message.payload), time); |
|
|
|
|
emit valueChanged(this, "yaw speed", message_position_get_speedYaw(message.payload), time); |
|
|
|
|
|
|
|
|
|
emit localPositionChanged(this, message_position_get_posX(message.payload), message_position_get_posY(message.payload), message_position_get_posZ(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "x", message_position_get_posX(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "y", message_position_get_posY(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "z", message_position_get_posZ(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "roll", message_position_get_roll(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "pitch", message_position_get_pitch(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "yaw", message_position_get_yaw(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "x speed", message_position_get_speedX(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "y speed", message_position_get_speedY(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "z speed", message_position_get_speedZ(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "roll speed", message_position_get_speedRoll(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "pitch speed", message_position_get_speedPitch(message.payload), time); |
|
|
|
|
emit valueChanged(uasId, "yaw speed", message_position_get_speedYaw(message.payload), time); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
case MAVLINK_MSG_ID_MARKER: |
|
|
|
|
emit valueChanged(uasId, "marker confidence", message_marker_get_confidence(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "marker x", message_marker_get_posX(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "marker y", message_marker_get_posY(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "marker z", message_marker_get_posZ(message.payload), MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "marker roll", message_marker_get_roll(message.payload)/M_PI*180.0f, MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "marker pitch", message_marker_get_pitch(message.payload)/M_PI*180.0f, MG::TIME::getGroundTimeNow()); |
|
|
|
|
emit valueChanged(uasId, "marker yaw", message_marker_get_yaw(message.payload)/M_PI*180.0f, MG::TIME::getGroundTimeNow()); |
|
|
|
|
break; |
|
|
|
|
case MAVLINK_MSG_ID_IMAGE: |
|
|
|
|
//std::cerr << std::endl;
|
|
|
|
|
//std::cerr << "IMAGE DATA RECEIVED" << std::endl;
|
|
|
|
|
emit imageStarted(message_image_get_rid(message.payload), message_image_get_width(message.payload), message_image_get_height(message.payload), message_image_get_depth(message.payload), message_image_get_channels(message.payload)); |
|
|
|
|
break; |
|
|
|
|
case MAVLINK_MSG_ID_BYTES: |
|
|
|
|
//std::cerr << std::endl;
|
|
|
|
|
//std::cerr << "BYTES RESSOURCE RECEIVED" << std::endl;
|
|
|
|
|
emit imageDataReceived(message_bytestream_get_rid(message.payload), message_bytestream_get_data(message.payload), message_bytestream_get_length(message.payload), message_bytestream_get_index(message.payload)); |
|
|
|
|
break; |
|
|
|
|
*/ |
|
|
|
|
case MAVLINK_MSG_ID_RAW_IMU: |
|
|
|
|
{ |
|
|
|
|
raw_imu_t raw; |
|
|
|
|