Shuto Naruse / Mbed 2 deprecated Eurobot2012_Primary

Eurobot2012_Primary

Dependencies:   mbed Eurobot_2012_Primary

front_arms.h

Committer:
narshu
Date:
2012-05-01
Revision:
21:15da49f18c63
Parent:
8:ffc7d8af2d5a
Child:
23:1901cb6d0d95

File content as of revision 21:15da49f18c63:

#ifndef _FRONT_ARMS_H
#define _FRONT_ARMS_H

#include "mbed.h"

#define LEFT_ARM_PIN p21
#define RIGHT_ARM_PIN p24

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

void setLeftArmPosition(float degrees) {
    if(degrees < 90) degrees = 90; // If arm moves past this angle, robot will not fit in the perimeter constraint
    leftServo.position(degrees);
}

void setRightArmPosition(float degrees) {
    if(degrees > 90) degrees = 90; // If arm moves past this angle, robot will not fit in the perimeter constraint
    rightServo.position(degrees);
}

#endif // _FRONT_ARMS_H