Diff: PolyServo.cpp

Revision:

1:1135f0b1566e

Parent:

0:6105cf98b610

Child:

2:f982504e6e84

--- a/PolyServo.cpp	Fri Jun 26 08:23:05 2015 +0000
+++ b/PolyServo.cpp	Sat Jun 27 06:03:19 2015 +0000
@@ -1,22 +1,25 @@
 
 #include "PolyServo.h"
 #include "mbed.h"
+#include "FPointer.h"
 #include <vector>
 
 
 Polyservo::Polyservo(DigitalOut servo_pins[], int num_pins): numservos(num_pins) {
-    servos.reserve(numservos); servo_times.reserve(numservos); 
+    servos.reserve(numservos); servo_timers.reserve(numservos); positions.reserve(numservos);
     //numservos = num_pins; 
     for(int i = 0; i < numservos; i++){
         Timeout* t = new Timeout(); 
         servos.push_back(&servo_pins[i]);
-        servo_times.push_back(t);
+        servo_timers.push_back(t);
+        positions.push_back(SERVO_DISABLED);
+        servos[i]->write(0);
                
     }
     
     
     servos[2]->is_connected();
-    servo_times[2]->detach();
+    servo_timers[2]->detach();
     
     
 }
\ No newline at end of file