NagaokaRoboticsClub_mbedTeam / Mbed OS 2021NHK_Bcon_RX

program for receiving 2021NHK B_team controller

Dependencies:   2021Bcon

main.cpp

Committer:
piroro4560
Date:
2021-10-16
Revision:
1:0cc19b454fc6
Parent:
0:157b6d43eb95

File content as of revision 1:0cc19b454fc6:

#include "controller.h"
#include "pinconfig.h"

Bcon mycon(fepTX, fepRX, fepad);
Serial pc(pcTX, pcRX, 115200);

int main()
{
    mycon.StartReceive();
    uint8_t b[8];
    int16_t stick[4];
    while(1) {
        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");
    }
}