131 lines
2.1 KiB
C
131 lines
2.1 KiB
C
#include "../config.h"
|
|
#include "../makros.h"
|
|
|
|
#include <avr/interrupt.h>
|
|
#include <avr/io.h>
|
|
#include <avr/wdt.h>
|
|
|
|
#include "borg_hw.h"
|
|
|
|
|
|
/*
|
|
// those macros get defined via menuconfig, now
|
|
|
|
#define ROWPORT PORTB
|
|
#define ROWDDR DDRB
|
|
|
|
#define COLPORT PORTD
|
|
#define COLDDR DDRD
|
|
|
|
#define PIN_DATA PC4
|
|
#define PIN_CLK PC6 //active low
|
|
#define PIN_LINE_EN PC5 //active low
|
|
|
|
*/
|
|
|
|
|
|
#define COLDDR DDR(COLPORT)
|
|
#define ROWDDR DDR(ROWPORT)
|
|
|
|
|
|
unsigned char pixmap[NUMPLANE][NUM_ROWS][LINEBYTES];
|
|
|
|
|
|
inline void rowshow(unsigned char row, unsigned char plane) {
|
|
COLPORT |= (1 << PIN_LINE_EN); //blank display
|
|
|
|
ROWPORT = (ROWPORT & 0xF8) | row;
|
|
|
|
unsigned char b, d, x;
|
|
for (b = 0; b < LINEBYTES; b++) {
|
|
d = pixmap[plane][row][b];
|
|
for (x = 0; x < 8; x++) {
|
|
if (d & 0x01) {
|
|
COLPORT |= (1 << PIN_DATA);
|
|
} else {
|
|
COLPORT &= ~(1 << PIN_DATA);
|
|
}
|
|
d >>= 1;
|
|
COLPORT &= ~(1 << PIN_CLK);
|
|
COLPORT |= (1 << PIN_CLK);
|
|
}
|
|
}
|
|
|
|
COLPORT &= ~(1 << PIN_LINE_EN); // unblank display
|
|
}
|
|
|
|
|
|
SIGNAL(SIG_OUTPUT_COMPARE0) {
|
|
static unsigned char plane = 0;
|
|
static unsigned char row = 0;
|
|
|
|
if (row == 0) {
|
|
switch (plane) {
|
|
case 0:
|
|
OCR0 = 7;
|
|
break;
|
|
case 1:
|
|
OCR0 = 20;
|
|
break;
|
|
case 2:
|
|
OCR0 = 40;
|
|
}
|
|
}
|
|
|
|
rowshow(row, plane);
|
|
|
|
if (++row == NUM_ROWS) {
|
|
row = 0;
|
|
if (++plane == NUMPLANE)
|
|
plane = 0;
|
|
}
|
|
wdt_reset();
|
|
}
|
|
|
|
|
|
void timer0_on() {
|
|
/* TCCR0: FOC0 WGM00 COM01 COM00 WGM01 CS02 CS01 CS00
|
|
CS02 CS01 CS00
|
|
0 0 0 stop
|
|
0 0 1 clk
|
|
0 1 0 clk/8
|
|
0 1 1 clk/64
|
|
1 0 0 clk/256
|
|
1 0 1 clk/1024
|
|
|
|
*/
|
|
TCCR0 = 0x08 | 0x04; // CTC Mode, clk/256
|
|
TCNT0 = 0; // reset timer
|
|
OCR0 = 0x30; // compare with this value
|
|
TIMSK = 0x02; // compare match Interrupt on
|
|
}
|
|
|
|
|
|
void timer0_off() {
|
|
cli();
|
|
|
|
COLPORT |= (1 << PIN_LINE_EN); //blank display
|
|
|
|
TCCR0 = 0x00;
|
|
sei();
|
|
}
|
|
|
|
|
|
void watchdog_enable() {
|
|
wdt_reset();
|
|
wdt_enable(0x00); // 17ms
|
|
|
|
}
|
|
|
|
|
|
void borg_hw_init() {
|
|
COLPORT |= (1 << PIN_CLK) | (1 << PIN_LINE_EN);
|
|
COLDDR |= (1 << PIN_CLK) | (1 << PIN_LINE_EN) | (1 << PIN_DATA);
|
|
|
|
ROWDDR |= 0x07;
|
|
|
|
watchdog_enable();
|
|
timer0_on();
|
|
}
|
|
|