広田 勇斗 / Mbed 2 deprecated BETA_A

Dependencies:   DataPool MD_PID mbed

main.cpp

Committer:
hirotayamato
Date:
2017-09-07
Revision:
8:c2569e1c34d7
Parent:
7:9eb4edae11c9
Child:
9:feb86a283109

File content as of revision 8:c2569e1c34d7:

#include "mbed.h"

#include "2017_3_h.h"

#include "BetaTransporter.h"
#include "DataPool.h"

Omni_3 Omni(PB_4, PB_0, PA_7, PA_2, PB_5, PB_1, PA_5, PA_6, PA_11, PF_0, PA_4, PA_3, 1);
Serial pc(USBTX, USBRX);

int main() {
    DataPool *beta;

    beta = new BetaTransporter;

    Omni.Drive(0, 0, 0);
    float x, y, t;
    while(1) {
        beta->set();
        x = beta->read(0) / 128;
        y = beta->read(1) / 128;
        t = beta->read(2) / 128;
        Omni.Drive(x, y, t);
    }
}