88 lines
1.7 KiB
C
88 lines
1.7 KiB
C
|
/* Sensor routine */
|
||
|
|
|
||
|
|
#include "lib/sensors.h"
|
||
|
|
#include "dev/button-sensor.h"
|
||
|
|
|
||
|
|
#include <avr/interrupt.h>
|
||
|
|
#include <avr/io.h>
|
||
|
|
#include "led.h" // debug
|
||
|
|
|
||
|
|
const struct sensors_sensor button_sensor;
|
||
|
|
|
||
|
|
static struct timer debouncetimer;
|
||
|
|
static int status(int type);
|
||
|
|
static int enabled = 0;
|
||
|
|
struct sensors_sensor *sensors[1];
|
||
|
|
unsigned char sensors_flags[1];
|
||
|
|
|
||
|
|
#define BUTTON_BIT INTF4
|
||
|
|
#define BUTTON_CHECK_IRQ() (EIFR & BUTTON_BIT) ? 0 : 1
|
||
|
|
|
||
|
|
#define PRINTF(...) printf(__VA_ARGS__)
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
ISR(INT4_vect)
|
||
|
|
{
|
||
|
|
|
||
|
|
// leds_toggle(LEDS_RED);
|
||
|
|
|
||
|
|
if(BUTTON_CHECK_IRQ()) {
|
||
|
|
if(timer_expired(&debouncetimer)) {
|
||
|
|
led1_on();
|
||
|
|
timer_set(&debouncetimer, CLOCK_SECOND / 4);
|
||
|
|
sensors_changed(&button_sensor);
|
||
|
|
led1_off();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
|
||
|
|
static int
|
||
|
|
value(int type)
|
||
|
|
{
|
||
|
|
return (PINE & _BV(PE4) ? 0 : 1) || !timer_expired(&debouncetimer);
|
||
|
|
|
||
|
|
//return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int
|
||
|
|
configure(int type, int c)
|
||
|
|
{
|
||
|
|
switch (type) {
|
||
|
|
case SENSORS_ACTIVE:
|
||
|
|
if (c) {
|
||
|
|
if(!status(SENSORS_ACTIVE)) {
|
||
|
|
led1_on();
|
||
|
|
timer_set(&debouncetimer, 0);
|
||
|
|
DDRE |= (0<<DDRE4); // Set pin as input
|
||
|
|
PORTE |= (1<<PORTE4); // Set port PORTE bint 5 with pullup resistor
|
||
|
|
EICRB |= (1<<ISC40); // For falling edge
|
||
|
|
EIMSK |= (1<<INT4); // Set int
|
||
|
|
enabled = 1;
|
||
|
|
sei();
|
||
|
|
led1_off();
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
enabled = 0;
|
||
|
|
EIMSK &= ~(1<<INT4); // clear int
|
||
|
|
}
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int
|
||
|
|
status(int type)
|
||
|
|
{
|
||
|
|
switch (type) {
|
||
|
|
case SENSORS_ACTIVE:
|
||
|
|
case SENSORS_READY:
|
||
|
|
return enabled;//(EIMSK & (1<<INT5) ? 0 : 1);//BUTTON_IRQ_ENABLED();
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
SENSORS_SENSOR(button_sensor, BUTTON_SENSOR,
|
||
|
|
value, configure, status);
|
||
|
|
|