
Go to the source code of this file.
Defines | |
| #define | _USE_MATH_DEFINES |
| URG センサ用の補助関数 | |
Functions | |
| static int | max (int a, int b) |
| static int | min (int a, int b) |
| int | urg_deg2index (const urg_t *urg, double degree) |
| int | urg_deg2step (const urg_t *urg, double degree) |
| void | urg_distance_min_max (const urg_t *urg, long *min_distance, long *max_distance) |
| const char * | urg_error (const urg_t *urg) |
| double | urg_index2deg (const urg_t *urg, int index) |
| double | urg_index2rad (const urg_t *urg, int index) |
| int | urg_max_data_size (const urg_t *urg) |
| int | urg_rad2index (const urg_t *urg, double radian) |
| int | urg_rad2step (const urg_t *urg, double radian) |
| long | urg_scan_usec (const urg_t *urg) |
| double | urg_step2deg (const urg_t *urg, int step) |
| int | urg_step2index (const urg_t *urg, int step) |
| double | urg_step2rad (const urg_t *urg, int step) |
| void | urg_step_min_max (const urg_t *urg, int *min_index, int *max_index) |
| #define _USE_MATH_DEFINES |
URG センサ用の補助関数
Definition at line 11 of file urg_utils.c.
| static int max | ( | int | a, |
| int | b | ||
| ) | [static] |
Definition at line 18 of file urg_utils.c.
| static int min | ( | int | a, |
| int | b | ||
| ) | [static] |
Definition at line 24 of file urg_utils.c.
| int urg_deg2index | ( | const urg_t * | urg, |
| double | degree | ||
| ) |
Definition at line 160 of file urg_utils.c.
| int urg_deg2step | ( | const urg_t * | urg, |
| double | degree | ||
| ) |
Definition at line 176 of file urg_utils.c.
| void urg_distance_min_max | ( | const urg_t * | urg, |
| long * | min_distance, | ||
| long * | max_distance | ||
| ) |
Example
long min_distance, max_distance; urg_distance_min_max(&urg, &min_distance, &max_distance); for (int i = 0; i < n; ++i) { long distance = data[i]; if ((distance < min_distance) || (distance > max_distance)) { continue; } ... }
Definition at line 73 of file urg_utils.c.
Example
if (!urg_open(&urg, "/dev/ttyACM0", 115200, URG_SERIAL)) { printf("urg_open: %s\n", urg_error(&urg)); return -1; }
Definition at line 30 of file urg_utils.c.
| double urg_index2deg | ( | const urg_t * | urg, |
| int | index | ||
| ) |
Definition at line 138 of file urg_utils.c.
| double urg_index2rad | ( | const urg_t * | urg, |
| int | index | ||
| ) |
Example
int n = urg_get_distance(&urg, data, NULL); for (int i = 0; i < n; ++i) { long distance = data[i]; double radian = urg_index2rad(i); double x = distance * cos(radian); double y = distance * sin(radian); printf("%.1f, %.1f\n", x, y); }
Definition at line 123 of file urg_utils.c.
| int urg_max_data_size | ( | const urg_t * | urg | ) |
Definition at line 114 of file urg_utils.c.
| int urg_rad2index | ( | const urg_t * | urg, |
| double | radian | ||
| ) |
Definition at line 144 of file urg_utils.c.
| int urg_rad2step | ( | const urg_t * | urg, |
| double | radian | ||
| ) |
Definition at line 166 of file urg_utils.c.
| long urg_scan_usec | ( | const urg_t * | urg | ) |
Definition at line 104 of file urg_utils.c.
| double urg_step2deg | ( | const urg_t * | urg, |
| int | step | ||
| ) |
Definition at line 192 of file urg_utils.c.
| int urg_step2index | ( | const urg_t * | urg, |
| int | step | ||
| ) |
Definition at line 198 of file urg_utils.c.
| double urg_step2rad | ( | const urg_t * | urg, |
| int | step | ||
| ) |
Definition at line 182 of file urg_utils.c.
| void urg_step_min_max | ( | const urg_t * | urg, |
| int * | min_step, | ||
| int * | max_step | ||
| ) |
Example
urg_step_min_max(&urg, &min_step, &max_step); printf("range first: %d [deg]\n", urg_step2deg(&urg, min_step)); printf("range last : %d [deg]\n", urg_step2deg(&urg, max_step));
Definition at line 91 of file urg_utils.c.