This program control a 5 axis arm robot from lynx motion

Dependencies:   TextLCD mbed

robot.h

Committer:
msimmerl
Date:
2011-02-15
Revision:
0:b6608b36efd7

File content as of revision 0:b6608b36efd7:

#include <mbed.h>

#define P1_ARM_VORNE        0.00225
#define P1_ARM_HINTEN       0.00169
#define P1_KLAUE            0.0018
#define P1_HEBEN            0.00089

void InitServos(void);
void InitPosition(void);
void Fahre_zu_Init_Pos(void);
void Welcome(void);
//void GoToPos1(float speed);
float Drive(PwmOut servo, float posAkt, float posNeu, float speed);
float Drive(PwmOut servo1, PwmOut servo2, float posAkt, float posNeu, float speed);