Subversion Repositories FlightCtrl

Rev

Rev 844 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 844 Rev 898
Line 132... Line 132...
132 
                                GPSPosDev_East  = (GPSInfo.longitude - pTargetPos->Longitude); // to calculate real cm we would need *111/100 additionally
 132 
                                GPSPosDev_East  = (GPSInfo.longitude - pTargetPos->Longitude); // to calculate real cm we would need *111/100 additionally
133 
                                // calculate latitude projection
 133 
                                // calculate latitude projection
134 
                                GPSPosDev_East  *= cos_target_latitude;
 134 
                                GPSPosDev_East  *= cos_target_latitude;
135 
                                GPSPosDev_East /= 8192;
 135 
                                GPSPosDev_East /= 8192;
Line 136... Line 136...
136 
 
 136 
 
137 
                        DebugOut.Analog[12] = GPSPosDev_North;
 137 
                        //DebugOut.Analog[12] = GPSPosDev_North;
138 
                                DebugOut.Analog[13] = GPSPosDev_East;
 138 
                                //DebugOut.Analog[13] = GPSPosDev_East;
139 
                                //DebugOut.Analog[12] = GPSInfo.velnorth;
 139 
                                //DebugOut.Analog[12] = GPSInfo.velnorth;
140 
                                //DebugOut.Analog[13] = GPSInfo.veleast;
 140 
                                //DebugOut.Analog[13] = GPSInfo.veleast;
141 
                        }
 141 
                        }
142 
                        else // no valid target position available
 142 
                        else // no valid target position available
Line 373... Line 373...
373 
                }
 373 
                }
374 
                // set current data as processed to avoid further calculations on the same gps data
 374 
                // set current data as processed to avoid further calculations on the same gps data
375 
                GPSInfo.status = PROCESSED;
 375 
                GPSInfo.status = PROCESSED;
376 
                break;
 376 
                break;
377 
        } // eof GPSInfo.status
 377 
        } // eof GPSInfo.status
378 
        DebugOut.Analog[14] = GPS_Pitch;
 378 
        //DebugOut.Analog[14] = GPS_Pitch;
379 
        DebugOut.Analog[15] = GPS_Roll;
 379 
        //DebugOut.Analog[15] = GPS_Roll;
380 
}
 380 
}