/*****************************************************************************
*
* checkWiFiConnected
*
* \param None
*
* \return TRUE if connected, FALSE if not
*
* \brief Checks to see that WiFi is still connected
*
*****************************************************************************/
unsigned char
checkWiFiConnected(int reinit)
{
unsigned char status = AtLibGs_IsNodeAssociated();
if (!status)
{
if (reinit)
{
WIFI_init(1);
}
WIFI_Associate();
status = AtLibGs_IsNodeAssociated();
}
RSSIReading();
return status;
}
void App_WhiskerGW()
{
char pubTopic[100];
char pubMsg[250];
unsigned char msgType;
int counter=0;
char cntStr[20];
char commandBuffer[64];
int commandBufferPointer=0;
led_all_off();
// Give the unit a little time to start up
// (300 ms for GS1011 and 1000 ms for GS1500)
MSTimerDelay(1000);
NVSettingsLoad(&GNV_Setting);
led_on(4);
WIFI_init(1); // Show MAC address and Version
led_on(5);
WIFI_Associate();
led_on(6);
DisplayLCD(LCD_LINE8, "Demo starting.");
DisplayLCD(LCD_LINE3, (const uint8_t *)WifiMAC);
// UART
if(spiUartInitialize()!=0)
{
DisplayLCD(LCD_LINE7, "!! SPIUART_ERROR !!");
while(1)
{
led_all_on();
MSTimerDelay(250);
led_all_off();
MSTimerDelay(250);
}
}
while (1)
{
// Do we need to connect to the AP?
if (!AtLibGs_IsNodeAssociated())
{
led_off(6);
WIFI_Associate();
led_on(6);
}
else
{
if(mqttConnected==0)
App_ConnectMqtt();
int charCount = spiUartRxBytesAvailable();
while(charCount>0)
{
commandBuffer[commandBufferPointer++] = spiUartGetByte();
charCount--;
if(charCount==0)
commandBufferPointer=0;
if(commandBufferPointer>4)
{
if(strstr(commandBuffer,"RMPU")==commandBuffer)
{
if(commandBufferPointer>24)
{
// process response
char macStr[9];
char lenStr[5];
memcpy(macStr,&commandBuffer[6],8);
macStr[8] = 0;
memcpy(lenStr,&commandBuffer[4],2);
lenStr[2]=0;
int len = (int)strtol(lenStr,0,16);
unsigned long mac = strtoul(macStr,NULL,16);
WhiskerModule *wm = findModule(mac);
if(wm!=0)
{
if(commandBufferPointer>len+16)
{
char rssiStr[3];
memcpy(rssiStr,&commandBuffer[commandBufferPointer-3],2);
rssiStr[2]=0;
int rssi = (int)strtol(rssiStr,0,16);
if((rssi & 0x80) == 0x80)
rssi-=256;
int puMsgPointer=14;
mqtt_initJsonMsg(pubMsg);
mqtt_addStringValToMsg("Name",wm->Name,pubMsg,0);
mqtt_addStringValToMsg("Mac",macStr,pubMsg,1);
char rstr[8];
sprintf(rstr,"%d dbm",rssi);
mqtt_addStringValToMsg("Rssi",rstr,pubMsg,1);
sprintf(pubMsg+strlen(pubMsg),",\"Values\":{");
puMsgPointer=14;
int comma=0;
while(puMsgPointer < (commandBufferPointer-3))
{
char cidStr[3];
memcpy(cidStr,&commandBuffer[puMsgPointer],2);
puMsgPointer+=2;
cidStr[2]=0;
unsigned char cid=(unsigned char)strtol(cidStr,0,16);
unsigned char channel = cid & 0x1f;
char valStr[9];
long valInt;
switch(cid)
{
case 0x21:
//digital input
memcpy(valStr,&commandBuffer[puMsgPointer],2);
valStr[2]=0;
puMsgPointer+=2;
valInt = (int)strtol(valStr,0,16);
if(valInt)
mqtt_addStringValToMsg("DIN1","True",pubMsg,comma);
else
mqtt_addStringValToMsg("DIN1","False",pubMsg,comma);
break;
case 0x22:
//digital input
memcpy(valStr,&commandBuffer[puMsgPointer],2);
valStr[2]=0;
puMsgPointer+=2;
valInt = (int)strtol(valStr,0,16);
if(valInt)
mqtt_addStringValToMsg("DIN2","True",pubMsg,comma);
else
mqtt_addStringValToMsg("DIN2","False",pubMsg,comma);
break;
case 0x43:
//battery analog in
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("Battery",valInt,pubMsg,comma);
break;
case 0x44:
//battery analog in
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("Temperature",valInt,pubMsg,comma);
break;
case 0x45:
//battery analog in
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("RH",valInt,pubMsg,comma);
break;
case 0x5d:
//internal temperature
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("IntTemp",valInt,pubMsg,comma);
break;
case 0x57:
//air quality
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("AirQual",valInt,pubMsg,comma);
break;
case 0x58:
//air quality
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("AirQual",valInt,pubMsg,comma);
break;
case 0x61:
// digital counter input
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("Count1",valInt,pubMsg,comma);
break;
case 0x62:
// digital counter input
memcpy(valStr,&commandBuffer[puMsgPointer],4);
valStr[4]=0;
puMsgPointer+=4;
valInt = (int)strtol(valStr,0,16);
mqtt_addIntValToMsg("Count2",valInt,pubMsg,comma);
break;
}
comma=1;
}
sprintf(pubMsg+strlen(pubMsg),"}");
mqtt_finishJsonMsg(pubMsg);
sprintf(pubTopic, "%s/%s", WIO_DOMAIN, macStr);
int res=mqtt_publish(&broker, pubTopic, pubMsg,0)<0;
if(res<0)
mqttConnected=0;
led_on(8);
//spiUartResetFIFO();
}
}
}
}
}
}
// Send data if
RSSIReading();
AtLibGs_WaitForTCPMessage(1000);
led_off(7);
led_off(8);
if(G_receivedCount>0)
{
AtLibGs_ParseTCPData(G_received,G_receivedCount,&rxm);
msgType = MQTTParseMessageType(rxm.message);
switch(msgType)
{
case MQTT_MSG_SUBACK:
// todo: display subscription acknowledgement
break;
case MQTT_MSG_PUBLISH:
App_MQTTMsgPublished();
break;
case MQTT_MSG_PUBACK:
// todo: display publish acknowledgement
break;
default:
break;
}
}
counter++;
sprintf(cntStr,"Counter=%d",counter);
DisplayLCD(LCD_LINE6,cntStr);
if(counter>30)
{
counter=0;
sprintf(pubTopic, "%s/%s", WIO_DOMAIN, WifiMAC);
mqtt_initJsonMsg(pubMsg);
mqtt_addStringValToMsg("msg","status ok",pubMsg,0);
mqtt_finishJsonMsg(pubMsg);
int res1=mqtt_publish(&broker, pubTopic, pubMsg,0)<0;
if(res1<0)
mqttConnected=0;
led_on(7);
}
}
// Send data if END
}
}
