Eurobot2012_Primary

Dependencies:   mbed Eurobot_2012_Primary

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers front_arms.h Source File

front_arms.h

00001 #ifndef _FRONT_ARMS_H
00002 #define _FRONT_ARMS_H
00003 
00004 #include "mbed.h"
00005 #include "Servo.h"
00006 
00007 #define LEFT_ARM_PIN p21
00008 #define RIGHT_ARM_PIN p24
00009 
00010 Servo leftServo(LEFT_ARM_PIN);
00011 Servo rightServo(RIGHT_ARM_PIN);
00012 
00013 void ArmsOpen(void) {
00014     leftServo.SetPosition(1900);
00015     rightServo.SetPosition(1000);
00016 }
00017 void ArmsClose(void) {
00018     leftServo.SetPosition(1000);
00019     rightServo.SetPosition(1900);
00020 }
00021 
00022 void ArmsEnable(void) {
00023     leftServo.Enable(1000,20000);
00024     rightServo.Enable(1000,20000);
00025 }
00026 
00027 #endif // _FRONT_ARMS_H