/* Sensor routine */

#include "lib/sensors.h"
#include "dev/button-sensor.h"

#include <avr/interrupt.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 INTF5
#define BUTTON_CHECK_IRQ() (EIFR & BUTTON_BIT) ? 0 : 1

#define PRINTF(...) printf(__VA_ARGS__)
/*---------------------------------------------------------------------------*/
ISR(INT5_vect)
{

//  leds_toggle(LEDS_YELLOW);
  
  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 (PORTE & _BV(PE5) ? 0 : 1) || !timer_expired(&debouncetimer);
 //return 0;
}

static int
configure(int type, int c)
{
 PRINTF("Sensor Button Configure called: %d, %d\n",type,c);
	switch (type) {
	case SENSORS_ACTIVE:
		if (c) {
			if(!status(SENSORS_ACTIVE)) {
    led1_on();
				timer_set(&debouncetimer, 0);
				PRINTF("Setup sensor started\n");
				DDRE |= (0<<DDE5); // Set pin as input
				PORTE |= (1<<PORTE5); // Set port PORTE bint 5 with pullup resistor
				EICRB |= (2<<ISC50); // For falling edge
				EIMSK |= (1<<INT5); // Set int
				enabled = 1;
				sei();
    led1_off();
			}
			PRINTF("Sensor EIMSK set\n");
		} else {
				enabled = 0;
				EIMSK &= ~(1<<INT5); // clear int
				PRINTF("Setup sensor failed\n");
		}
		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);