419,7 → 419,6 |
int motorwert = 0; |
int pd_ergebnis; |
|
|
/***************************************************************************** |
Update noimial attitude |
**************************************************************************** */ |
474,6 → 473,7 |
|
//DebugOut.Analog[13] = (int) GasMischanteil; |
|
#ifdef X_FORMATION |
/* Overide in case the remote link got lost */ |
if (RemoteLinkLost == 0) |
{ /* We are flying in X-Formation */ |
486,6 → 486,21 |
StickNick45 = (int) (0.707F * (float)(-GPS_Roll) + 0.707F * (float)(-GPS_Nick)); |
StickGier = 0; |
} |
#else |
/* Overide in case the remote link got lost */ |
if (RemoteLinkLost == 0) |
{ /* We are flying in X-Formation */ |
StickRoll45 = StickRoll - GPS_Roll; |
StickNick45 = StickNick - GPS_Nick; |
} |
else |
{ /* GPS overide is aktive */ |
StickRoll45 = -GPS_Roll; |
StickNick45 = -GPS_Nick; |
StickGier = 0; |
} |
#endif |
|
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
// Yaw |
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |