sub2 MDC and enc
Dependencies: 2022_NHK_B_canTR FEP_RX22 QEI ikarashiMDC_2byte_ver mbed HOSOKIkikou R1370 SEKIkikou
main.cpp
- Committer:
- umekou
- Date:
- 20 months ago
- Revision:
- 2:ea17f9e04972
- Parent:
- 0:877aeb04390a
- Child:
- 3:75dae8deb5f3
File content as of revision 2:ea17f9e04972:
#include "mbed.h" #include "controller.h" #include "pinconfig.h" #include "ikarashiMDC.h" Bcon mycon(fepTX, fepRX, fepad); Serial pc(USBTX, USBRX, 115200); Serial serial(motorTX, motorRX, 115200); DigitalOut stop(stop_pin); DigitalOut led(LED2); ikarashiMDC motor[] = { ikarashiMDC(0,0,SM,&serial), ikarashiMDC(0,1,SM,&serial), ikarashiMDC(0,2,SM,&serial), ikarashiMDC(0,3,SM,&serial) }; uint8_t b[8]; int16_t stick[4]; void recieveController(){ for (int i=0; i<8; i++) b[i] = mycon.getButton(i); for (int i=0; i<4; i++) stick[i] = mycon.getStick(i); for (int i=0; i<8; i++) pc.printf("%d ", b[i]); pc.printf(" | "); for (int i=0; i<4; i++) pc.printf("%3d ", stick[i]); pc.printf(" | "); if (mycon.status) pc.printf("received\r\n"); else pc.printf("anything error...\r\n"); } int main() { mycon.StartReceive(); stop = 1; led = 1; while(1) { //recieveController(); } }