Samir Bouaziz / m3pi

function correction on motor control adding get individual sensor function

Dependents:   m3PI_TP_POPS_II2015v0 m3PI_TP_POPS_II2015v0 ourproject m3PI_TP_SETI ... more

Fork of m3pi by Chris Styles

Diff: m3pi.cpp

Revision:
4:54c673c71fc0
Parent:
3:c38d2f980494
Child:
5:09fb0636207b
--- a/m3pi.cpp	Mon Nov 01 23:30:09 2010 +0000
+++ b/m3pi.cpp	Sun Nov 07 09:57:11 2010 +0000
@@ -24,7 +24,8 @@
 #include "mbed.h"
 #include "m3pi.h"
 
-m3pi::m3pi(PinName nrst, PinName tx, PinName rx) :  Stream("m3pi"), _nrst(nrst), _ser(tx, rx)  {
+m3pi::m3pi(PinName nrst, PinName tx, PinName rx) :  Stream("m3pi"), _nrst(nrst), _ser(tx, rx), _leds(p20,p19,p18,p17,p16,p15,p14,p13)  {
+    _leds = 0;
     _ser.baud(115200);
     reset();
 }
@@ -33,6 +34,7 @@
     _nrst = 0;
     wait (0.01);
     _nrst = 1;
+    wait (0.01);
 }
 
 void m3pi::left_motor (float speed) {