From eea8208edf3364a3003433267314e1c1916c3029 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Fri, 9 Apr 2010 19:54:42 +0200 Subject: digital/io/src: take obstacle radius into account, refs #129 --- digital/io/src/radar.c | 3 +++ 1 file changed, 3 insertions(+) (limited to 'digital/io/src/radar.c') diff --git a/digital/io/src/radar.c b/digital/io/src/radar.c index 294a4558..7c9557c4 100644 --- a/digital/io/src/radar.c +++ b/digital/io/src/radar.c @@ -98,6 +98,9 @@ radar_update (vect_t robot_pos, uint16_t robot_a, vect_t *obs_pos) robot_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); + vect_translate (&hit[i], &ray); } else valid[i] = 0; -- cgit v1.2.3