Yosuke Kirihata / Mbed 2 deprecated Nucleo_CaitSith_Firmware_added_delayServo

Dependencies:   mbed

Fork of Nucleo_CaitSith_Firmware by Yosuke Kirihata

Revision:
0:a9b204e27472
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/RobotArm.cpp	Thu Sep 11 13:45:07 2014 +0000
@@ -0,0 +1,32 @@
+/*
+
+    Controller firmware for CaitSithDanger
+    
+    Kyoto-Densou-An 2014
+
+    Author : yishii
+*/
+
+
+#include <mbed.h>
+#include <RobotArm.h>
+
+RobotArm::RobotArm(PinName pin1,PinName pin2)
+{
+    mPwmServo[0] = new PwmServo(pin1);
+    mPwmServo[1] = new PwmServo(pin2);
+}
+
+RobotArm::~RobotArm()
+{
+    delete mPwmServo[0];
+    delete mPwmServo[1];    
+}
+
+void RobotArm::actuate(int angle1,int angle2)
+{
+    mPwmServo[0]->setAngle(angle1);
+    mPwmServo[1]->setAngle(angle2);
+}
+
+       
\ No newline at end of file