Yosuke Kirihata / Mbed 2 deprecated Nucleo_CaitSith_Firmware_added_delayServo

Dependencies:   mbed

Fork of Nucleo_CaitSith_Firmware by Yosuke Kirihata

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers RobotArm.cpp Source File

RobotArm.cpp

00001 /*
00002 
00003     Controller firmware for CaitSithDanger
00004     
00005     Kyoto-Densou-An 2014
00006 
00007     Author : yishii
00008 */
00009 
00010 
00011 #include <mbed.h>
00012 #include <RobotArm.h>
00013 
00014 RobotArm::RobotArm(PinName pin1,PinName pin2)
00015 {
00016     mPwmServo[0] = new PwmServo(pin1);
00017     mPwmServo[1] = new PwmServo(pin2);
00018 }
00019 
00020 RobotArm::~RobotArm()
00021 {
00022     delete mPwmServo[0];
00023     delete mPwmServo[1];    
00024 }
00025 
00026 void RobotArm::actuate(int angle1,int angle2)
00027 {
00028     mPwmServo[0]->setAngle(angle1);
00029     mPwmServo[1]->setAngle(angle2);
00030 }
00031 
00032