#include <stdio.h>
#include "pico/stdlib.h"
#include "mcp2515.h"

MCP2515 can0;
struct can_frame rx;

int main() {
    stdio_init_all();

    // Initialize interface
    can0.reset();
    can0.setBitrate(CAN_250KBPS, MCP_16MHZ);
    can0.setNormalMode();

    // Listen loop
    while (true) {
        if(can0.readMessage(&rx) == MCP2515::ERROR_OK) {
            printf("New frame from ID: %10x\n", rx.can_id);
        } else {
            printf("CAN error!\n");
            sleep_ms(1000);
        }
    }

    return 0;
}