Go to the source code of this file.
Macros | |
#define | DEBUG_SEARCH(a) ; |
#define | SQUARE(a) ((a)*(a)) |
Functions | |
void | find_correspondences_tricks (struct sm_params *params) |
void | ld_create_jump_tables (struct laser_data *ld) |
INLINE double | local_distance_squared_d (const double *a, const double *b) |
INLINE double | mysin (double x) |
Variables | |
int | distance_counter |
#define DEBUG_SEARCH | ( | a | ) | ; |
Definition at line 16 of file icp_corr_tricks.c.
#define SQUARE | ( | a | ) | ((a)*(a)) |
Definition at line 53 of file icp_corr_tricks.c.
void find_correspondences_tricks | ( | struct sm_params * | params | ) |
Smart algorithm
Search domain for j1
Current best match
and his distance
If last match was succesful, then start at that index + 1
Definition at line 56 of file icp_corr_tricks.c.
void ld_create_jump_tables | ( | struct laser_data * | ld | ) |
Definition at line 18 of file icp_corr_tricks.c.
INLINE double local_distance_squared_d | ( | const double * | a, |
const double * | b | ||
) |
Definition at line 43 of file icp_corr_tricks.c.
INLINE double mysin | ( | double | x | ) |
This is very close (but less than) to sin(x), for x in (0, PI/2). It's a 5° degree taylor expansion.
Definition at line 8 of file icp_corr_tricks.c.
int distance_counter |
Definition at line 46 of file math_utils.c.