summaryrefslogtreecommitdiff
path: root/n/asserv/src/main.c
diff options
context:
space:
mode:
authorschodet2005-02-05 13:59:01 +0000
committerschodet2005-02-05 13:59:01 +0000
commit9a4696369295d3a2c9389c41a69416bce14e215e (patch)
treeadaedf297096a6fbbc072d0ee2f6c629cc18dd4d /n/asserv/src/main.c
parent094c44352e2c985306641694b445fb5f0c835379 (diff)
cleanup
Diffstat (limited to 'n/asserv/src/main.c')
-rw-r--r--n/asserv/src/main.c48
1 files changed, 25 insertions, 23 deletions
diff --git a/n/asserv/src/main.c b/n/asserv/src/main.c
index 61ae706..3fed431 100644
--- a/n/asserv/src/main.c
+++ b/n/asserv/src/main.c
@@ -71,7 +71,7 @@ main_loop (void);
/* -AutoDec */
-/* Entry point. */
+/** Entry point. */
int
main (void)
{
@@ -88,7 +88,7 @@ main (void)
return 0;
}
-/* Main loop. */
+/** Main loop. */
static void
main_loop (void)
{
@@ -112,9 +112,21 @@ main_loop (void)
/* Pwm setup. */
pwm_update ();
/* Stats. */
+ if (motor_stat_counter && !--motor_stat_counter_cpt)
+ {
+ proto_send2w ('C', counter_left, counter_right);
+ motor_stat_counter_cpt = motor_stat_counter;
+ }
+ if (motor_stat_postrack && !--motor_stat_postrack_cpt)
+ {
+ proto_send1d ('X', postrack_x);
+ proto_send1d ('Y', postrack_y);
+ proto_send1d ('A', postrack_a);
+ motor_stat_postrack_cpt = motor_stat_postrack;
+ }
if (motor_stat_speed && !--motor_stat_speed_cpt)
{
- proto_send4w ('U', speed_left_e_old, speed_left_int,
+ proto_send4w ('S', speed_left_e_old, speed_left_int,
speed_right_e_old, speed_right_int);
motor_stat_speed_cpt = motor_stat_speed;
}
@@ -129,18 +141,6 @@ main_loop (void)
motor_timer_0);
motor_stat_timer_cpt = motor_stat_timer;
}
- if (motor_stat_counter && !--motor_stat_counter_cpt)
- {
- proto_send2w ('C', counter_left, counter_right);
- motor_stat_counter_cpt = motor_stat_counter;
- }
- if (motor_stat_postrack && !--motor_stat_postrack_cpt)
- {
- proto_send1d ('X', postrack_x);
- proto_send1d ('Y', postrack_y);
- proto_send1d ('A', postrack_a);
- motor_stat_postrack_cpt = motor_stat_postrack;
- }
/* Misc. */
if ((motor_loop_cpt & 7) == 0)
{
@@ -190,18 +190,20 @@ proto_callback (uint8_t cmd, uint8_t size, uint8_t *args)
case c ('f', 2):
postrack_set_footing (args[0] << 8 | args[1]);
break;
- case c ('m', 1):
- motor_stat_speed_cpt = motor_stat_speed = args[0];
- motor_stat_pwm_cpt = motor_stat_pwm = args[0];
- break;
- case c ('c', 1):
+ case c ('C', 1):
motor_stat_counter_cpt = motor_stat_counter = args[0];
break;
- case c ('t', 1):
- motor_stat_timer_cpt = motor_stat_timer = args[0];
+ case c ('X', 1):
+ motor_stat_postrack_cpt = motor_stat_postrack = args[0];
+ break;
+ case c ('S', 1):
+ motor_stat_speed_cpt = motor_stat_speed = args[0];
+ break;
+ case c ('W', 1):
+ motor_stat_pwm_cpt = motor_stat_pwm = args[0];
break;
case c ('T', 1):
- motor_stat_postrack_cpt = motor_stat_postrack = args[0];
+ motor_stat_timer_cpt = motor_stat_timer = args[0];
break;
default:
proto_send0 ('e');