Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
lidar_correction.c File Reference
#include "lidar_correction.h"
#include "modules/lidar/tfmini.h"
#include "modules/ins/ins_int.h"
#include "math/pprz_algebra.h"
#include <math.h>
#include <float.h>
#include <state.h>
Include dependency graph for lidar_correction.c:

Go to the source code of this file.

Functions

float distance_to_wall (float theta, const struct FloatVect2 *P, const struct FloatVect2 *A, const struct FloatVect2 *B)
static float distance_to_segment (const struct FloatVect2 *P, const struct FloatVect2 *A, const struct FloatVect2 *B, struct FloatVect2 *C)
float find_nearest_wall (const struct FloatVect2 *obstacle_pos, struct FloatVect2 *nearest_point)
void init_walls (void)
void convert_walls_to_ltp (void)

Variables

struct WallSystem wall_system
const struct WallConfig obstacle_walls [] = OBSTACLE_WALLS

Function Documentation

◆ convert_walls_to_ltp()

void convert_walls_to_ltp ( void )

Definition at line 168 of file lidar_correction.c.

References ned_of_lla_point_f(), p, stateGetNedOrigin_f(), stateIsLocalCoordinateValid(), wall_system, NedCoor_f::x, and NedCoor_f::y.

Referenced by ins_update_lidar().

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

◆ distance_to_segment()

float distance_to_segment ( const struct FloatVect2 * P,
const struct FloatVect2 * A,
const struct FloatVect2 * B,
struct FloatVect2 * C )
static

Definition at line 75 of file lidar_correction.c.

References A, B, P, FloatVect2::x, and FloatVect2::y.

Referenced by find_nearest_wall().

Here is the caller graph for this function:

◆ distance_to_wall()

float distance_to_wall ( float theta,
const struct FloatVect2 * P,
const struct FloatVect2 * A,
const struct FloatVect2 * B )

Definition at line 48 of file lidar_correction.c.

References A, B, P, and s.

Referenced by sim_overwrite_lidar().

Here is the caller graph for this function:

◆ find_nearest_wall()

float find_nearest_wall ( const struct FloatVect2 * obstacle_pos,
struct FloatVect2 * nearest_point )

Definition at line 97 of file lidar_correction.c.

References Wall::count, distance_to_segment(), p, Wall::points_ltp, wall_system, FloatVect2::x, and FloatVect2::y.

Here is the call graph for this function:

◆ init_walls()

Variable Documentation

◆ obstacle_walls

const struct WallConfig obstacle_walls[] = OBSTACLE_WALLS

Definition at line 141 of file lidar_correction.c.

Referenced by init_walls().

◆ wall_system