Shuto Naruse / Mbed 2 deprecated Eurobot2012_Primary

Eurobot2012_Primary

Dependencies:   mbed Eurobot_2012_Primary

front_arms.h

Committer:
narshu
Date:
2012-10-17
Revision:
26:0995f61cb7b8
Parent:
23:1901cb6d0d95

File content as of revision 26:0995f61cb7b8:

#ifndef _FRONT_ARMS_H
#define _FRONT_ARMS_H

#include "mbed.h"
#include "Servo.h"

#define LEFT_ARM_PIN p21
#define RIGHT_ARM_PIN p24

Servo leftServo(LEFT_ARM_PIN);
Servo rightServo(RIGHT_ARM_PIN);

void ArmsOpen(void) {
    leftServo.SetPosition(1900);
    rightServo.SetPosition(1000);
}
void ArmsClose(void) {
    leftServo.SetPosition(1000);
    rightServo.SetPosition(1900);
}

void ArmsEnable(void) {
    leftServo.Enable(1000,20000);
    rightServo.Enable(1000,20000);
}

#endif // _FRONT_ARMS_H