| 146,7 → 146,7 |
|---|
| /* Set Hold Position */ |
| if ((actualPos.state > 2) && |
| ((Override == 1) || |
| (SwitchPos == 2) )) /* Update the hold position in case we are in target mode */ |
| (SwitchPos == 2) )) /* Update the hold position in case we are in target mode */ |
| { |
| holdPos.north = actualPos.north; |
| holdPos.east = actualPos.east; |
| 204,9 → 204,9 |
|---|
| if (actualPos.state > 2 ) |
| { |
| if ((SwitchPos == 2) && |
| (targetPosValid == 1) && |
| (RemoteLinkLost == 0) && |
| (Override == 0)) |
| (targetPosValid == 1) && |
| (RemoteLinkLost == 0) && |
| (Override == 0)) |
| { /* determine distance from target position */ |
| distanceNS = actualPos.north - targetPos.north; // in 0.1m |
| distanceEW = actualPos.east - targetPos.east; // in 0.1m |
| 216,8 → 216,8 |
|---|
| } |
| else if ((SwitchPos == 1)&& |
| (holdPosValid == 1) && |
| (RemoteLinkLost == 0) && |
| (Override == 0)) |
| (RemoteLinkLost == 0) && |
| (Override == 0)) |
| { /* determine distance from hold position */ |
| distanceNS = actualPos.north - holdPos.north; // in 0.1m |
| distanceEW = actualPos.east - holdPos.east; // in 0.1m |
| 236,12 → 236,12 |
|---|
| } |
| else |
| { |
| distanceNS = 0.0F; // in 0.1m |
| distanceEW = 0.0F; // in 0.1m |
| velocityNS = 0.0F; // in 0.1m/s |
| velocityEW = 0.0F; // in 0.1m/s |
| maxDistance = 0.0F; |
| GPSTrackingCycles = 0; |
| distanceNS = 0.0F; // in 0.1m |
| distanceEW = 0.0F; // in 0.1m |
| velocityNS = 0.0F; // in 0.1m/s |
| velocityEW = 0.0F; // in 0.1m/s |
| maxDistance = 0.0F; |
| GPSTrackingCycles = 0; |
| } |
| |
| /* Limit GPS_Nick to 25 */ |