summaryrefslogtreecommitdiff
path: root/digital/beacon/src/laser.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/beacon/src/laser.c')
-rw-r--r--digital/beacon/src/laser.c11
1 files changed, 5 insertions, 6 deletions
diff --git a/digital/beacon/src/laser.c b/digital/beacon/src/laser.c
index f5fca7ff..09f9368e 100644
--- a/digital/beacon/src/laser.c
+++ b/digital/beacon/src/laser.c
@@ -152,14 +152,13 @@ ISR(TIMER3_COMPB_vect)
}
else
{
- angle_to_send = laser_get_angle_raw() + (laser.angle_id << 9);
+ if(laser_get_angle_degree() < ANGLE_RANGE_MAX)
+ {
+ angle_to_send = laser_get_angle_raw() + (laser.angle_id << 9);
#ifdef LOL_NUMBER_2
- angle_to_send = (CODEWHEEL_CPR/4 - laser_get_angle_raw()) + (laser.angle_id << 9);
+ angle_to_send = (CODEWHEEL_CPR/4 - laser_get_angle_raw()) + (laser.angle_id << 9);
#endif
- network_send_data(NETWORK_ANGLE_RAW,angle_to_send);
- if((laser_get_angle_degree() > 30) && (laser_get_angle_degree() < 70))
- {
- uprintf("angle[%d] = %f\r\n",laser.angle_id,laser_get_angle_degree());
+ network_send_data(NETWORK_ANGLE_RAW,angle_to_send);
laser.angle_id++;
}
}