BETA_A
Dependencies: DataPool MD_PID mbed
main.cpp
- Committer:
- hirotayamato
- Date:
- 2017-09-15
- Revision:
- 11:5365da759270
- Parent:
- 9:feb86a283109
File content as of revision 11:5365da759270:
#include "mbed.h" #include "2017_3_h.h" #include "BetaTransporter.h" #include "DataPool.h" Omni_3 Omni(PB_4, PB_0, PA_12, PA_7, PB_5, PB_1, PA_6, PA_5, 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.00; y = beta->read(1) / 128.00; t = beta->read(2) / 128.00; Omni.Drive(x, y, t); wait(0.1); } }