Sayak Chatterjee / Mbed 2 deprecated devilsafe

kh

Dependencies:   mbed PinDetect Servo

Diff: actuators.cpp

Revision:
3:2f7a7e2cd49e
Parent:
2:04bbd14722bd
diff -r 04bbd14722bd -r 2f7a7e2cd49e actuators.cpp
--- a/actuators.cpp	Mon Nov 12 23:36:11 2018 +0000
+++ b/actuators.cpp	Tue Nov 13 03:19:06 2018 +0000
@@ -8,8 +8,9 @@
 #include "Servo.h"
 
 
-Servo rcServo1(p23); // pwm
-Servo rcServo2(p24); // pwm
+Servo rcServo1(p21); // pwm
+Servo rcServo2(p22); // pwm
+Servo middle(p23);
 
 /*
 * Function:  turnsRcServosRight
@@ -43,6 +44,8 @@
 *  Opens the safe
 */
 void openSafe() {
+	middle = 1.0f;
+	wait(1);
 	turnsRcServosRight();
 }
 
@@ -53,6 +56,8 @@
 */
 void lockSafe() {
 	turnsRcServosLeft();
+	wait(3);
+	middle = 1.0f;
 }