Yosuke Kirihata / Mbed 2 deprecated Nucleo_CaitSith_Firmware_added_delayServo

Dependencies:   mbed

Fork of Nucleo_CaitSith_Firmware by Yosuke Kirihata

RobotArm.cpp

Committer:
YosukeK
Date:
2015-03-07
Revision:
8:857b3285dc79
Parent:
0:a9b204e27472

File content as of revision 8:857b3285dc79:

/*

    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);
}