53 lines
906 B
C
53 lines
906 B
C
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
#include <avr/io.h>
|
|
#include <avr/interrupt.h>
|
|
#include "avr.h"
|
|
|
|
#define cbi(byt, bit) (byt &= ~_BV(bit))
|
|
#define sbi(byt, bit) (byt |= _BV(bit))
|
|
|
|
extern volatile bool tick;
|
|
extern volatile uint32_t jiffies;
|
|
|
|
// Count microseconds
|
|
volatile uint32_t micros = 0;
|
|
|
|
// Interrupt called every 256 * 64 microseconds
|
|
ISR(TIM0_OVF_vect)
|
|
{
|
|
uint32_t m = micros;
|
|
|
|
m += (256 * 64);
|
|
if (m >= JIFFY_uS) {
|
|
m %= JIFFY_uS;
|
|
tick = true;
|
|
jiffies += 1;
|
|
}
|
|
micros = m;
|
|
}
|
|
|
|
|
|
void
|
|
init(void)
|
|
{
|
|
// Set prescaler to 16, so we get clock ticks at exactly 1MHz
|
|
CLKPR = _BV(CLKPCE);
|
|
CLKPR = 0x04;
|
|
|
|
// Set timer 0 interrupt clock divider to 64
|
|
TCCR0B = _BV(CS01) + _BV(CS00);
|
|
|
|
// enable timer 0 overflow interrupt
|
|
TIMSK0 |= _BV(TOIE0); //enable compare match interrupt;
|
|
|
|
// Enable interrupts
|
|
sei();
|
|
|
|
DDRA = ~(_BV(NESOUT));
|
|
DDRB = 0xff;
|
|
|
|
PORTA = 0;
|
|
PORTB = 0xff;
|
|
}
|