Commit 8b1f5624 authored by Hyon Lim (Retina)'s avatar Hyon Lim (Retina)

There was an HILS bug that bypass raw RC signal (range from 900 to around 2000) to XPlane.

This commit disabled RC RAW signal callback.
parent d64f163e
...@@ -292,15 +292,6 @@ void QGCXPlaneLink::updateActuators(uint64_t time, float act1, float act2, float ...@@ -292,15 +292,6 @@ void QGCXPlaneLink::updateActuators(uint64_t time, float act1, float act2, float
void QGCXPlaneLink::updateControls(uint64_t time, float rollAilerons, float pitchElevator, float yawRudder, float throttle, uint8_t systemMode, uint8_t navMode) void QGCXPlaneLink::updateControls(uint64_t time, float rollAilerons, float pitchElevator, float yawRudder, float throttle, uint8_t systemMode, uint8_t navMode)
{ {
// Do not update this control type for
// all multirotors
if (mav->getSystemType() == MAV_TYPE_QUADROTOR ||
mav->getSystemType() == MAV_TYPE_HEXAROTOR ||
mav->getSystemType() == MAV_TYPE_OCTOROTOR)
{
return;
}
#pragma pack(push, 1) #pragma pack(push, 1)
struct payload { struct payload {
char b[5]; char b[5];
...@@ -315,7 +306,11 @@ void QGCXPlaneLink::updateControls(uint64_t time, float rollAilerons, float pitc ...@@ -315,7 +306,11 @@ void QGCXPlaneLink::updateControls(uint64_t time, float rollAilerons, float pitc
p.b[3] = 'A'; p.b[3] = 'A';
p.b[4] = '\0'; p.b[4] = '\0';
p.index = 12; Q_UNUSED(time);
Q_UNUSED(systemMode);
Q_UNUSED(navMode);
bool isFixedWing = true;
if (mav->getAirframe() == UASInterface::QGC_AIRFRAME_X8 || if (mav->getAirframe() == UASInterface::QGC_AIRFRAME_X8 ||
mav->getAirframe() == UASInterface::QGC_AIRFRAME_VIPER_2_0 || mav->getAirframe() == UASInterface::QGC_AIRFRAME_VIPER_2_0 ||
...@@ -329,31 +324,59 @@ void QGCXPlaneLink::updateControls(uint64_t time, float rollAilerons, float pitc ...@@ -329,31 +324,59 @@ void QGCXPlaneLink::updateControls(uint64_t time, float rollAilerons, float pitc
// yaw // yaw
p.f[2] = 0.0f; p.f[2] = 0.0f;
} }
else if (mav->getSystemType() == MAV_TYPE_QUADROTOR)
{
qDebug() << "MAV_TYPE_QUADROTOR";
// Individual effort will be provided directly to the actuators on Xplane quadrotor.
#if 1
p.f[0] = rollAilerons;
p.f[1] = pitchElevator;
p.f[2] = yawRudder;
p.f[3] = throttle;
#endif
#if 0
p.f[0] = throttle;
p.f[1] = rollAilerons;
p.f[2] = pitchElevator;
p.f[3] = yawRudder;
#endif
isFixedWing = false;
}
else else
{ {
// direct pass-through // direct pass-through, normal fixed-wing.
p.f[0] = -pitchElevator; p.f[0] = -pitchElevator;
p.f[1] = rollAilerons; p.f[1] = rollAilerons;
p.f[2] = yawRudder; p.f[2] = yawRudder;
} }
Q_UNUSED(time); if(isFixedWing)
Q_UNUSED(systemMode); {
Q_UNUSED(navMode); // Ail / Elevon / Rudder
p.index = 12; // XPlane, wing sweep
writeBytes((const char*)&p, sizeof(p));
p.index = 8; // XPlane, joystick? why?
writeBytes((const char*)&p, sizeof(p));
p.index = 25; // Thrust
memset(p.f, 0, sizeof(p.f));
p.f[0] = throttle;
p.f[1] = throttle;
p.f[2] = throttle;
p.f[3] = throttle;
// Throttle
writeBytes((const char*)&p, sizeof(p));
}
else
{
qDebug() << "Transmitting p.index = 25";
p.index = 25; // XPlane, throttle command.
writeBytes((const char*)&p, sizeof(p));
}
// Ail / Elevon / Rudder
writeBytes((const char*)&p, sizeof(p));
p.index = 8;
writeBytes((const char*)&p, sizeof(p));
p.index = 25;
memset(p.f, 0, sizeof(p.f));
p.f[0] = throttle;
p.f[1] = throttle;
p.f[2] = throttle;
p.f[3] = throttle;
// Throttle
writeBytes((const char*)&p, sizeof(p));
} }
Eigen::Matrix3f euler_to_wRo(double yaw, double pitch, double roll) { Eigen::Matrix3f euler_to_wRo(double yaw, double pitch, double roll) {
......
...@@ -1326,6 +1326,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message) ...@@ -1326,6 +1326,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
} }
} }
break; break;
#if 0
case MAVLINK_MSG_ID_SERVO_OUTPUT_RAW: case MAVLINK_MSG_ID_SERVO_OUTPUT_RAW:
{ {
mavlink_servo_output_raw_t raw; mavlink_servo_output_raw_t raw;
...@@ -1340,6 +1341,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message) ...@@ -1340,6 +1341,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
} }
} }
break; break;
#endif
#ifdef MAVLINK_ENABLED_PIXHAWK #ifdef MAVLINK_ENABLED_PIXHAWK
case MAVLINK_MSG_ID_DATA_TRANSMISSION_HANDSHAKE: case MAVLINK_MSG_ID_DATA_TRANSMISSION_HANDSHAKE:
{ {
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment