pentabug/firmware/main.c
2012-07-26 01:34:49 +02:00

101 lines
1.5 KiB
C

#include <inttypes.h>
#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>
#include <stdlib.h>
#include "main.h"
//25kHz
ISR (TIMER0_OVF_vect)
{
}
static void init_sampletimer(void)
{
// Timer 0
//
//set timer0 to CTC & prescaler 64 == 125k
TCCR0A = (1<<WGM01);
TCCR0B = (1<<CS00)|(1<<CS01);
//count up to 5 :
OCR0A = 5;
//enable interrupt
TIMSK0 |= (1<<TOIE0);
}
static inline void init_pwm(void)
{
//PB1 set to output:
DDRB |= (1<<PORTB2);
OCR1B = 0xefff; //preselect some default
ICR1 = 0xffff; // TOP-wert
TCCR1A = (1<<COM1B1) | (1<<WGM11); // only b-chan , fastpwm (mode 14)
TCCR1B = (1<<WGM13)|(1<<WGM12) | (1<<CS10); //Fastpwm, no prescale
return ;
}
static void init_leds(void)
{
//enable LED channels as output
DDRC |= (1 << PORTC0) | (1 << PORTC2) | (1 << PORTC3) | (1 << PORTC1);
PORTC = 1; //one led is on...
return;
}
inline void setleds(uint8_t state)
{
//set leds according to
PORTC |= (state | 0b00001111);
PORTC &= ~(state | 0b11110000);
return;
}
static void init_motor(void)
{
//vibration motor on B1:
DDRB |= (1 << PORTB1);
}
static void stupid_pwmtest(void)
{
uint8_t i,t,r;
ICR1 = 0xAA00;
r=1;
for (;;) {
t = (r)?(t+1):(t-1);
ICR1 = (t << 7);
if(t=0) r ^= 1;
for(i=1;i<100;i++) __asm("nop");
}
return; //never
}
int main(void)
{
//hardware initialisation:
init_leds();
init_motor();
init_pwm();
//just stupid test for now....
stupid_pwmtest();
//never get here
return;
}