79 lines
1.4 KiB
C
79 lines
1.4 KiB
C
#include <inttypes.h>
|
|
#include <avr/io.h>
|
|
#include <avr/interrupt.h>
|
|
#include <util/delay.h>
|
|
#include <can.h>
|
|
|
|
static void init() {
|
|
// Set PB as input, pull-up off
|
|
DDRB = 0;
|
|
// Set PC0/4/6 as input, pull-up off
|
|
DDRC &= ~(_BV(DDC0) | _BV(DDC4) | _BV(DDC6));
|
|
|
|
// Initialize CAN interface
|
|
can_init(BITRATE_125_KBPS);
|
|
// Regular receive/transmit mode
|
|
can_set_mode(NORMAL_MODE);
|
|
|
|
// Filter for status requests
|
|
can_filter_t filter = {
|
|
.id = 0x10,
|
|
.mask = 0x7ff,
|
|
.flags = {
|
|
.rtr = 1,
|
|
.extended = 0,
|
|
},
|
|
};
|
|
can_set_filter(0, &filter);
|
|
|
|
// Enable interrupts to start reception
|
|
sei();
|
|
}
|
|
|
|
static void send_status() {
|
|
// Get GPIO state
|
|
// PB -> invert -> Dend..Hend, Dempty..Fempty
|
|
uint8_t statusl = ~PINB;
|
|
// PC0,6,4 -> invert -> Gempty, Hempty, Reset
|
|
uint8_t pinc = ~PINC;
|
|
uint8_t gempty = (pinc & _BV(0)) ? _BV(0) : 0;
|
|
uint8_t hempty = (pinc & _BV(6)) ? _BV(1) : 0;
|
|
uint8_t swres = (pinc & _BV(4)) ? _BV(2) : 0;
|
|
uint8_t statush = gempty | hempty | swres;
|
|
|
|
if (can_check_free_buffer()) {
|
|
can_t msg = {
|
|
.id = 0x10,
|
|
.flags = {
|
|
.rtr = 0,
|
|
},
|
|
.length = 2,
|
|
.data = { statush, statusl, },
|
|
};
|
|
can_send_message(&msg);
|
|
}
|
|
}
|
|
|
|
static void loop() {
|
|
// Check for new messages
|
|
if (can_check_message()) {
|
|
can_t msg = { 0 };
|
|
uint8_t status = can_get_message(&msg);
|
|
if (status != 0) {
|
|
switch (msg.id) {
|
|
case 0x10:
|
|
if (msg.flags.rtr) {
|
|
send_status();
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
int main() {
|
|
init();
|
|
while (1) {
|
|
loop();
|
|
}
|
|
}
|
|
|