Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
pprz_geodetic_float.c File Reference

Paparazzi floating point math for geodetic calculations. More...

#include "pprz_geodetic_float.h"
#include "pprz_algebra_float.h"
#include <math.h>
#include "pprz_geodetic_double.h"
#include "math/pprz_geodetic_utm.h"
Include dependency graph for pprz_geodetic_float.c:

Go to the source code of this file.

Data Structures

struct  complex

Macros

#define CScal(k, z)
#define CAdd(z1, z2)
#define CSub(z1, z2)
#define CI(z)
#define CExp(z)
#define CSin(z)

Functions

void ltp_def_from_ecef_f (struct LtpDef_f *def, struct EcefCoor_f *ecef)
void ltp_def_from_lla_f (struct LtpDef_f *def, struct LlaCoor_f *lla)
void enu_of_ecef_point_f (struct EnuCoor_f *enu, struct LtpDef_f *def, struct EcefCoor_f *ecef)
void ned_of_ecef_point_f (struct NedCoor_f *ned, struct LtpDef_f *def, struct EcefCoor_f *ecef)
void enu_of_ecef_vect_f (struct EnuCoor_f *enu, struct LtpDef_f *def, struct EcefCoor_f *ecef)
void ned_of_ecef_vect_f (struct NedCoor_f *ned, struct LtpDef_f *def, struct EcefCoor_f *ecef)
void enu_of_lla_point_f (struct EnuCoor_f *enu, struct LtpDef_f *def, struct LlaCoor_f *lla)
void ned_of_lla_point_f (struct NedCoor_f *ned, struct LtpDef_f *def, struct LlaCoor_f *lla)
void ecef_of_enu_point_f (struct EcefCoor_f *ecef, struct LtpDef_f *def, struct EnuCoor_f *enu)
void ecef_of_ned_point_f (struct EcefCoor_f *ecef, struct LtpDef_f *def, struct NedCoor_f *ned)
void ecef_of_enu_vect_f (struct EcefCoor_f *ecef, struct LtpDef_f *def, struct EnuCoor_f *enu)
void ecef_of_ned_vect_f (struct EcefCoor_f *ecef, struct LtpDef_f *def, struct NedCoor_f *ned)
void lla_of_ecef_f (struct LlaCoor_f *out, struct EcefCoor_f *in)
void ecef_of_lla_f (struct EcefCoor_f *out, struct LlaCoor_f *in)
static float isometric_latitude_f (float phi, float e)
static float isometric_latitude_fast_f (float phi)
static float inverse_isometric_latitude_f (float lat, float e, float epsilon)
void utm_of_lla_f (struct UtmCoor_f *utm, struct LlaCoor_f *lla)
void lla_of_utm_f (struct LlaCoor_f *lla, struct UtmCoor_f *utm)

Detailed Description

Paparazzi floating point math for geodetic calculations.

Definition in file pprz_geodetic_float.c.


Data Structure Documentation

◆ complex

struct complex

Definition at line 266 of file pprz_geodetic_float.c.

Data Fields
float im
float re

Macro Definition Documentation

◆ CAdd

#define CAdd ( z1,
z2 )
Value:
{ z2.re += z1.re; z2.im += z1.im; }

Definition at line 268 of file pprz_geodetic_float.c.

Referenced by utm_of_lla_f().

◆ CExp

#define CExp ( z)
Value:
{ float e = exp(z.re); z.re = e*cos(z.im); z.im = e*sin(z.im); }

Definition at line 271 of file pprz_geodetic_float.c.

◆ CI

#define CI ( z)
Value:
{ float tmp = z.re; z.re = - z.im; z.im = tmp; }

Definition at line 270 of file pprz_geodetic_float.c.

◆ CScal

#define CScal ( k,
z )
Value:
{ z.re *= k; z.im *= k; }

Definition at line 267 of file pprz_geodetic_float.c.

Referenced by lla_of_utm_f(), and utm_of_lla_f().

◆ CSin

#define CSin ( z)
Value:
{ CI(z); struct complex _z = {-z.re, -z.im}; float e = exp(z.re); float cos_z_im = cosf(z.im); z.re = e*cos_z_im; float sin_z_im = sinf(z.im); z.im = e*sin_z_im; _z.re = cos_z_im/e; _z.im = -sin_z_im/e; CSub(_z, z); CScal(-0.5, z); CI(z); }
#define CI(v)
#define CScal(k, z)
#define CSub(z1, z2)

Definition at line 274 of file pprz_geodetic_float.c.

Referenced by lla_of_utm_f(), and utm_of_lla_f().

◆ CSub

#define CSub ( z1,
z2 )
Value:
{ z2.re -= z1.re; z2.im -= z1.im; }

Definition at line 269 of file pprz_geodetic_float.c.

Referenced by lla_of_utm_f().

Function Documentation

◆ ecef_of_enu_point_f()

void ecef_of_enu_point_f ( struct EcefCoor_f * ecef,
struct LtpDef_f * def,
struct EnuCoor_f * enu )

◆ ecef_of_enu_vect_f()

void ecef_of_enu_vect_f ( struct EcefCoor_f * ecef,
struct LtpDef_f * def,
struct EnuCoor_f * enu )

◆ ecef_of_lla_f()

◆ ecef_of_ned_point_f()

void ecef_of_ned_point_f ( struct EcefCoor_f * ecef,
struct LtpDef_f * def,
struct NedCoor_f * ned )

Definition at line 157 of file pprz_geodetic_float.c.

References ecef_of_enu_point_f(), and ENU_OF_TO_NED.

Referenced by detection_cb(), stateCalcPositionEcef_f(), stateCalcPositionEcef_i(), stateCalcPositionLla_f(), and tag_tracking_report().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ ecef_of_ned_vect_f()

