#include "Arduino.h"
#include "bombatuino_INPUT_74HC4051.h"

//should be called in setup()
void INPUT_74HC4051::begin(uint8_t analog, uint8_t s0, uint8_t s1, uint8_t s2,CallbackFunction cbF) {
	
	//analog pin which output Z is connected to
	_analog = analog;
	
	//3 digital pins where S0,S1,S2 are connected to
	_s0 = s0;
	_s1 = s1;
	_s2 = s2;
	
	
	pinMode(_analog,INPUT);
	
	pinMode(_s0,OUTPUT);
	pinMode(_s1,OUTPUT);
	pinMode(_s2,OUTPUT);
	
	_callbackFunction = cbF;
	
	//initalize start values
	uint8_t pin,r0,r1,r2;
	//run through the 8 I/O pins
	for (pin=0; pin<8; pin++) {
		r0 = bitRead(pin,0);     
		r1 = bitRead(pin,1);
		r2 = bitRead(pin,2);   
		digitalWrite(_s0, r0);
		digitalWrite(_s1, r1);
		digitalWrite(_s2, r2);
		//delayMicroseconds(10);
		_value[pin] = analogRead(_analog);
	}  	
}

void INPUT_74HC4051::setPins(uint8_t pins) {
		_pins = pins;
}

//should be called in loop(), read values and call callback function on change
void INPUT_74HC4051::loop() {
	uint8_t pin,r0,r1,r2;
	int value;
	for (pin=0; pin<8; pin++) {
		if (_pins & (1<<pin)) {
			r0 = bitRead(pin,0);     
			r1 = bitRead(pin,1);
			r2 = bitRead(pin,2);   
			digitalWrite(_s0, r0);
			digitalWrite(_s1, r1);
			digitalWrite(_s2, r2);
			//divide by 8 to get value beetween 0-127 for MIDI
			value = analogRead(_analog) / 8;
			if (_value[pin] < value || _value[pin] > value) {
				_value[pin] = value;
				(*_callbackFunction)(_analog,pin,value);
			}
		}
	}  	
}

//maybe useful later
int INPUT_74HC4051::getSpecificValue(uint8_t pin) {
	if (pin >= 8 || !(_pins & (1<<pin)))
		return -1;
	uint8_t r0,r1,r2;
	r0 = bitRead(pin,0);     
	r1 = bitRead(pin,1);
	r2 = bitRead(pin,2);   
	digitalWrite(_s0, r0);
	digitalWrite(_s1, r1);
	digitalWrite(_s2, r2);
	//delayMicroseconds(10);
	int value = analogRead(_analog) / 8;
	_value[pin] = value;
	return value;
}