Subversion Repositories NaviCtrl

Rev

Rev 544 | Rev 549 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 544 Rev 545
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
 - 
 
772 
//      WP.Heading = CompassSetpointCorrected/10 + Parameter.OrientationAngle * 15;
 771 
        // set heading
773 
        WP.Heading = CompassSetpointCorrected/10 + Parameter.CamOrientation * 15;
 772 
        WP.Heading = (CompassSetpointCorrected/10 + Parameter.CamOrientation * 15) % 360;
774 
        if(WP.Heading == 0) WP.Heading = 360;
 773 
        if(WP.Heading == 0) WP.Heading = 360;
775 
        WP.ToleranceRadius = 120; // 12m
774 
        WP.ToleranceRadius = 120; // 12m
776 
        WP.HoldTime  = 2;
 775 
        WP.HoldTime  = 2;
777 
        WP.Index  = 1;
 776 
        WP.Index  = 1;