Takes in serial coordinates (in mm) and moves servos in Lynxmotion AL5 arm accordingly.

Dependencies:   mbed Servo

robo.h

Committer:
gvalentin3
Date:
2011-12-14
Revision:
0:4a15e2d20446

File content as of revision 0:4a15e2d20446:

//Robo class header for controlling robotic arm
//Created 10/12/2011 by MLD 427

#include "mbed.h"
class robo{
    private:
    PwmOut *spin;
    PwmOut *base;
    PwmOut *elbow;
    PwmOut *wrist;
    PwmOut *claw;
    PwmOut *trash;
    public:
    robo(PinName s, PinName b, PinName e, PinName w, PinName c, PinName t);
    void write(float percent, int motor);
    void writeSpin(float percent);
    void writeBase(float percent);
    void writeElbow(float percent);
    void writeWrist(float percent);
    void writeClaw(float percent);
    void writeTrash(float percent);
    float* calculateangle(float x1e, float y1e, float oe, float angles[]);
    
    
};