Move snprintf to work with any architecture.
This commit is contained in:
@@ -52,10 +52,10 @@ SFE_UBLOX_GNSS myGNSS;
|
|||||||
|
|
||||||
//Global variables
|
//Global variables
|
||||||
//=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
|
//=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
|
||||||
long lastReceivedRTCM_ms = 0; //5 RTCM messages take approximately ~300ms to arrive at 115200bps
|
long lastReceivedRTCM_ms = 0; //5 RTCM messages take approximately ~300ms to arrive at 115200bps
|
||||||
int maxTimeBeforeHangup_ms = 10000; //If we fail to get a complete RTCM frame after 10s, then disconnect from caster
|
int maxTimeBeforeHangup_ms = 10000; //If we fail to get a complete RTCM frame after 10s, then disconnect from caster
|
||||||
|
|
||||||
bool transmitLocation = true; //By default we will transmit the units location via GGA sentence.
|
bool transmitLocation = true; //By default we will transmit the units location via GGA sentence.
|
||||||
int timeBetweenGGAUpdate_ms = 10000; //GGA is required for Rev2 NTRIP casters. Don't transmit but once every 10 seconds
|
int timeBetweenGGAUpdate_ms = 10000; //GGA is required for Rev2 NTRIP casters. Don't transmit but once every 10 seconds
|
||||||
long lastTransmittedGGA_ms = 0;
|
long lastTransmittedGGA_ms = 0;
|
||||||
|
|
||||||
@@ -76,7 +76,7 @@ void setup()
|
|||||||
|
|
||||||
Wire.begin(); //Start I2C
|
Wire.begin(); //Start I2C
|
||||||
|
|
||||||
while(myGNSS.begin() == false) //Connect to the Ublox module using Wire port
|
while (myGNSS.begin() == false) //Connect to the Ublox module using Wire port
|
||||||
{
|
{
|
||||||
Serial.println(F("u-blox GPS not detected at default I2C address. Please check wiring. Freezing."));
|
Serial.println(F("u-blox GPS not detected at default I2C address. Please check wiring. Freezing."));
|
||||||
delay(2000);
|
delay(2000);
|
||||||
@@ -84,7 +84,7 @@ void setup()
|
|||||||
}
|
}
|
||||||
Serial.println(F("u-blox module connected"));
|
Serial.println(F("u-blox module connected"));
|
||||||
|
|
||||||
myGNSS.setI2COutput(COM_TYPE_UBX | COM_TYPE_NMEA); //Set the I2C port to output both NMEA and UBX messages
|
myGNSS.setI2COutput(COM_TYPE_UBX | COM_TYPE_NMEA); //Set the I2C port to output both NMEA and UBX messages
|
||||||
myGNSS.setPortInput(COM_PORT_I2C, COM_TYPE_UBX | COM_TYPE_NMEA | COM_TYPE_RTCM3); //Be sure RTCM3 input is enabled. UBX + RTCM3 is not a valid state.
|
myGNSS.setPortInput(COM_PORT_I2C, COM_TYPE_UBX | COM_TYPE_NMEA | COM_TYPE_RTCM3); //Be sure RTCM3 input is enabled. UBX + RTCM3 is not a valid state.
|
||||||
|
|
||||||
myGNSS.enableNMEAMessage(UBX_NMEA_GGA, COM_PORT_I2C); //Verify the GGA sentence is enabled
|
myGNSS.enableNMEAMessage(UBX_NMEA_GGA, COM_PORT_I2C); //Verify the GGA sentence is enabled
|
||||||
@@ -93,7 +93,8 @@ void setup()
|
|||||||
|
|
||||||
Serial.print(F("Connecting to local WiFi"));
|
Serial.print(F("Connecting to local WiFi"));
|
||||||
WiFi.begin(ssid, password);
|
WiFi.begin(ssid, password);
|
||||||
while (WiFi.status() != WL_CONNECTED) {
|
while (WiFi.status() != WL_CONNECTED)
|
||||||
|
{
|
||||||
delay(500);
|
delay(500);
|
||||||
Serial.print(F("."));
|
Serial.print(F("."));
|
||||||
}
|
}
|
||||||
@@ -102,7 +103,8 @@ void setup()
|
|||||||
Serial.print(F("WiFi connected with IP: "));
|
Serial.print(F("WiFi connected with IP: "));
|
||||||
Serial.println(WiFi.localIP());
|
Serial.println(WiFi.localIP());
|
||||||
|
|
||||||
while (Serial.available()) Serial.read();
|
while (Serial.available())
|
||||||
|
Serial.read();
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop()
|
void loop()
|
||||||
@@ -110,7 +112,8 @@ void loop()
|
|||||||
if (Serial.available())
|
if (Serial.available())
|
||||||
{
|
{
|
||||||
beginClient();
|
beginClient();
|
||||||
while (Serial.available()) Serial.read(); //Empty buffer of any newline chars
|
while (Serial.available())
|
||||||
|
Serial.read(); //Empty buffer of any newline chars
|
||||||
}
|
}
|
||||||
|
|
||||||
Serial.println(F("Press any key to start NTRIP Client."));
|
Serial.println(F("Press any key to start NTRIP Client."));
|
||||||
@@ -126,7 +129,8 @@ void beginClient()
|
|||||||
|
|
||||||
Serial.println(F("Subscribing to Caster. Press key to stop"));
|
Serial.println(F("Subscribing to Caster. Press key to stop"));
|
||||||
delay(10); //Wait for any serial to arrive
|
delay(10); //Wait for any serial to arrive
|
||||||
while (Serial.available()) Serial.read(); //Flush
|
while (Serial.available())
|
||||||
|
Serial.read(); //Flush
|
||||||
|
|
||||||
while (Serial.available() == 0)
|
while (Serial.available() == 0)
|
||||||
{
|
{
|
||||||
@@ -181,13 +185,14 @@ void beginClient()
|
|||||||
String strEncodedCredentials = b.encode(userCredentials);
|
String strEncodedCredentials = b.encode(userCredentials);
|
||||||
char encodedCredentials[strEncodedCredentials.length() + 1];
|
char encodedCredentials[strEncodedCredentials.length() + 1];
|
||||||
strEncodedCredentials.toCharArray(encodedCredentials, sizeof(encodedCredentials)); //Convert String to char array
|
strEncodedCredentials.toCharArray(encodedCredentials, sizeof(encodedCredentials)); //Convert String to char array
|
||||||
snprintf(credentials, sizeof(credentials), "Authorization: Basic %s\r\n", encodedCredentials);
|
|
||||||
#else
|
#else
|
||||||
//Encode with nfriendly library
|
//Encode with nfriendly library
|
||||||
int encodedLen = base64_enc_len(strlen(userCredentials));
|
int encodedLen = base64_enc_len(strlen(userCredentials));
|
||||||
char encodedCredentials[encodedLen]; //Create array large enough to house encoded data
|
char encodedCredentials[encodedLen]; //Create array large enough to house encoded data
|
||||||
base64_encode(encodedCredentials, userCredentials, strlen(userCredentials)); //Note: Input array is consumed
|
base64_encode(encodedCredentials, userCredentials, strlen(userCredentials)); //Note: Input array is consumed
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
snprintf(credentials, sizeof(credentials), "Authorization: Basic %s\r\n", encodedCredentials);
|
||||||
}
|
}
|
||||||
strncat(serverRequest, credentials, SERVER_BUFFER_SIZE);
|
strncat(serverRequest, credentials, SERVER_BUFFER_SIZE);
|
||||||
strncat(serverRequest, "\r\n", SERVER_BUFFER_SIZE);
|
strncat(serverRequest, "\r\n", SERVER_BUFFER_SIZE);
|
||||||
@@ -221,7 +226,8 @@ void beginClient()
|
|||||||
int responseSpot = 0;
|
int responseSpot = 0;
|
||||||
while (ntripClient.available())
|
while (ntripClient.available())
|
||||||
{
|
{
|
||||||
if (responseSpot == sizeof(response) - 1) break;
|
if (responseSpot == sizeof(response) - 1)
|
||||||
|
break;
|
||||||
|
|
||||||
response[responseSpot++] = ntripClient.read();
|
response[responseSpot++] = ntripClient.read();
|
||||||
if (strstr(response, "200") > 0) //Look for '200 OK'
|
if (strstr(response, "200") > 0) //Look for '200 OK'
|
||||||
@@ -248,10 +254,10 @@ void beginClient()
|
|||||||
Serial.print(F("Connected to "));
|
Serial.print(F("Connected to "));
|
||||||
Serial.println(casterHost);
|
Serial.println(casterHost);
|
||||||
lastReceivedRTCM_ms = millis(); //Reset timeout
|
lastReceivedRTCM_ms = millis(); //Reset timeout
|
||||||
ggaTransmitComplete = true; //Reset to start polling for new GGA data
|
ggaTransmitComplete = true; //Reset to start polling for new GGA data
|
||||||
}
|
}
|
||||||
} //End attempt to connect
|
} //End attempt to connect
|
||||||
} //End connected == false
|
} //End connected == false
|
||||||
|
|
||||||
if (ntripClient.connected() == true)
|
if (ntripClient.connected() == true)
|
||||||
{
|
{
|
||||||
@@ -263,7 +269,8 @@ void beginClient()
|
|||||||
{
|
{
|
||||||
//Serial.write(ntripClient.read()); //Pipe to serial port is fine but beware, it's a lot of binary data
|
//Serial.write(ntripClient.read()); //Pipe to serial port is fine but beware, it's a lot of binary data
|
||||||
rtcmData[rtcmCount++] = ntripClient.read();
|
rtcmData[rtcmCount++] = ntripClient.read();
|
||||||
if (rtcmCount == sizeof(rtcmData)) break;
|
if (rtcmCount == sizeof(rtcmData))
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (rtcmCount > 0)
|
if (rtcmCount > 0)
|
||||||
@@ -278,12 +285,7 @@ void beginClient()
|
|||||||
}
|
}
|
||||||
|
|
||||||
//Provide the caster with our current position as needed
|
//Provide the caster with our current position as needed
|
||||||
if (ntripClient.connected() == true
|
if (ntripClient.connected() == true && transmitLocation == true && (millis() - lastTransmittedGGA_ms) > timeBetweenGGAUpdate_ms && ggaSentenceComplete == true && ggaTransmitComplete == false)
|
||||||
&& transmitLocation == true
|
|
||||||
&& (millis() - lastTransmittedGGA_ms) > timeBetweenGGAUpdate_ms
|
|
||||||
&& ggaSentenceComplete == true
|
|
||||||
&& ggaTransmitComplete == false
|
|
||||||
)
|
|
||||||
{
|
{
|
||||||
Serial.print(F("Pushing GGA to server: "));
|
Serial.print(F("Pushing GGA to server: "));
|
||||||
Serial.println(ggaSentence);
|
Serial.println(ggaSentence);
|
||||||
@@ -315,7 +317,8 @@ void beginClient()
|
|||||||
int responseSpot = 0;
|
int responseSpot = 0;
|
||||||
while (ntripClient.available())
|
while (ntripClient.available())
|
||||||
{
|
{
|
||||||
if (responseSpot == sizeof(response) - 1) break;
|
if (responseSpot == sizeof(response) - 1)
|
||||||
|
break;
|
||||||
|
|
||||||
response[responseSpot++] = ntripClient.read();
|
response[responseSpot++] = ntripClient.read();
|
||||||
if (strstr(response, "200") > 0) //Look for '200 OK'
|
if (strstr(response, "200") > 0) //Look for '200 OK'
|
||||||
|
|||||||
Reference in New Issue
Block a user