| 65,6 → 65,13 |
|---|
| #define NMEA_EARTH_FLATTENING (1 / 298.257223563) /**< Earth's flattening according WGS 84 */ |
| #define NMEA_DOP_FACTOR (5) /**< Factor for translating DOP to meters */ |
| |
| |
| // Definitonen für FollowMeStep2 |
| #define LONG_DIV 10000000 |
| #define LAT_DIV LONG_DIV |
| #define FOLLOWME_DEG2M 1/111111*LONG_DIV |
| |
| |
| # define NMEA_POSIX(x) x |
| |
| |
| 111,7 → 118,26 |
|---|
| } |
| |
| |
| // Berechnet die Position der Kopters für FollowMeStep2 |
| // Momentan wird die gleich Position ausgegeben |
| |
| int followme_calculate_offset( |
| const nmeaPOS *pkt_pos, /**< Start position in radians */ |
| nmeaPOS *target_pos, /**< Result position in radians */ |
| int d_lat, /**< Distance lat(m) */ |
| int d_lon /**< Distance long(m) */ |
| ) |
| { |
| |
| // only for test the "Debug-Mode" |
| target_pos->lat = pkt_pos->lat; |
| target_pos->lon = pkt_pos->lon; |
| |
| |
| return 1; |
| } |
| |
| |
| //############################################################################################### |
| |
| |