trilateration.c File Reference

#include "trilateration.h"
#include "math/pprz_algebra_float.h"

Include dependency graph for trilateration.c:

Go to the source code of this file.

Functions
int	trilateration_init (struct Anchor *anchors)
	Init internal trilateration structures. More...
int	trilateration_compute (struct Anchor *anchors, struct EnuCoor_f *pos)
	Compute trilateration based on the latest measurments. More...

Variables
static float	P [3][3]
static float	Ex [3]
static float	Ey [3]
static float	Ez [3]
static float	D
static float	I
static float	J
bool	init_failed

Detailed Description

Author

Gautier Hattenberger Trilateration algorithm https://en.wikipedia.org/wiki/Trilateration

Definition in file trilateration.c.

Function Documentation

int trilateration_compute	(	struct Anchor *	anchors,
		struct EnuCoor_f *	pos
	)

Compute trilateration based on the latest measurments.

Parameters

[in]	anchors	array of anchors with updated distance measurements
[out]	pos	computed position

Returns

error status (0 for valid position)

Definition at line 87 of file trilateration.c.

References D, d2, Anchor::distance, Ex, Ey, Ez, I, init_failed, J, P, EnuCoor_f::x, EnuCoor_f::y, and EnuCoor_f::z.

Referenced by dw1000_arduino_event().

Here is the caller graph for this function:

int trilateration_init

(

struct Anchor *

anchors

)

Init internal trilateration structures.

Parameters

[in]

anchors

array of anchors with their location

Definition at line 39 of file trilateration.c.

References D, Ex, Ey, Ez, float_vect_add(), float_vect_diff(), float_vect_dot_product(), float_vect_norm(), float_vect_sdiv(), float_vect_smul(), I, init_failed, J, P, Anchor::pos, EnuCoor_f::x, EnuCoor_f::y, and EnuCoor_f::z.

Referenced by dw1000_arduino_init().

Here is the call graph for this function:

Here is the caller graph for this function:

Variable Documentation

float D

static

Definition at line 35 of file trilateration.c.

Referenced by calculate_edge_displacement(), trilateration_compute(), and trilateration_init().

float Ex[3]

static

Definition at line 33 of file trilateration.c.

Referenced by trilateration_compute(), and trilateration_init().

float Ey[3]

static

Definition at line 33 of file trilateration.c.

Referenced by trilateration_compute(), and trilateration_init().

float Ez[3]

static

Definition at line 33 of file trilateration.c.

Referenced by trilateration_compute(), and trilateration_init().

float I

static

Definition at line 35 of file trilateration.c.

Referenced by kalmanCorrectionAltimetre(), kalmanCorrectionGPS(), kalmanEstimation(), trilateration_compute(), and trilateration_init().

bool init_failed

Definition at line 37 of file trilateration.c.

Referenced by trilateration_compute(), and trilateration_init().

float J

static

Definition at line 35 of file trilateration.c.

Referenced by kalmanEstimation(), trilateration_compute(), and trilateration_init().

float P[3][3]

static

Definition at line 31 of file trilateration.c.

Referenced by lla_of_ecef_d(), lla_of_ecef_f(), trilateration_compute(), and trilateration_init().