ajout module_mouvement

Dependencies:   mbed xbee_lib ADXL345_I2C IMUfilter ITG3200 Motor RangeFinder Servo mbos PID

Fork of Labo_TRSE_Drone by HERBERT Nicolas

Revision:
36:660be809a49d
Parent:
35:3c410cdc4792
Child:
37:e1ad11fe3fe4
--- a/Module_Asservissement/Sous_Module_Mouvement/Module_Mouvement.cpp	Wed May 22 08:31:58 2013 +0000
+++ b/Module_Asservissement/Sous_Module_Mouvement/Module_Mouvement.cpp	Wed Nov 20 10:47:38 2013 +0000
@@ -29,10 +29,10 @@
  /* CONSRTRUCTEUR(S) */
  ModuleMouvement::ModuleMouvement()
  {
- m_motor1 = new PwmOut (p21);
- m_motor2 = new PwmOut (p22);
- m_motor3 = new PwmOut (p23);
- m_motor4 = new PwmOut (p24); 
+ m_motor1 = new PwmOut (p23);
+ m_motor2 = new PwmOut (p24);
+ m_motor3 = new PwmOut (p25);
+ m_motor4 = new PwmOut (p26); 
  }
  
  /* DESTRUCTEUR */
@@ -176,13 +176,19 @@
        //initialisation, attends du premier bip
        for (float s= 0; s < 0.40; s += 0.01) 
        {
-       m_motor1->write(s); 
+       m_motor1->write(s);
+       m_motor2->write(s);
+       m_motor3->write(s);
+       m_motor4->write(s);
        wait(0.2); 
        pc1.printf("%f", s);
        }
        wait(2);
        
        m_motor1->write(0.96);
+       m_motor2->write(0.96);
+       m_motor3->write(0.96);
+       m_motor4->write(0.96);
        pc1.printf("test motor");