summaryrefslogtreecommitdiffhomepage
path: root/digital/io/src/radar.c
diff options
context:
space:
mode:
authorNicolas Schodet2010-04-13 00:22:05 +0200
committerNicolas Schodet2010-04-13 00:22:05 +0200
commita7005814750c04d6e14186760e17effa1fde6898 (patch)
treeb1408910b689d54d013a0419058044627c06dfd8 /digital/io/src/radar.c
parentcdc38652ea2b310cf8f501924f3dec5d3e2818ea (diff)
digital/io/src: use position_t in radar interface
Diffstat (limited to 'digital/io/src/radar.c')
-rw-r--r--digital/io/src/radar.c10
1 files changed, 5 insertions, 5 deletions
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