From b4d8344ae068467679c733998ef9e0a2cbb6956c Mon Sep 17 00:00:00 2001 From: Florent Duchon Date: Wed, 16 May 2012 17:31:53 +0200 Subject: digital/beacon: sending angle management --- digital/beacon/src/laser.c | 24 +++++++++++++++++++++++- 1 file changed, 23 insertions(+), 1 deletion(-) (limited to 'digital/beacon/src/laser.c') diff --git a/digital/beacon/src/laser.c b/digital/beacon/src/laser.c index 888589ad..bf77cdd9 100644 --- a/digital/beacon/src/laser.c +++ b/digital/beacon/src/laser.c @@ -28,7 +28,9 @@ #include "debug_avr.h" #include "laser.h" #include "servo.h" +#include "network.h" #include "codewheel.h" +#include "calibration.h" laser_s laser; @@ -37,6 +39,7 @@ void laser_init(void) { /* Init laser structiure */ laser_set_angle(0); + laser_reset_angle_id(); /* Configure Input compare interrupts for Laser Interrupt*/ TCCR3B |= (1< 30) && (laser_get_angle_degree() < 70)) + { + uprintf("angle[%d] = %f\r\n",laser.angle_id,laser_get_angle_degree()); + laser.angle_id++; + } } /* Disable the interrupt */ -- cgit v1.2.3