]> git.droids-corp.org - aversive.git/commitdiff
enhance debug sensors on ballboard
authorzer0 <zer0@carbon.local>
Sun, 2 May 2010 22:41:35 +0000 (00:41 +0200)
committerzer0 <zer0@carbon.local>
Sun, 2 May 2010 22:41:35 +0000 (00:41 +0200)
projects/microb2010/ballboard/sensor.c

index fe7f92a7588a4b046c94a689ba4d787da42f81e4..92b1c47482dcab8e0aa7948b5cff76b58cb88306 100644 (file)
@@ -235,7 +235,8 @@ static void do_boolean_sensors(void *dummy)
        IRQ_UNLOCK(flags);
 }
 
-static volatile uint8_t lcob_seen = I2C_COB_NONE, rcob_seen = I2C_COB_NONE;
+static volatile uint8_t lcob_seen = I2C_COB_NONE;
+static volatile uint8_t rcob_seen = I2C_COB_NONE;
 
 uint8_t cob_detect_left(void)
 {
@@ -298,6 +299,12 @@ static void do_cob_detection(void)
                        else
                                lcob_seen = I2C_COB_BLACK;
                        IRQ_UNLOCK(flags);
+                       if (l_cpt_on > l_cpt_off)
+                               DEBUG(E_USER_SENSOR, "left white %d %d",
+                                     l_cpt_on, l_cpt_off);
+                       else
+                               DEBUG(E_USER_SENSOR, "left black %d %d",
+                                     l_cpt_on, l_cpt_off);
                }
        }
 
@@ -328,6 +335,13 @@ static void do_cob_detection(void)
                        else
                                rcob_seen = I2C_COB_BLACK;
                        IRQ_UNLOCK(flags);
+
+                       if (r_cpt_on > r_cpt_off)
+                               DEBUG(E_USER_SENSOR, "right white %d %d",
+                                     r_cpt_on, r_cpt_off);
+                       else
+                               DEBUG(E_USER_SENSOR, "right black %d %d",
+                                     r_cpt_on, r_cpt_off);
                }
        }