87 lines
2.0 KiB
C++
87 lines
2.0 KiB
C++
|
#include "UpnpBroadcastResponder.h"
|
||
|
|
#include "Switch.h"
|
||
|
|
#include <functional>
|
||
|
|
|
||
|
|
// Multicast declarations
|
||
|
|
IPAddress ipMulti(239, 255, 255, 250);
|
||
|
|
const unsigned int portMulti = 1900;
|
||
|
|
char packetBuffer[512];
|
||
|
|
|
||
|
|
#define MAX_SWITCHES 14
|
||
|
|
Switch switches[MAX_SWITCHES] = {};
|
||
|
|
int numOfSwitchs = 0;
|
||
|
|
|
||
|
|
//#define numOfSwitchs (sizeof(switches)/sizeof(Switch)) //array size
|
||
|
|
|
||
|
|
//<<constructor>>
|
||
|
|
UpnpBroadcastResponder::UpnpBroadcastResponder(){
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
//<<destructor>>
|
||
|
|
UpnpBroadcastResponder::~UpnpBroadcastResponder(){/*nothing to destruct*/}
|
||
|
|
|
||
|
|
bool UpnpBroadcastResponder::beginUdpMulticast(){
|
||
|
|
boolean state = false;
|
||
|
|
|
||
|
|
Serial.println("Begin multicast ..");
|
||
|
|
|
||
|
|
if(UDP.beginMulticast(WiFi.localIP(), ipMulti, portMulti)) {
|
||
|
|
Serial.print("Udp multicast server started at ");
|
||
|
|
Serial.print(ipMulti);
|
||
|
|
Serial.print(":");
|
||
|
|
Serial.println(portMulti);
|
||
|
|
|
||
|
|
state = true;
|
||
|
|
}
|
||
|
|
else{
|
||
|
|
Serial.println("Connection failed");
|
||
|
|
}
|
||
|
|
|
||
|
|
return state;
|
||
|
|
}
|
||
|
|
|
||
|
|
//Switch *ptrArray;
|
||
|
|
|
||
|
|
void UpnpBroadcastResponder::addDevice(Switch& device) {
|
||
|
|
Serial.print("Adding switch : ");
|
||
|
|
Serial.print(device.getAlexaInvokeName());
|
||
|
|
Serial.print(" index : ");
|
||
|
|
Serial.println(numOfSwitchs);
|
||
|
|
|
||
|
|
switches[numOfSwitchs] = device;
|
||
|
|
numOfSwitchs++;
|
||
|
|
}
|
||
|
|
|
||
|
|
void UpnpBroadcastResponder::serverLoop(){
|
||
|
|
int packetSize = UDP.parsePacket();
|
||
|
|
if (packetSize <= 0)
|
||
|
|
return;
|
||
|
|
|
||
|
|
IPAddress senderIP = UDP.remoteIP();
|
||
|
|
unsigned int senderPort = UDP.remotePort();
|
||
|
|
|
||
|
|
// read the packet into the buffer
|
||
|
|
UDP.read(packetBuffer, packetSize);
|
||
|
|
|
||
|
|
// check if this is a M-SEARCH for WeMo device
|
||
|
|
String request = String((char *)packetBuffer);
|
||
|
|
|
||
|
|
if(request.indexOf('M-SEARCH') > 0) {
|
||
|
|
if(request.indexOf("urn:Belkin:device:**") > 0) {
|
||
|
|
Serial.println("Got UDP Belkin Request..");
|
||
|
|
|
||
|
|
// int arrSize = sizeof(switchs) / sizeof(Switch);
|
||
|
|
|
||
|
|
for(int n = 0; n < numOfSwitchs; n++) {
|
||
|
|
Switch &sw = switches[n];
|
||
|
|
|
||
|
|
if (&sw != NULL) {
|
||
|
|
sw.respondToSearch(senderIP, senderPort);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|