Rev 521 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 521 | Rev 540 | ||
|---|---|---|---|
| Line 663... | Line 663... | ||
| 663 | if(len) |
663 | if(len) |
| 664 | { |
664 | { |
| 665 | if(value[len-1] == '\r') |
665 | if(value[len-1] == '\r') |
| 666 | { |
666 | { |
| 667 | value[len-1] = 0; |
667 | value[len-1] = 0; |
| 668 | len--; |
668 | // len--; |
| 669 | } |
669 | } |
| 670 | } |
670 | } |
| 671 | if(len > listnamelen) len = listnamelen; |
671 | if(len > listnamelen) len = listnamelen; |
| 672 | if(len) |
672 | if(len) |
| 673 | { |
673 | { |
| Line 767... | Line 767... | ||
| 767 | GPSPos_Copy(&NaviData.TargetPosition, &(WP.Position)); |
767 | GPSPos_Copy(&NaviData.TargetPosition, &(WP.Position)); |
| 768 | } |
768 | } |
| Line 769... | Line 769... | ||
| 769 | 769 | ||
| 770 | GPSPos_Copy(&GPSData.Position, &(WP.Position)); |
770 | GPSPos_Copy(&GPSData.Position, &(WP.Position)); |
| 771 | // set heading |
771 | // set heading |
| 772 | WP.Heading = CompassSetpointCorrected/10; |
772 | WP.Heading = CompassSetpointCorrected/10 + Parameter.OrientationAngle * 15; |
| 773 | if(WP.Heading == 0) WP.Heading = 360; |
773 | if(WP.Heading == 0) WP.Heading = 360; |
| 774 | WP.ToleranceRadius = 120; // 12m |
774 | WP.ToleranceRadius = 120; // 12m |
| 775 | WP.HoldTime = 2; |
775 | WP.HoldTime = 2; |
| 776 | WP.Index = 1; |
776 | WP.Index = 1; |