Subversion Repositories Projects

Rev

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

Rev 2192 Rev 2194
Line 63... Line 63...
63 
#define NMEA_EARTH_SEMIMAJORAXIS_M  (6378137.0)                     /**< Earth's semi-major axis in m according WGS84 */
 63 
#define NMEA_EARTH_SEMIMAJORAXIS_M  (6378137.0)                     /**< Earth's semi-major axis in m according WGS84 */
64 
#define NMEA_EARTH_SEMIMAJORAXIS_KM (NMEA_EARTHMAJORAXIS_KM / 1000) /**< Earth's semi-major axis in km according WGS 84 */
 64 
#define NMEA_EARTH_SEMIMAJORAXIS_KM (NMEA_EARTHMAJORAXIS_KM / 1000) /**< Earth's semi-major axis in km according WGS 84 */
65 
#define NMEA_EARTH_FLATTENING       (1 / 298.257223563)             /**< Earth's flattening according WGS 84 */
 65 
#define NMEA_EARTH_FLATTENING       (1 / 298.257223563)             /**< Earth's flattening according WGS 84 */
66 
#define NMEA_DOP_FACTOR             (5)                             /**< Factor for translating DOP to meters */
 66 
#define NMEA_DOP_FACTOR             (5)                             /**< Factor for translating DOP to meters */
Line 67... Line -...
67 
 
 - 
 
68 
 
 - 
 
69 
// Definitonen für FollowMeStep2
 - 
 
70 
#define LONG_DIV                    10000000
 - 
 
71 
#define LAT_DIV                     LONG_DIV
 - 
 
72 
#define FOLLOWME_DEG2M              1/111111*LONG_DIV
 - 
 
73 
 
 - 
 
74 
 
 67 
 
Line 75... Line 68...
75 
# define NMEA_POSIX(x)  x
 68 
# define NMEA_POSIX(x)  x
Line 116... Line 109...
116 
 
 109 
 
117 
    return RetVal;
 110 
    return RetVal;
Line 118... Line -...
118 
}
 - 
 
119 
 
 - 
 
120 
 
 - 
 
121 
// Berechnet die Position der Kopters für FollowMeStep2
 - 
 
122 
// Momentan wird die gleich Position ausgegeben
 - 
 
123 
 
 - 
 
124 
int followme_calculate_offset(
 - 
 
125 
    const nmeaPOS *pkt_pos,     /**< Start position in radians */
 - 
 
126 
    nmeaPOS *target_pos,        /**< Result position in radians */
 - 
 
127 
    int d_lat,                  /**< Distance lat(m) */
 - 
 
128 
    int d_lon                   /**< Distance long(m) */
 - 
 
129 
    )
 - 
 
130 
{
 - 
 
131 
 
 - 
 
132 
        // only for test the "Debug-Mode"
 - 
 
133 
    target_pos->lat = pkt_pos->lat;
 - 
 
134 
    target_pos->lon = pkt_pos->lon;
 - 
 
135 
 
 - 
 
136 
 
 - 
 
Line 137... Line 111...
137 
        return 1;
 111 
}