#include #include #include "Adafruit_FreeTouch.h" #include Adafruit_FreeTouch qt_0 = Adafruit_FreeTouch(A0, OVERSAMPLE_4, RESISTOR_50K, FREQ_MODE_NONE); Adafruit_FreeTouch qt_1 = Adafruit_FreeTouch(A1, OVERSAMPLE_4, RESISTOR_50K, FREQ_MODE_NONE); Adafruit_FreeTouch qt_2 = Adafruit_FreeTouch(A2, OVERSAMPLE_4, RESISTOR_50K, FREQ_MODE_NONE); Adafruit_FreeTouch *p[3] = { &qt_0, &qt_1, &qt_2 }; #undef NUM_DIGITAL_PINS #define NUM_DIGITAL_PINS 3 #undef NUM_ANALOG_PINS #define NUM_ANALOG_PINS 3 SLIPEncodedUSBSerial SLIPSerial( Serial ); //outgoing messages OSCBundle bundleOUT; //converts the pin to an osc address char * numToOSCAddress( int pin){ static char s[10]; int i = 9; s[i--]= '\0'; do { s[i] = "0123456789"[pin % 10]; --i; pin /= 10; } while(pin && i); s[i] = '/'; return &s[i]; } /** * ROUTES * * these are where the routing functions go * */ /** * DIGITAL * * called when address matched "/d" * expected format: * /d/(pin) * /u = digitalRead with pullup * (no value) = digitalRead without pullup * (value) = digital write on that pin * */ void routeDigital(OSCMessage &msg, int addrOffset ){ //match input or output for(byte pin = 0; pin < NUM_DIGITAL_PINS; pin++){ //match against the pin number strings int pinMatched = msg.match(numToOSCAddress(pin), addrOffset); if(pinMatched){ //if it has an int, then it's a digital write if (msg.isInt(0)){ pinMode(pin, OUTPUT); digitalWrite(pin, (msg.getInt(0)>0) ? HIGH:LOW); } else if(msg.isFloat(0)){ analogWrite(pin, (int)(msg.getFloat(0)*255.0f)); } //otherwise it's an digital read //with a pullup? else if (msg.fullMatch("/u", pinMatched+addrOffset)){ //set the pullup pinMode(pin, INPUT_PULLUP); //setup the output address which should be /d/(pin)/u char outputAddress[9]; strcpy(outputAddress, "/d"); strcat(outputAddress, numToOSCAddress(pin)); strcat(outputAddress,"/u"); //do the digital read and send the results bundleOUT.add(outputAddress).add(digitalRead(pin)); } //else without a pullup else { //set the pinmode pinMode(pin, INPUT); //setup the output address which should be /d/(pin) char outputAddress[6]; strcpy(outputAddress, "/d"); strcat(outputAddress, numToOSCAddress(pin)); //do the digital read and send the results bundleOUT.add(outputAddress).add(digitalRead(pin)); } } } } /** * ANALOG * * called when the address matches "/a" * * format: * /a/(pin) * /u = analogRead with pullup * (no value) = analogRead without pullup * (digital value) = digital write on that pin * (float value) = analogWrite on that pin * **/ void routeAnalog(OSCMessage &msg, int addrOffset ){ //iterate through all the analog pins for(byte pin = 0; pin < NUM_ANALOG_INPUTS; pin++){ //match against the pin number strings int pinMatched = msg.match(numToOSCAddress(pin), addrOffset); if(pinMatched){ //if it has an int, then it's a digital write if (msg.isInt(0)){ pinMode(analogInputToDigitalPin(pin), OUTPUT); digitalWrite(analogInputToDigitalPin(pin), (msg.getInt(0) > 0)? HIGH: LOW); } else if(msg.isFloat(0)){ analogWrite(pin, (int)(msg.getFloat(0)*255.0f)); } #ifdef BOARD_HAS_ANALOG_PULLUP //with a pullup? else if (msg.fullMatch("/u", pinMatched+addrOffset)){ //set the pullup pinMode(analogInputToDigitalPin(pin), INPUT_PULLUP); //setup the output address which should be /a/(pin)/u char outputAddress[9]; strcpy(outputAddress, "/a"); strcat(outputAddress, numToOSCAddress(pin)); strcat(outputAddress,"/u"); //do the analog read and send the results bundleOUT.add(outputAddress).add((int32_t)analogRead(pin)); } //else without a pullup #endif else { //otherwise it's an analog read //set the pinmode pinMode(analogInputToDigitalPin(pin), INPUT); //setup the output address which should be /a/(pin) char outputAddress[6]; strcpy(outputAddress, "/a"); strcat(outputAddress, numToOSCAddress(pin)); //do the analog read and send the results bundleOUT.add(outputAddress).add((int32_t)analogRead(pin)); } } } } #if 1 /** * TONE * * square wave output "/tone" * * format: * /tone/pin * * (digital value) (float value) = frequency in Hz * (no value) disable tone * **/ void routeTone(OSCMessage &msg, int addrOffset ){ //iterate through all the analog pins for(byte pin = 0; pin < NUM_DIGITAL_PINS; pin++){ //match against the pin number strings int pinMatched = msg.match(numToOSCAddress(pin), addrOffset); if(pinMatched){ unsigned int frequency = 0; //if it has an int, then it's an integers frequency in Hz if (msg.isInt(0)){ frequency = msg.getInt(0); } //otherwise it's a floating point frequency in Hz else if(msg.isFloat(0)){ frequency = msg.getFloat(0); } else noTone(pin); if(frequency>0) { if(msg.isInt(1)) tone(pin, frequency, msg.getInt(1)); else tone(pin, frequency); } } } } #endif void routeTouch(OSCMessage &msg, int addrOffset ) { for(int i=0;i<3;++i) { const char *name = numToOSCAddress(i); int pinMatched = msg.match(name, addrOffset); if(pinMatched && p[i]) { char outputAddress[9]; strcpy(outputAddress, "/c"); strcat(outputAddress, name); bundleOUT.add(outputAddress).add(p[i]->measure()); } } } /** * SYSTEM MESSAGES * * expected format: * /s * /m = microseconds * /d = number of digital pins * /a = number of analog pins * /l integer = set the led * /t = temperature * /s = power supply voltage */ // void routeSystem(OSCMessage &msg, int addrOffset ){ if (msg.fullMatch("/m", addrOffset)){ bundleOUT.add("/s/m").add((int32_t)micros()); } if (msg.fullMatch("/d", addrOffset)){ bundleOUT.add("/s/d").add(NUM_DIGITAL_PINS); } if (msg.fullMatch("/a", addrOffset)){ bundleOUT.add("/s/a").add(NUM_ANALOG_INPUTS); } if (msg.fullMatch("/l", addrOffset)){ if (msg.isInt(0)){ pinMode(LED_BUILTIN, OUTPUT); int i = msg.getInt(0); pinMode(LED_BUILTIN, OUTPUT); digitalWrite(LED_BUILTIN, (i > 0)? HIGH: LOW); bundleOUT.add("/s/l").add(i); } } } /** * MAIN METHODS * * setup and loop, bundle receiving/sending, initial routing */ void setup() { SLIPSerial.begin(115200); // set this as high as you can reliably run on your platform for(int i=0; i<3; ++i) if(!p[i]->begin()) p[i] =0; } //reads and routes the incoming messages void loop(){ OSCBundle bundleIN; int size; while(!SLIPSerial.endofPacket()) if ((size =SLIPSerial.available()) > 0) { while(size--) bundleIN.fill(SLIPSerial.read()); } if(!bundleIN.hasError()) { bundleIN.route("/s", routeSystem); bundleIN.route("/a", routeAnalog); bundleIN.route("/d", routeDigital); bundleIN.route("/tone", routeTone); bundleIN.route("/c", routeTouch); } bundleIN.empty(); //send the outgoing message SLIPSerial.beginPacket(); bundleOUT.send(SLIPSerial); SLIPSerial.endPacket(); bundleOUT.empty(); }