#include <Arduino.h>
#include <esp32_can.h>

void printFrame(CAN_FRAME *message)
{
  Serial.print(message->id, HEX);
  if (message->extended) Serial.print(" X ");
  else Serial.print(" S ");   
  Serial.print(message->length, DEC);
  for (int i = 0; i < message->length; i++) {
    Serial.print(message->data.byte[i], HEX);
    Serial.printf(" ");
  }
  Serial.print('\n');
}

void gotHundred(CAN_FRAME *frame)
{
  Serial.printf("Got special frame!  ");
  printFrame(frame);
}

void setup(void) {
  Serial.begin(115200);
  delay(1000);

  Serial.printf("Initializing ...");

  CAN0.begin(125000);
}

void loop() {
  CAN_FRAME message;

  if (CAN0.read(message)) {
    printFrame(&message);
  }
}