summaryrefslogtreecommitdiff
path: root/n/es-2006/src/main.c
diff options
context:
space:
mode:
Diffstat (limited to 'n/es-2006/src/main.c')
-rw-r--r--n/es-2006/src/main.c23
1 files changed, 22 insertions, 1 deletions
diff --git a/n/es-2006/src/main.c b/n/es-2006/src/main.c
index 4878f0d..172c385 100644
--- a/n/es-2006/src/main.c
+++ b/n/es-2006/src/main.c
@@ -56,6 +56,9 @@ uint8_t sharp_enable[SHARP_NUMBER], sharp_enable_freq[SHARP_NUMBER];
/* Stats for colour selection and jack */
uint8_t others_jackcolor_stat_enable, others_jackcolor_stats;
+/* Stat for RVB front sensors */
+uint8_t sniff_rvb_front_enable, sniff_rvb_front_stats;
+
/* XXX Debug stats */
uint8_t main_stats[4];
uint8_t main_stats_freq, main_stats_enable;
@@ -142,7 +145,11 @@ proto_callback (uint8_t cmd, uint8_t size, uint8_t *args)
break;
/* Print stats for ball */
case c ('B', 1):
- sniff_ball_stats = sniff_ball_stat_enable = args[1];
+ sniff_ball_stats = sniff_ball_stat_enable = args[0];
+ break;
+ /* Print stats for front RVB Sniff */
+ case c ('C', 1):
+ sniff_rvb_front_enable = sniff_rvb_front_stats = args[0];
break;
/* Enable all sensors */
case c ('u', 1):
@@ -333,6 +340,20 @@ main (void)
sniff_ball_stats = sniff_ball_stat_enable;
proto_send2b ('B', sniff_rvb_analysis_ball (7), sniff_rvb_analysis_ball (8));
}
+ /* Print stats for front sensors */
+ if (sniff_rvb_front_enable && !--sniff_rvb_front_stats)
+ {
+ if (sensor_rvb_state_sleeeping ())
+ {
+ /* Re init stats system for this sensor */
+ sniff_rvb_front_stats = sniff_rvb_front_enable;
+ proto_send2b
+ ('C', sniff_rvb_analysis_color (4, RVB_SNIFF_ALL_COLORS),
+ sniff_rvb_analysis_color (6, RVB_SNIFF_ALL_COLORS));
+ }
+ else
+ sniff_rvb_front_stats = 1;
+ }
main_stats[1] = TCNT0;