task main()
{
char *ssid = "YOURSSID";
char *wpa_psk = "YOURPASSWORD";
writeDebugStreamLine("ssid: %s", ssid);
writeDebugStreamLine("psk: %s", wpa_psk);
short len;
eraseDisplay();
bNxtLCDStatusDisplay = true; // Enable top status line display
writeDebugStream("Scanning for wifi sensor: ");
// You can play with these to see if they work for you.
// I tend to use the 460800 rate as it's the fastest speed
// that I can use reliably.
//DWIFIsetBAUDRate(9600);
DWIFIsetBAUDRate(230400);
DWIFIresetConfig();
playSound(soundBlip);
while(nNxtButtonPressed != kEnterButton) sleep(1);
DWIFIsetBAUDRate(230400);
configureWiFi((char *)ssid, (char *)wpa_psk);
// set_verbose(false);
// Receive();
sleep(100);
while(true)
{
RS485read(RS485rxbuffer, len, 100);
}
playSound(soundBeepBeep);
}
void parseInput()
{
tMassiveArray tmp_array;
//char *b_marker = &beginmarker;
//char *e_marker = &endmarker;
short len;
short bpos;
short epos;
bool parsed = true;
writeDebugStreamLine("Beging parsing...");
//ubyte currByte[] = {0};
//ubyte prevByte[] = {0};
ubyte conn[] = {0};
//short cid;
//string tmpString;
short index = 0;
memset(&tmp_array[0], 0, sizeof(tMassiveArray));
while (true)
{
RS485read(RS485rxbuffer, len, 100);
if (len > 0)
{
writeDebugStreamLine("Appending to buffer: %d", len);
parsed = false;
if (index == 0)
memset(&tmp_array[0], 0, sizeof(tMassiveArray));
index = RS485appendToBuff(tmp_array, index, &RS485rxbuffer[0], len);
}
else if ((parsed == false) && (len == 0))
{
writeDebugStreamLine("Parsing buffer: %s", &tmp_array[0]);
bpos = stringFind((char *)&tmp_array[0], &beginmarker[0]);
epos = stringFind((char *)&tmp_array[0], &endmarker[0]);
// we've found a start and end marker
if (bpos > -1)
writeDebugStreamLine("begin marker found: %d", bpos);
if (epos > -1)
writeDebugStreamLine("end marker found: %d", epos);
if (bpos > -1 && epos > -1)
{
writeDebugStreamLine("bpos: %d, epos: %d", bpos, epos);
}
else
{
writeDebugStreamLine("no markers found");
}
parsed = true;
index = 0;
sleep(2000);
playSound(soundBeepBeep);
}
}
}
void configureWiFi(char *_ssid, char *_key)
{
short len;
RS485clearRead(); // Clear out the buffer and test TX/RX.
sleep(1000); // Must be run first!
DWIFIsetEcho(false); // Must be run first!
sleep(1000); // Must be run first!
RS485clearRead();
eraseDisplay();
DWIFIsetSWControl(); // Must be run first!
RS485clearRead();
DWIFIsetVerbose(false);
sleep(100);
RS485clearRead();
RS485read(RS485rxbuffer, len);
DWIFIsetSSID(_ssid);
DWIFIsetDHCP(true);
DWIFIsetWPAPSK(_ssid, _key);
sleep(20000);
DWIFIsaveConfig();
}
void genResponse(int cid) {
int power = motor[motorA];
float temp = 0.0;
string tmpString;
int index = 0;
ubyte linebuff[20];
StringFromChars(tmpString, rxbuffer);
index = StringFind(tmpString, "/");
StringDelete(tmpString, 0, index);
index = StringFind(tmpString, "HTTP");
StringDelete(tmpString, index, strlen(tmpString));
writeDebugStreamLine("Request:%s", tmpString);
nxtDisplayTextLine(2, "Request: ");
nxtDisplayTextLine(3, tmpString);
if (StringFind(tmpString, "MOTA") > 0) {
StringDelete(tmpString, 0, 6);
index = StringFind(tmpString, " ");
if (index > -1)
StringDelete(tmpString, index, strlen(tmpString));
//power = RC_atoix(tmpString);
power = clip(atoi(tmpString), -100, 100);
writeDebugStreamLine("Power:%d", power);
} else {
writeDebugStreamLine("NO POWER: %s", tmpString);
}
sendHeader(cid);
while(nxtHS_Status == HS_SENDING) wait1Msec(5);
wait1Msec(100);
index = 0;
linebuff[0] = 27; // escape;
linebuff[1] = 'S'; // the CID;
linebuff[2] = (ubyte)cid + 48; // the CID;
index = RS485appendToBuff(RS485txbuffer, index, linebuff, 3);
StringFormat(tmpString, "MotorA=%d\n", power);
memcpy(linebuff, tmpString, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, linebuff, strlen(tmpString));
DTMPreadTemp(DTMP, temp);
StringFormat(tmpString, "Temp: %2.2f C", temp);
memcpy(linebuff, tmpString, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, linebuff, strlen(tmpString));
linebuff[0] = 27; // escape;
linebuff[1] = 'E'; // the CID;
index = RS485appendToBuff(RS485txbuffer, index, endmarker, 2);
RS485write(RS485txbuffer, index);
if (power != 0) nMotorEncoderTarget[motorA] = 2000;
motor[motorA] = power;
if (power > 0)
SensorType[COLOUR] = sensorCOLORGREEN;
else if (power < 0)
SensorType[COLOUR] = sensorCOLORBLUE;
else if (nMotorRunState[motorA] == runStateIdle)
SensorType[COLOUR] = sensorCOLORRED;
else
SensorType[COLOUR] = sensorCOLORRED;
wait1Msec(300);
RS485clearRead();
closeConn(1);
memset(RS485rxbuffer, 0, sizeof(RS485rxbuffer));
//wait1Msec(100);
RS485read(RS485rxbuffer, sizeof(RS485rxbuffer));
//clear_read_buffer();
}