Adjust test code to new hardware
This commit is contained in:
Thammi
parent
b57aa8b263
commit
278aae7c7d
215
fw_test/main.c
215
fw_test/main.c
|
|
@ -5,203 +5,70 @@
|
||||||
#include <util/delay.h>
|
#include <util/delay.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
|
|
||||||
|
#define ever (;;)
|
||||||
|
|
||||||
#define LED_L (1 << PORTC0)
|
#define follow(from_port, from_pin, to_port, to_pin) { if(from_port & (1 << from_pin)) to_port &= ~(1 << to_pin); else to_port |= 1 << to_pin; }
|
||||||
#define LED_R (1 << PORTC2)
|
#define not_follow(from_port, from_pin, to_port, to_pin) { if(from_port & (1 << from_pin)) to_port |= 1 << to_pin; else to_port &= ~(1 << to_pin); }
|
||||||
#define MOTOR_ON (0<<PORTB1)
|
|
||||||
#define MOTOR_OFF (1<<PORTB1)
|
|
||||||
|
|
||||||
|
int main(void) {
|
||||||
|
uint8_t vib_delay = 0;
|
||||||
|
|
||||||
|
// init and stuff
|
||||||
|
|
||||||
static void init_leds(void){
|
PORTB |= (1 << 6) | (1 << 7);
|
||||||
//enable LED channels as output
|
PORTC |= (1 << 0) | (1 << 2) | (1 << 3);
|
||||||
DDRC |= (1 << PORTC0) | (1 << PORTC1) | (1 << PORTC2) | (1 << PORTC3);
|
|
||||||
// both LEDs off
|
|
||||||
PORTC &= ~((1 << PORTC0) | (1 << PORTC1) | (1 << PORTC2) | (1 << PORTC3));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void inline led_on(int leds){
|
DDRB |= (1 << 6) | (1 << 7);
|
||||||
PORTC |= leds;
|
DDRC |= (1 << 0) | (1 << 2) | (1 << 3);
|
||||||
}
|
DDRD |= (1 << 2) | (1 << 4);
|
||||||
|
|
||||||
static void inline led_off(int leds){
|
// pullups
|
||||||
PORTC &= ~leds;
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void inline buzzr_off(void){
|
PORTB |= (1 << 0) | (1 << 1) | (1 << 2);
|
||||||
PORTC &= ~(1 << PORTC5);
|
PORTC |= (1 << 4) | (1 << 5);
|
||||||
PORTB &= ~(1 << PORTB2);
|
PORTD |= (1 << 7);
|
||||||
}
|
|
||||||
|
|
||||||
static void init_buzzr(void){
|
PORTD |= 1 << 2;
|
||||||
//its on B2 and C5, for reasons
|
|
||||||
DDRC |= (1 << PORTC5);
|
|
||||||
DDRB |= (1 << PORTB2);
|
|
||||||
//switch it off
|
|
||||||
buzzr_off();
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void buzzr_up(void){
|
// looping
|
||||||
PORTC &= ~(1 << PORTC5);
|
|
||||||
PORTB |= (1 << PORTB2);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void buzzr_down(void){
|
for ever {
|
||||||
PORTC |= (1 << PORTC5);
|
// LEDs
|
||||||
PORTB &= ~(1 << PORTB2);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
not_follow(PINB, 0, PORTD, 4);
|
||||||
|
/*not_follow(PINB, 1, PORTC, 2);*/
|
||||||
|
|
||||||
|
not_follow(PIND, 3, PORTC, 2);
|
||||||
|
|
||||||
static void buzzr_inv(void){
|
// vibration
|
||||||
PORTC ^= (1 << PORTC5);
|
|
||||||
PORTB ^= (1 << PORTB2);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
follow(PINC, 4, PORTB, 6);
|
||||||
|
|
||||||
static void init_motor(void)
|
// higher buzzer
|
||||||
{
|
|
||||||
/* vibration motor on B1, initially off: */
|
|
||||||
DDRB |= (1 << PORTB1);
|
|
||||||
PORTB &= ~( 1<<PORTB1);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void set_motor(int val){
|
|
||||||
PORTB = ~(val);
|
|
||||||
PORTB = PORTB;
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void init_switch(void){
|
|
||||||
DDRD &= ~( (1 << PORTD1) | (1<<PORTD0));
|
|
||||||
PORTD |= (1 << PORTD1) | (1<<PORTD0); //Pullups FTW
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void blinkrattlebeep(void){
|
|
||||||
led_off(LED_L|LED_R);
|
|
||||||
_delay_ms(100);
|
|
||||||
led_on(LED_L);
|
|
||||||
_delay_ms(100);
|
|
||||||
led_off(LED_L);
|
|
||||||
led_on(LED_R);
|
|
||||||
_delay_ms(100);
|
|
||||||
led_off(LED_R);
|
|
||||||
set_motor(MOTOR_ON);
|
|
||||||
_delay_ms(200);
|
|
||||||
set_motor(MOTOR_OFF);
|
|
||||||
buzzr_up();
|
|
||||||
for (int i=0; i<100; i++){
|
|
||||||
_delay_ms(2);
|
|
||||||
buzzr_inv();
|
|
||||||
};
|
|
||||||
buzzr_off();
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mode_motortest(void)
|
|
||||||
{
|
|
||||||
set_motor(MOTOR_ON);
|
|
||||||
_delay_ms(400);
|
|
||||||
set_motor(MOTOR_OFF);
|
|
||||||
_delay_ms(500);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void mode_blinktest(void)
|
|
||||||
{
|
|
||||||
led_off(LED_L|LED_R);
|
|
||||||
_delay_ms(100);
|
|
||||||
led_on(LED_L);
|
|
||||||
_delay_ms(100);
|
|
||||||
led_off(LED_L);
|
|
||||||
led_on(LED_R);
|
|
||||||
_delay_ms(100);
|
|
||||||
led_off(LED_R);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mode_beeptest(void)
|
|
||||||
{
|
|
||||||
buzzr_up();
|
|
||||||
for (int i=0; i<100; i++){
|
|
||||||
_delay_ms(2);
|
|
||||||
buzzr_inv();
|
|
||||||
};
|
|
||||||
buzzr_off();
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void flashleds(int leds)
|
|
||||||
{
|
|
||||||
led_off(LED_L|LED_R);
|
|
||||||
for (int i=0; i<10; i++){
|
|
||||||
led_on(leds);
|
|
||||||
_delay_ms(10);
|
|
||||||
led_off(LED_L|LED_R);
|
|
||||||
_delay_ms(90);
|
|
||||||
};
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
|
|
||||||
/* hardware initialisation: */
|
|
||||||
init_motor();
|
|
||||||
init_buzzr();
|
|
||||||
init_leds();
|
|
||||||
init_switch();
|
|
||||||
uint8_t mode = 0;
|
|
||||||
|
|
||||||
for(;;) /* ever */ {
|
|
||||||
//do something
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
switch(mode){
|
|
||||||
case 1:
|
|
||||||
mode_blinktest();
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
mode_motortest();
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
mode_beeptest();
|
|
||||||
break;
|
|
||||||
default: //mode=0;
|
|
||||||
blinkrattlebeep();
|
|
||||||
|
|
||||||
|
if(!(PINC & (1 << 5))) {
|
||||||
|
PORTB ^= 1 << 7;
|
||||||
|
} else {
|
||||||
|
PORTB &= ~(1 << 7);
|
||||||
}
|
}
|
||||||
|
|
||||||
//check switches and change mode
|
// lower buzzer
|
||||||
switch( PIND & 0b00000011){
|
|
||||||
case 0b00000010: //left switch pressed
|
|
||||||
mode--;
|
|
||||||
if (mode > 3) mode =3;
|
|
||||||
flashleds(LED_L);
|
|
||||||
break;
|
|
||||||
case 0b00000001: //right switch pressed
|
|
||||||
mode++;
|
|
||||||
if (mode > 3) mode = 0;
|
|
||||||
flashleds(LED_R);
|
|
||||||
break;
|
|
||||||
case 0b00000000: //both switches pressed
|
|
||||||
flashleds(LED_R|LED_L);
|
|
||||||
break;
|
|
||||||
|
|
||||||
|
vib_delay ^= 1;
|
||||||
|
|
||||||
|
if(!(PIND & (1 << 7))) {
|
||||||
|
if(vib_delay) {
|
||||||
|
PORTC ^= 1 << 0;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
PORTC &= ~(1 << 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// wait
|
||||||
|
|
||||||
|
_delay_ms(1);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* never return 0; */
|
/* never return 0; */
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue
Block a user