pentabug/firmware/main.c

56 lines
1.0 KiB
C

#include <inttypes.h>
#include <avr/io.h>
#include <avr/interrupt.h>
#define __DELAY_BACKWARD_COMPATIBLE__
#include <util/delay.h>
#include <stdlib.h>
#include "main.h"
#include "lib/synth.h"
#include "lib/usart.h"
#include "lib/bughal.h"
#include "lib/util.h"
void __attribute__((noreturn))
main(void)
{
/* hardware initialisation: */
init_leds();
init_buzzr();
init_switch();
USART0_Init();
init_motor();
/* software initialisation */
timer_init();
/* here the show begins:*/
sei();
//set_motor(MOTOR_ON);
timer_t t;
uint8_t ledmode =0;
uint16_t ct =0;
led_on(LED_R);
timer_set(&t, 100);
for(;;) /* ever */ {
//do something
//main polling loop;
if (timer_expired(&t)){
if (switch_l()) {led_on(LED_L);} else {led_off(LED_L);};
if (switch_r()) {led_on(LED_R);} else {led_off(LED_R);};
if (switch_l()&&switch_r()) {set_motor(MOTOR_ON);} else {set_motor(MOTOR_OFF);};
timer_set(&t, 5);
}; //end if timer expired
//USART0_put_uint16(0xA09F);
//USART0_crlf();
}
/* never return 0; */
}