void ecef_of_ned_vect_f ( struct EcefCoor_f * ecef,
struct LtpDef_f * def,
struct NedCoor_f * ned )

Definition at line 192 of file pprz_geodetic_float.c.

References ecef_of_enu_vect_f(), and ENU_OF_TO_NED.

Referenced by stateCalcAccelEcef_f(), and stateCalcSpeedEcef_f().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ enu_of_ecef_point_f()

void enu_of_ecef_point_f ( struct EnuCoor_f * enu,
struct LtpDef_f * def,
struct EcefCoor_f * ecef )

Definition at line 85 of file pprz_geodetic_float.c.

References LtpDef_f::ecef, LtpDef_f::ltp_of_ecef, MAT33_VECT3_MUL, and VECT3_DIFF.

Referenced by enu_of_lla_point_f(), ned_of_ecef_point_f(), stateCalcPositionEnu_f(), and stateCalcPositionEnu_i().

Here is the caller graph for this function:

◆ enu_of_ecef_vect_f()

void enu_of_ecef_vect_f ( struct EnuCoor_f * enu,
struct LtpDef_f * def,
struct EcefCoor_f * ecef )

Definition at line 100 of file pprz_geodetic_float.c.

References LtpDef_f::ltp_of_ecef, and MAT33_VECT3_MUL.

Referenced by ned_of_ecef_vect_f(), and stateCalcSpeedEnu_f().

Here is the caller graph for this function:

◆ enu_of_lla_point_f()

void enu_of_lla_point_f ( struct EnuCoor_f * enu,
struct LtpDef_f * def,
struct LlaCoor_f * lla )

Definition at line 112 of file pprz_geodetic_float.c.

References ecef_of_lla_f(), and enu_of_ecef_point_f().

Referenced by acInfoCalcPositionEnu_f(), acInfoCalcPositionEnu_i(), nav_land_at_loc(), nav_poles_setup_lla(), and stateCalcPositionEnu_f().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ inverse_isometric_latitude_f()

float inverse_isometric_latitude_f ( float lat,
float e,
float epsilon )
inlinestatic

Definition at line 287 of file pprz_geodetic_float.c.

References epsilon.

Referenced by lla_of_utm_f().

Here is the caller graph for this function:

◆ isometric_latitude_f()

float isometric_latitude_f ( float phi,
float e )
inlinestatic

Definition at line 277 of file pprz_geodetic_float.c.

Referenced by utm_of_lla_f().

Here is the caller graph for this function:

◆ isometric_latitude_fast_f()

float isometric_latitude_fast_f ( float phi)
inlinestatic

Definition at line 282 of file pprz_geodetic_float.c.

Referenced by lla_of_utm_f(), and utm_of_lla_f().

Here is the caller graph for this function:

◆ lla_of_ecef_f()

void lla_of_ecef_f ( struct LlaCoor_f * out,
struct EcefCoor_f * in )

Definition at line 204 of file pprz_geodetic_float.c.

References LlaCoor_f::alt, b, f, LlaCoor_f::lat, LlaCoor_f::lon, P, s, EcefCoor_f::x, EcefCoor_f::y, EcefCoor_f::z, and z2.

Referenced by detection_cb(), lla_of_ecef_i(), ltp_def_from_ecef_f(), stateCalcPositionLla_f(), and tag_tracking_report().

Here is the caller graph for this function:

◆ lla_of_utm_f()

◆ ltp_def_from_ecef_f()

void ltp_def_from_ecef_f ( struct LtpDef_f * def,
struct EcefCoor_f * ecef )

Definition at line 36 of file pprz_geodetic_float.c.

References LtpDef_f::ecef, LlaCoor_f::lat, LtpDef_f::lla, lla_of_ecef_f(), LlaCoor_f::lon, LtpDef_f::ltp_of_ecef, FloatRMat::m, and VECT3_COPY.

Here is the call graph for this function:

◆ ltp_def_from_lla_f()

void ltp_def_from_lla_f ( struct LtpDef_f * def,
struct LlaCoor_f * lla )

Definition at line 60 of file pprz_geodetic_float.c.

References LtpDef_f::ecef, ecef_of_lla_f(), LlaCoor_f::lat, LtpDef_f::lla, LLA_COPY, LlaCoor_f::lon, LtpDef_f::ltp_of_ecef, and FloatRMat::m.

Here is the call graph for this function:

◆ ned_of_ecef_point_f()

void ned_of_ecef_point_f ( struct NedCoor_f * ned,
struct LtpDef_f * def,
struct EcefCoor_f * ecef )

Definition at line 92 of file pprz_geodetic_float.c.

References enu_of_ecef_point_f(), and ENU_OF_TO_NED.

Referenced by ned_of_lla_point_f(), stateCalcPositionNed_f(), and stateCalcPositionNed_i().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ ned_of_ecef_vect_f()

void ned_of_ecef_vect_f ( struct NedCoor_f * ned,
struct LtpDef_f * def,
struct EcefCoor_f * ecef )

Definition at line 105 of file pprz_geodetic_float.c.

References enu_of_ecef_vect_f(), and ENU_OF_TO_NED.

Referenced by gps_cb(), ins_float_invariant_update_gps(), stateCalcAccelNed_f(), stateCalcHorizontalSpeedNorm_i(), and stateCalcSpeedNed_f().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ ned_of_lla_point_f()

void ned_of_lla_point_f ( struct NedCoor_f * ned,
struct LtpDef_f * def,
struct LlaCoor_f * lla )

Definition at line 119 of file pprz_geodetic_float.c.

References ecef_of_lla_f(), and ned_of_ecef_point_f().

Referenced by convert_walls_to_ltp(), and stateCalcPositionNed_f().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ utm_of_lla_f()