jetfishteam / Mbed 2 deprecated jetfish

the fish that looks like a jet

Dependencies:   ADXL345 ADXL345_I2C IMUfilter ITG3200 mbed Servo

main.cpp

Committer:
sandwich
Date:
2014-01-21
Revision:
0:ff9bc5f69c57
Child:
1:80e0af42f876
Child:
2:430c068cf570

File content as of revision 0:ff9bc5f69c57:

#include "mbed.h"
#include "motor_controller.h"
#include "IMU.h"

PololuMController mcon(p22, p6, p5);
IMU imu(0.1, 0.3, 0.005, 0.005);

int main() {
    Timer t;
    t.start();
    while(1) {
       /* if (speed>=1)
        {
            speed=0;
            mcon.reverse();
        }
        mcon.setspeed(speed);
        */
        mcon.drive_sinusoidal(t.read(), 1, 0.25*3.14, 0);
        wait(0.2);
    }
    t.stop();
}