Refactored display intf routines into module
This commit is contained in:
parent
6b58fc2738
commit
a2a0ab6865
2 changed files with 20 additions and 109 deletions
|
@ -1,7 +1,7 @@
|
||||||
PRG = display
|
PRG = display
|
||||||
PROJ_ROOT = ../..
|
PROJ_ROOT = ../..
|
||||||
AVRCANLIB_PATH = $(PROJ_ROOT)/avr-can-lib
|
AVRCANLIB_PATH = $(PROJ_ROOT)/avr-can-lib
|
||||||
OBJ = main.o \
|
OBJ = main.o display.o \
|
||||||
$(AVRCANLIB_PATH)/src/at90can_buffer.o \
|
$(AVRCANLIB_PATH)/src/at90can_buffer.o \
|
||||||
$(AVRCANLIB_PATH)/src/at90can.o \
|
$(AVRCANLIB_PATH)/src/at90can.o \
|
||||||
$(AVRCANLIB_PATH)/src/at90can_disable_dyn_filter.o \
|
$(AVRCANLIB_PATH)/src/at90can_disable_dyn_filter.o \
|
||||||
|
|
|
@ -5,11 +5,16 @@
|
||||||
#include <util/delay.h>
|
#include <util/delay.h>
|
||||||
#include <can.h>
|
#include <can.h>
|
||||||
#include <messages.h>
|
#include <messages.h>
|
||||||
|
#include "display.h"
|
||||||
|
|
||||||
static bool report_change = false;
|
static bool report_change = false;
|
||||||
|
|
||||||
static void init() {
|
static void init();
|
||||||
/*
|
static uint8_t get_buttons();
|
||||||
|
static void send_status();
|
||||||
|
static void loop();
|
||||||
|
|
||||||
|
/* I/O map:
|
||||||
PB2 BUTTON0
|
PB2 BUTTON0
|
||||||
PB3 BUTTON1
|
PB3 BUTTON1
|
||||||
PB4 BUTTON2
|
PB4 BUTTON2
|
||||||
|
@ -32,15 +37,17 @@ static void init() {
|
||||||
PD6 VFDDB6
|
PD6 VFDDB6
|
||||||
PD7 VFDDB7
|
PD7 VFDDB7
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
static void init() {
|
||||||
|
// initialize buttons
|
||||||
// PB2, PB3, PB4, PB5, PB6, PC0, PC1, PC4: input, no pullup (button0..7)
|
// PB2, PB3, PB4, PB5, PB6, PC0, PC1, PC4: input, no pullup (button0..7)
|
||||||
// PC5, PC6, PC7: output (VFD RS, RW, E), RS=0, RW=H, E=H
|
PORTB &= ~(_BV(PB2) | _BV(PB3) | _BV(PB4) | _BV(PB5) | _BV(PB6));
|
||||||
// PD: output (VFD DB) - can be switched to input w/ pullup
|
DDRB &= ~(_BV(PB2) | _BV(PB3) | _BV(PB4) | _BV(PB5) | _BV(PB6));
|
||||||
PORTB = 0x00;
|
PORTC &= ~(_BV(PC0) | _BV(PC1) | _BV(PC4));
|
||||||
DDRB = 0x00;
|
DDRC &= ~(_BV(PC0) | _BV(PC1) | _BV(PC4));
|
||||||
PORTC = _BV(PC6) | _BV(PC7);
|
|
||||||
DDRC = _BV(PC5) | _BV(PC6) | _BV(PC7);
|
// initialize VFD
|
||||||
PORTD = 0x00;
|
display_init();
|
||||||
DDRD = 0xff;
|
|
||||||
|
|
||||||
// Initialize CAN interface
|
// Initialize CAN interface
|
||||||
can_init(BITRATE_125_KBPS);
|
can_init(BITRATE_125_KBPS);
|
||||||
|
@ -103,102 +110,6 @@ static void send_status() {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static uint8_t read_ir() {
|
|
||||||
// switch PD to input
|
|
||||||
DDRD = 0x00;
|
|
||||||
// E=0 (enable/clock) RS=0 (IR) RW=1 (read)
|
|
||||||
PORTC = (PORTC & ~(_BV(PC5) | _BV(PC7))) | _BV(PC6);
|
|
||||||
_delay_us(0.23);
|
|
||||||
// E=1 (enable/clock)
|
|
||||||
PORTC |= _BV(PC7);
|
|
||||||
_delay_us(0.16);
|
|
||||||
uint8_t data = PIND;
|
|
||||||
_delay_us(0.23 - 0.16);
|
|
||||||
// E=0 (enable/clock)
|
|
||||||
PORTC &= ~_BV(PC7);
|
|
||||||
_delay_us(0.01);
|
|
||||||
// reset to idle
|
|
||||||
PORTC = _BV(PC6) | _BV(PC7);
|
|
||||||
DDRD = 0xff;
|
|
||||||
return data;
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t read_dr() {
|
|
||||||
// switch PD to input
|
|
||||||
DDRD = 0x00;
|
|
||||||
// E=0 (enable/clock) RS=1 (IR) RW=1 (read)
|
|
||||||
PORTC = (PORTC & ~_BV(PC7)) | (_BV(PC5) | _BV(PC6));
|
|
||||||
_delay_us(0.23);
|
|
||||||
// E=1 (enable/clock)
|
|
||||||
PORTC |= _BV(PC7);
|
|
||||||
_delay_us(0.16);
|
|
||||||
uint8_t data = PIND;
|
|
||||||
_delay_us(0.23 - 0.16);
|
|
||||||
// E=0 (enable/clock)
|
|
||||||
PORTC &= ~_BV(PC7);
|
|
||||||
_delay_us(0.01);
|
|
||||||
// reset to idle
|
|
||||||
PORTC = _BV(PC6) | _BV(PC7);
|
|
||||||
DDRD = 0xff;
|
|
||||||
return data;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void write_ir(uint8_t data) {
|
|
||||||
// E=0 (enable/clock) RS=0 (IR) RW=0 (write)
|
|
||||||
PORTC &= ~(_BV(PC5) | _BV(PC6) | _BV(PC7));
|
|
||||||
_delay_us(0.23);
|
|
||||||
// E=1 (enable/clock)
|
|
||||||
PORTC |= _BV(PC7);
|
|
||||||
// data
|
|
||||||
PORTD = data;
|
|
||||||
_delay_us(0.23);
|
|
||||||
// E=0 (enable/clock)
|
|
||||||
PORTC &= ~_BV(PC7);
|
|
||||||
_delay_us(0.01);
|
|
||||||
// reset to idle
|
|
||||||
PORTC = _BV(PC6) | _BV(PC7);
|
|
||||||
PORTD = 0x00;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void write_dr(uint8_t data) {
|
|
||||||
// E=0 (enable/clock) RS=1 (IR) RW=0 (write)
|
|
||||||
PORTC = (PORTC & ~(_BV(PC6) | _BV(PC7))) | _BV(PC5);
|
|
||||||
_delay_us(0.23);
|
|
||||||
// E=1 (enable/clock)
|
|
||||||
PORTC |= _BV(PC7);
|
|
||||||
// data
|
|
||||||
PORTD = data;
|
|
||||||
_delay_us(0.23);
|
|
||||||
// E=0 (enable/clock)
|
|
||||||
PORTC &= ~_BV(PC7);
|
|
||||||
_delay_us(0.01);
|
|
||||||
// reset to idle
|
|
||||||
PORTC = _BV(PC6) | _BV(PC7);
|
|
||||||
PORTD = 0x00;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static bool wait_ready() {
|
|
||||||
// if the busy flag never goes high, we'll run into a deadlock here.
|
|
||||||
// let's put a deadline on the wait loop.
|
|
||||||
for (uint8_t i = 0; i < 100; i++) {
|
|
||||||
// read_ir() takes about 500ns
|
|
||||||
if (read_ir() & _BV(7)) return true;
|
|
||||||
// wait 10us until the next status read
|
|
||||||
_delay_us(10 - 0.5);
|
|
||||||
}
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void write_display(uint8_t command, const uint8_t *data, uint8_t length) {
|
|
||||||
if (wait_ready()) {
|
|
||||||
write_ir(command);
|
|
||||||
for (uint8_t i = 0; i < length; i++) {
|
|
||||||
write_dr(data[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void loop() {
|
static void loop() {
|
||||||
// Check for new messages
|
// Check for new messages
|
||||||
if (can_check_message()) {
|
if (can_check_message()) {
|
||||||
|
@ -211,7 +122,7 @@ static void loop() {
|
||||||
break;
|
break;
|
||||||
case CAN_MSG_DISPLAY_CMD:
|
case CAN_MSG_DISPLAY_CMD:
|
||||||
if (msg.length >= 1) {
|
if (msg.length >= 1) {
|
||||||
write_display(msg.data[0], &msg.data[1], msg.length - 1);
|
display_write(msg.data[0], &msg.data[1], msg.length - 1);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case CAN_MSG_AUTO_STATUS:
|
case CAN_MSG_AUTO_STATUS:
|
||||||
|
|
Loading…
Reference in a new issue