bombatuino-pro/bombatuino_INPUT_74HC4051/bombatuino_INPUT_74HC4051.cpp

82 lines
1.8 KiB
C++
Raw Permalink Normal View History

2020-10-25 19:05:01 +01:00
#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;
}