123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165 |
- #include <Ethernet.h>
- #include <EthernetUdp.h>
- #include <SPI.h>
- #include <OSCBundle.h>
- #include <OSCBoards.h>
- EthernetUDP Udp;
- IPAddress ip(128, 32, 122, 252);
- const unsigned int inPort = 8888;
- const unsigned int outPort = 9999;
- #if defined(__MK20DX128__)
- static byte mac[6];
- void read(uint8_t word, uint8_t *mac, uint8_t offset) {
- FTFL_FCCOB0 = 0x41;
- FTFL_FCCOB1 = word;
-
- FTFL_FSTAT = FTFL_FSTAT_CCIF;
- while(!(FTFL_FSTAT & FTFL_FSTAT_CCIF));
- *(mac+offset) = FTFL_FCCOB5;
- *(mac+offset+1) = FTFL_FCCOB6;
- *(mac+offset+2) = FTFL_FCCOB7;
- }
- void read_mac() {
- read(0xe,mac,0);
- read(0xf,mac,3);
- }
- #else
- void read_mac() {}
- byte mac[] = {
- 0xDE, 0xAD, 0xBE, 0xEF, 0xFE, 0xED };
- #endif
- OSCBundle bundleOUT;
- 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];
- }
- void routeAnalog(OSCMessage &msg, int addrOffset ){
- int pinMatched;
- pinMatched = msg.match("/0", addrOffset);
- if(pinMatched){
- if (msg.fullMatch("/u", pinMatched+addrOffset)) pinMode(analogInputToDigitalPin(0), INPUT_PULLUP);
-
- bundleOUT.add("/analog/0").add((int32_t)analogRead(0));
- }
- pinMatched = msg.match("/1", addrOffset);
- if(pinMatched){
- if (msg.fullMatch("/u", pinMatched+addrOffset)) pinMode(analogInputToDigitalPin(1), INPUT_PULLUP);
-
- bundleOUT.add("/analog/1").add((int32_t)analogRead(1));
- }
- pinMatched = msg.match("/2", addrOffset);
- if(pinMatched){
- if (msg.fullMatch("/u", pinMatched+addrOffset)) pinMode(analogInputToDigitalPin(2), INPUT_PULLUP);
-
- bundleOUT.add("/analog/2").add((int32_t)analogRead(2));
- }
- pinMatched = msg.match("/3", addrOffset);
- if(pinMatched){
- if (msg.fullMatch("/u", pinMatched+addrOffset)) pinMode(analogInputToDigitalPin(3), INPUT_PULLUP);
-
- bundleOUT.add("/analog/3").add((int32_t)analogRead(3));
- }
- pinMatched = msg.match("/4", addrOffset);
- if(pinMatched){
- if (msg.fullMatch("/u", pinMatched+addrOffset)) pinMode(analogInputToDigitalPin(4), INPUT_PULLUP);
-
- bundleOUT.add("/analog/4").add((int32_t)analogRead(4));
- }
- pinMatched = msg.match("/5", addrOffset);
- if(pinMatched){
- if (msg.fullMatch("/u", pinMatched+addrOffset)) pinMode(analogInputToDigitalPin(5), INPUT_PULLUP);
-
- bundleOUT.add("/analog/5").add((int32_t)analogRead(5));
- }
- }
- void setup() {
-
- read_mac();
- Ethernet.begin(mac,ip);
- Udp.begin(inPort);
- }
- void loop(){
- OSCBundle bundleIN;
- int size;
-
- if( (size = Udp.parsePacket())>0)
- {
- while(size--)
- bundleIN.fill(Udp.read());
- if(!bundleIN.hasError())
- bundleIN.route("/analog", routeAnalog);
-
- Udp.beginPacket(Udp.remoteIP(), outPort);
- bundleOUT.send(Udp);
- Udp.endPacket();
- bundleOUT.empty();
- }
- }
|