//#define TARGET_STM32F103C8T6    1       // uncomment this line to use STM32F103C8T6 boards

//#define BOARD1  1                       // comment out this line when compiling for board #2

#if defined(TARGET_STM32F103C8T6)
#define LED_PIN PC_13
const int           OFF = 1;
const int           ON = 0;
#else
#define LED_PIN LED1
const int           OFF = 0;
const int           ON = 1;
#endif
#if defined(BOARD1)
const unsigned int  RX_ID = 0x100;
const unsigned int  TX_ID = 0x101;
#else
const unsigned int  RX_ID = 0x101;
const unsigned int  TX_ID = 0x100;
#endif
#include "mbed.h"
#include "CANMsg.h"
 
Serial              pc(USBTX, USBRX);
CAN                 can(PB_8, PB_9);    // CAN Rx pin name, CAN Tx pin name
CANMsg              rxMsg;
CANMsg              txMsg;
DigitalOut          led(LED_PIN);
Timer               timer;
uint8_t             counter = 0;
 

void printMsg(CANMessage& msg)
{
    pc.printf("  ID      = 0x%.3x\r\n", msg.id);
    pc.printf("  Type    = %d\r\n", msg.type);
    pc.printf("  Format  = %d\r\n", msg.format);
    pc.printf("  Length  = %d\r\n", msg.len);
    pc.printf("  Data    =");
    for (int i = 0; i < msg.len; i++)
        pc.printf(" 0x%.2X", msg.data[i]);
    pc.printf("\r\n");
}
 

int main(void)
{
    pc.baud(9600);                              // set serial speed
#if defined(BOARD1)
    led = ON;                                   // turn the LED on
    timer.start();                              // start timer
    pc.printf("CAN_Hello board #1\r\n");
#else
    led = OFF;                                  // turn LED off
    pc.printf("CAN_Hello board #2\r\n");
#endif
    can.frequency(1000000);                     // set CAN bit rate to 1Mbps
    can.filter(RX_ID, 0xFFF, CANStandard, 0);   // set filter #0 to accept only standard messages with ID == RX_ID
    while (1) {
        if (timer.read_ms() >= 2000) {
            // check for timeout
            timer.stop();                       // stop timer
            timer.reset();                      // reset timer
            counter++;                          // increment counter
            txMsg.clear();                      // clear Tx message storage
            txMsg.id = TX_ID;                   // set ID
            // append data (total data length must not exceed 8 bytes!)
            txMsg << counter;                   // one byte
            if (can.write(txMsg)) {
                // transmit message
                led = OFF;                      // turn the LED off
                pc.printf("-------------------------------------\r\n");
                pc.printf("-------------------------------------\r\n");
                pc.printf("CAN message sent\r\n");
                printMsg(txMsg);
                pc.printf("  counter = %d\r\n", counter);
            }
            else
                pc.printf("Transmission error\r\n");
        }
 
        if (can.read(rxMsg)) {
            pc.printf("-------------------------------------\r\n");
            pc.printf("CAN message received\r\n");
            printMsg(rxMsg);
            led = ON;                           // turn the LED on
            if (rxMsg.id == RX_ID) {
                rxMsg >> counter;
                pc.printf("  counter = %d\r\n", counter);
            }
 
            timer.start();                      // to transmit next message
        }
    }
}