mirror of
https://github.com/supleed2/EIE4-FYP.git
synced 2024-11-13 21:45:48 +00:00
62 lines
1.9 KiB
C++
62 lines
1.9 KiB
C++
#include "can"
|
|
#include <generated/csr.h>
|
|
#include <irq.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
|
|
char *readstr(bool);
|
|
|
|
#ifdef CSR_CAN_BASE
|
|
uint32_t can_id_read(void) {
|
|
return can_can_id_read();
|
|
}
|
|
|
|
void can_id_write(uint32_t value) {
|
|
can_can_id_write(value);
|
|
}
|
|
|
|
uint32_t can_mask_read(void) {
|
|
return can_id_mask_read();
|
|
}
|
|
|
|
void can_mask_write(uint32_t value) {
|
|
can_id_mask_write(value);
|
|
}
|
|
|
|
can_frame can_read(void) {
|
|
can_frame frame;
|
|
frame.id = can_can_id_read();
|
|
frame.data[0] = can_rcv_data0_read();
|
|
frame.data[1] = can_rcv_data1_read();
|
|
frame.data[2] = can_rcv_data2_read();
|
|
frame.data[3] = can_rcv_data3_read();
|
|
frame.data[4] = can_rcv_data4_read();
|
|
frame.data[5] = can_rcv_data5_read();
|
|
frame.data[6] = can_rcv_data6_read();
|
|
frame.data[7] = can_rcv_data7_read();
|
|
return frame;
|
|
}
|
|
|
|
void can_isr(void) {
|
|
static uint32_t count = 0;
|
|
can_ev_pending_frame_write(1); // Should use `can_ev_pending_read()` and check which interrupt, but there is only 1
|
|
uint32_t o_leds = leds_out_read() >> 8; // Read LED state
|
|
uint32_t n_leds = o_leds ? o_leds : 0xFF0000; // Next LED state
|
|
leds_out_write(n_leds); // Toggle Red LED
|
|
count++;
|
|
can_frame frame = can_read();
|
|
printf("\033[F\033[F\33[2K\nCAN frame % 5d received, ID: 0x%03X, data: 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X\n",
|
|
count, frame.id, frame.data[0], frame.data[1], frame.data[2], frame.data[3], frame.data[4], frame.data[5],
|
|
frame.data[6], frame.data[7]); // Print CAN frame to UART
|
|
can_ev_enable_frame_write(1); // Re-enable event handler, same as in `can_init()`
|
|
printf("\e[92;1mStackSynth\e[0m> "); // Print prompt to UART
|
|
readstr(true); // Print current user input (if any)
|
|
}
|
|
|
|
void can_init(void) {
|
|
irq_setmask(irq_getmask() | (1 << CAN_INTERRUPT)); // Enable CAN interrupt
|
|
can_ev_enable_frame_write(1); // Should be `can_ev_enable_frame_write(1)` but it is equivalent
|
|
printf("CAN INIT\n"); // Print debug message to UART
|
|
}
|
|
#endif
|