James O'Keeffe / Mbed 2 deprecated BeaconDemo_RobotCodeNew

ft. button press reset

Dependencies:   mbed

Fork of BeaconDemo_RobotCode by Science Memeseum

Diff: PsiSwarm/psiswarm.cpp

Revision:
4:25039ea5eb09
Parent:
3:cd048f6e544e
Child:
5:598298aa4900
diff -r cd048f6e544e -r 25039ea5eb09 PsiSwarm/psiswarm.cpp
--- a/PsiSwarm/psiswarm.cpp	Mon Oct 05 20:42:37 2015 +0000
+++ b/PsiSwarm/psiswarm.cpp	Mon Oct 12 12:39:35 2015 +0000
@@ -118,6 +118,8 @@
     if(read_firmware() == 1){
         debug("Version %3.2f\n",firmware_version);   
     }else debug("INVALID\n");
+    debug("- Setting up PIC microcontroller\n");
+   // IF_check_pic_firmware();
     debug("- Setting up LED drivers\n");
     IF_init_leds();    
     if(IF_setup_led_expansion_ic() != 0) {
@@ -198,6 +200,7 @@
     if(lwe == 0 && lwep==2) left_encoder--;
     if(rwe == 0 && rwep==1) right_encoder++;
     if(rwe == 0 && rwep==2) right_encoder--;
+    if(left_encoder % 100 == 0) pc.printf("L:%d\n",left_encoder);
 }
 
 void IF_update_user_id()