Thomas Giraud-Sauveur / Mbed 2 deprecated Gimbal_ENSEA

pour simone

Dependencies:   MPU6050 mbed

Diff: main.cpp

Revision:
2:146ff0747375
Parent:
0:63c6db89607f
--- a/main.cpp	Fri Jun 03 13:51:54 2016 +0000
+++ b/main.cpp	Fri Jun 03 14:50:37 2016 +0000
@@ -7,13 +7,22 @@
 Ticker filter; 
 Ticker toggler1; 
 MPU6050 mpu6050;  
-/*
+
 PwmOut pwm1A(PA_10);
 PwmOut pwm1B(PA_6);
 PwmOut pwm1C(PB_6);
 DigitalOut enable1A(PA_7);
 DigitalOut enable1B(PA_9);
-*/
+
+PwmOut pwm2A(PB_1);
+PwmOut pwm2B(PB_10);
+PwmOut pwm2C(PB_5);
+DigitalOut enable2A(PB_4);
+DigitalOut enable2B(PC_4);
+
+brushlessservo moteur(pwm1A,pwm1B,pwm1C,enable1A,enable1B);
+brushlessservo moteurB(pwm2A,pwm2B,pwm2C,enable2A,enable2B);
+
 float pitchAngle = 0;
 float rollAngle = 0;
 
@@ -22,7 +31,7 @@
 void toggle_led2();
 
 int main() {
-    brushlessservo moteur;
+    //brushlessservo moteur;
     mpu6050.init(); 
     filter.attach(&compFilter, 0.005);
     wait(1);