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();
        
    }
}