jetfishteam / Mbed 2 deprecated jetfish

the fish that looks like a jet

Dependencies:   ADXL345 ADXL345_I2C IMUfilter ITG3200 mbed Servo

guardian.cpp

Committer:
rkk
Date:
2014-02-17
Revision:
16:79cfe6201318
Parent:
12:7eeb29892625

File content as of revision 16:79cfe6201318:

#include "guardian.h"

Guardian::Guardian(PinName modpin, PinName gainpin)
:mod(modpin),
gain(gainpin)
{

    mod.write(0.5); //set autopilot to off
    gain.write(1.00);
}

void Guardian::set3D() //set autopilot to 3D
{
    mod.write(1.00);
    return;
}

void Guardian::set2D() //set autopilot 2D
{
    mod.write(0.00);
    return;
}

void Guardian::setoff()
{
    mod.write(0.5);
    return;
}

void Guardian::calibrate() //must be done within 15 sec of power on
{
    set2D();
    wait(500);
    set3D();
    wait(500);
    set2D();
    wait(2000);
    //now look for the twitch
    return;
}

void Guardian::setmod(float val)
{
    mod.write(val);
    return;
}

void Guardian::setgain(float val)
{
    gain.write(val);
    return;
}