void sendHeader(int cid) {
ubyte linebuff[20];
int index = 0;
string tmpString;
linebuff[0] = 27; // escape;
linebuff[1] = 'S'; // the CID;
linebuff[2] = (ubyte)cid + 48; // the CID;
index = RS485appendToBuff(RS485txbuffer, index, linebuff, 3);
tmpString = "HTTP/1.1 200 OK";
//memcpy(linebuff, tmpString, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, tmpString, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, linefeed, sizeof(linefeed));
tmpString = "Content-Type:";
memcpy(linebuff, tmpString, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, linebuff, strlen(tmpString));
tmpString = " text/plain";
memcpy(linebuff, tmpString, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, linebuff, strlen(tmpString));
index = RS485appendToBuff(RS485txbuffer, index, linefeed, sizeof(newline));
index = RS485appendToBuff(RS485txbuffer, index, linefeed, sizeof(newline));
linebuff[0] = 27; // escape;
linebuff[1] = 'E'; // the CID;
index = RS485appendToBuff(RS485txbuffer, index, endmarker, 2);
RS485write(RS485txbuffer, index);
}
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 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();
}
task main ()
{
int index;
// port to use for the socket
int BOFHport = 6666;
string dataString;
// get our bluetooth name
getFriendlyName(dataString);
int avail = 0;
nNxtButtonTask = -2;
StartTask(updateScreen);
// initialise the port, etc
RS485initLib();
memset(RS485rxbuffer, 0, sizeof(RS485rxbuffer));
memset(RS485txbuffer, 0, sizeof(RS485txbuffer));
N2WchillOut();
// Disconnect if already connected
N2WDisconnect();
N2WchillOut();
// if a custom profile exists, use that instead
if (N2WCustomExist())
{
N2WLoad();
}
else
{
// enable DHCP
N2WsetDHCP(true);
wait1Msec(100);
// Disable adhoc
N2WsetAdHoc(false);
wait1Msec(100);
// SSID to connect to
N2WsetSSID("YOURWIFINETWORK");
wait1Msec(100);
// The passphrase to use
N2WSecurityWPA2Passphrase("YOURWIFIPASSPHRASE");
wait1Msec(100);
// Save this profile to the custom profile
N2WSave();
wait1Msec(100);
// Load the custom profile
N2WLoad();
}
wait1Msec(100);
N2WConnect(true);
connStatus = "connecting";
while (!N2WConnected())
wait1Msec(1000);
connStatus = "connected";
PlaySound(soundBeepBeep);
wait1Msec(3000);
N2WgetIP(IPaddress);
wait1Msec(1000);
// Open a listening socket on port 6666
if (!N2WTCPOpenServer(1, BOFHport))
{
writeDebugStreamLine("Err open port %d", BOFHport);
PlaySound(soundException);
while(bSoundActive) EndTimeSlice();
StopAllTasks();
}
while (true)
{
// Check if anyone has sent us anything
avail = N2WTCPAvail(1);
if (avail > 0)
{
rxbytes += avail;
N2WchillOut();
PlaySound(soundFastUpwardTones);
// Read what the client sent us
sprintf(dataStrings[0], "%d bytes from", avail);
N2WTCPRead(1, avail);
N2WchillOut();
// Get the MAC address of the client
dataStrings[2] = "Remote MAC:";
N2WTCPClientMAC(1, dataStrings[3]);
writeDebugStream("MAC: ");
writeDebugStreamLine(dataStrings[3]);
N2WchillOut();
// check the IP address of the client
N2WTCPClientIP(1, dataStrings[1]);
N2WchillOut();
// Send back a hearty "Hi there, <IP>!"
index = 0;
returnMsg = "Hi there, ";
index = RS485appendToBuff(buffer, index, returnMsg);
index = RS485appendToBuff(buffer, index, dataStrings[1]);
returnMsg = "\n";
index = RS485appendToBuff(buffer, index, returnMsg);
txbytes += index;
N2WTCPWrite(1, (tHugeByteArray)buffer, index);
N2WchillOut();
// Terminate the connection to the client
N2WTCPDetachClient(1);
N2WchillOut();
}
// Wait a bit
wait1Msec(50);
}
}
task main ()
{
int index;
// port to use for the socket
int BOFHport = 6666;
string dataString;
// get our bluetooth name
getFriendlyName(dataString);
int avail = 0;
StartTask(updateScreen);
// initialise the port, etc
RS485initLib();
N2WchillOut();
N2WsetDebug(true);
N2WchillOut();
// Disconnect if already connected
N2WDisconnect();
wait1Msec(100);
if (!N2WCustomExist())
{
StopTask(updateScreen);
wait1Msec(50);
eraseDisplay();
PlaySound(soundException);
nxtDisplayCenteredBigTextLine(1, "ERROR");
nxtDisplayTextLine(3, "No custom profile");
nxtDisplayTextLine(4, "configured!!");
while(true) EndTimeSlice();
}
N2WLoad();
wait1Msec(100);
N2WConnect(true);
connStatus = "connecting";
while (!N2WConnected())
wait1Msec(1000);
connStatus = "connected";
PlaySound(soundBeepBeep);
wait1Msec(3000);
N2WgetIP(IPaddress);
memcpy(dataStrings[4], IPaddress, strlen(IPaddress) + 1);
wait1Msec(1000);
N2WTCPClose(0);
N2WchillOut();
RS485clearRead();
N2WchillOut();
// Open a listening socket on port 6666
if (!N2WTCPOpenServer(1, BOFHport))
{
writeDebugStreamLine("Err open port %d", BOFHport);
PlaySound(soundException);
while(bSoundActive) EndTimeSlice();
StopAllTasks();
}
while (true)
{
// Check if anyone has sent us anything
avail = N2WTCPAvail(1);
if (avail > 0)
{
rxbytes += avail;
N2WchillOut();
PlaySound(soundFastUpwardTones);
// Read what the client sent us
sprintf(dataStrings[0], "%d bytes from", avail);
N2WTCPRead(1, avail);
N2WchillOut();
// Get the MAC address of the client
dataStrings[2] = "Remote MAC:";
N2WTCPClientMAC(1, dataStrings[3]);
writeDebugStream("MAC: ");
writeDebugStreamLine(dataStrings[3]);
N2WchillOut();
// check the IP address of the client
N2WTCPClientIP(1, dataStrings[1]);
N2WchillOut();
// Send back a hearty "Hi there, <IP>!"
index = 0;
returnMsg = "Hi there, ";
index = RS485appendToBuff(buffer, index, returnMsg);
index = RS485appendToBuff(buffer, index, dataStrings[1]);
returnMsg = "\n";
index = RS485appendToBuff(buffer, index, returnMsg);
txbytes += index;
N2WTCPWrite(1, (tHugeByteArray)buffer, index);
N2WchillOut();
// Terminate the connection to the client
N2WTCPDetachClient(1);
N2WchillOut();
wait1Msec(1000);
}
// Wait a bit
wait1Msec(50);
}
}
