mirror of
https://github.com/Seeed-Studio/Seeed_Arduino_CAN.git
synced 2026-07-27 19:55:59 +00:00
98 lines
2.4 KiB
Arduino
98 lines
2.4 KiB
Arduino
/*
|
||
* demo: CAN-BUS Shield, receive all frames and print all fields id/type/data
|
||
* to receive frame fastly, a poll in loop() is required.
|
||
*
|
||
* Copyright (C) 2020 Seeed Technology Co.,Ltd.
|
||
*/
|
||
#include <SPI.h>
|
||
|
||
#define CAN_2515
|
||
// #define CAN_2518FD
|
||
|
||
// Set SPI CS Pin according to your hardware
|
||
|
||
#if defined(SEEED_WIO_TERMINAL) && defined(CAN_2518FD)
|
||
// For Wio Terminal w/ MCP2518FD RPi Hat：
|
||
// Channel 0 SPI_CS Pin: BCM 8
|
||
// Channel 1 SPI_CS Pin: BCM 7
|
||
// Interupt Pin: BCM25
|
||
const int SPI_CS_PIN = BCM8;
|
||
const int CAN_INT_PIN = BCM25;
|
||
#else
|
||
|
||
// For Arduino MCP2515 Hat:
|
||
// the cs pin of the version after v1.1 is default to D9
|
||
// v0.9b and v1.0 is default D10
|
||
const int SPI_CS_PIN = 9;
|
||
const int CAN_INT_PIN = 2;
|
||
#endif
|
||
|
||
|
||
#ifdef CAN_2518FD
|
||
#include "mcp2518fd_can.h"
|
||
mcp2518fd CAN(SPI_CS_PIN); // Set CS pin
|
||
#define MAX_DATA_SIZE 64
|
||
#endif
|
||
|
||
#ifdef CAN_2515
|
||
#include "mcp2515_can.h"
|
||
mcp2515_can CAN(SPI_CS_PIN); // Set CS pin
|
||
#define MAX_DATA_SIZE 8
|
||
#endif
|
||
|
||
void setup() {
|
||
SERIAL_PORT_MONITOR.begin(115200);
|
||
while (!SERIAL_PORT_MONITOR) {}
|
||
|
||
while (CAN_OK != CAN.begin(CAN_500KBPS)) { // init can bus : baudrate = 500k
|
||
SERIAL_PORT_MONITOR.println(F("CAN init fail, retry..."));
|
||
delay(100);
|
||
}
|
||
SERIAL_PORT_MONITOR.println(F("CAN init ok!"));
|
||
}
|
||
|
||
uint32_t id;
|
||
uint8_t type; // bit0: ext, bit1: rtr
|
||
uint8_t len;
|
||
byte cdata[MAX_DATA_SIZE] = {0};
|
||
|
||
void loop() {
|
||
// check if data coming
|
||
if (CAN_MSGAVAIL != CAN.checkReceive()) {
|
||
return;
|
||
}
|
||
|
||
char prbuf[32 + MAX_DATA_SIZE * 3];
|
||
int i, n;
|
||
|
||
unsigned long t = millis();
|
||
// read data, len: data length, buf: data buf
|
||
CAN.readMsgBuf(&len, cdata);
|
||
|
||
id = CAN.getCanId();
|
||
type = (CAN.isExtendedFrame() << 0) |
|
||
(CAN.isRemoteRequest() << 1);
|
||
/*
|
||
* MCP2515(or this driver) could not handle properly
|
||
* the data carried by remote frame
|
||
*/
|
||
|
||
n = sprintf(prbuf, "%04lu.%03d ", t / 1000, int(t % 1000));
|
||
/* Displayed type:
|
||
*
|
||
* 0x00: standard data frame
|
||
* 0x02: extended data frame
|
||
* 0x30: standard remote frame
|
||
* 0x32: extended remote frame
|
||
*/
|
||
static const byte type2[] = {0x00, 0x02, 0x30, 0x32};
|
||
n += sprintf(prbuf + n, "RX: [%08lX](%02X) ", (unsigned long)id, type2[type]);
|
||
// n += sprintf(prbuf, "RX: [%08lX](%02X) ", id, type);
|
||
|
||
for (i = 0; i < len; i++) {
|
||
n += sprintf(prbuf + n, "%02X ", cdata[i]);
|
||
}
|
||
SERIAL_PORT_MONITOR.println(prbuf);
|
||
}
|
||
// END FILE
|