From a7005814750c04d6e14186760e17effa1fde6898 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Tue, 13 Apr 2010 00:22:05 +0200 Subject: digital/io/src: use position_t in radar interface --- digital/io/src/radar.c | 10 +++++----- 1 file changed, 5 insertions(+), 5 deletions(-) (limited to 'digital/io/src/radar.c') diff --git a/digital/io/src/radar.c b/digital/io/src/radar.c index 7c9557c4..93aaa047 100644 --- a/digital/io/src/radar.c +++ b/digital/io/src/radar.c @@ -75,7 +75,7 @@ radar_valid (vect_t p) } uint8_t -radar_update (vect_t robot_pos, uint16_t robot_a, vect_t *obs_pos) +radar_update (const position_t *robot_pos, vect_t *obs_pos) { uint8_t i, j; vect_t ray; @@ -92,14 +92,14 @@ radar_update (vect_t robot_pos, uint16_t robot_a, vect_t *obs_pos) if (dist_mm[i] != 0xffff) { hit[i] = radar_sensors[i].pos; - vect_rotate_uf016 (&hit[i], robot_a); - vect_translate (&hit[i], &robot_pos); + vect_rotate_uf016 (&hit[i], robot_pos->a); + vect_translate (&hit[i], &robot_pos->v); vect_from_polar_uf016 (&ray, dist_mm[i], - robot_a + radar_sensors[i].a); + robot_pos->a + radar_sensors[i].a); vect_translate (&hit[i], &ray); valid[i] = radar_valid (hit[i]); vect_from_polar_uf016 (&ray, RADAR_OBSTACLE_RADIUS_MM, - robot_a + radar_sensors[i].a); + robot_pos->a + radar_sensors[i].a); vect_translate (&hit[i], &ray); } else -- cgit v1.2.3