uint8_t GPS_MTK3339::continueRead(){
#ifdef GPS_DEBUG_READ_VERBOSE
GPS_DEBUG_READ_PRINTLN("READ GPS CONTINUE");
#endif
while(serial_available() > 0){
char b = (char)serial_read();
if(b == GPS_START_DELIM){
GPS_DEBUG_READ_PRINTLN("unexpected start delimiter found");
_machineState = GPS_MS_ERROR;
return GPS_ERROR_PARSE_ERR;
}
if(b == GPS_CHKSUM_DELIM){
writeBuffer(b);
uint32_t ticks = millis();
while(serial_available() < 2){
if(millis() - ticks > 250){
GPS_DEBUG_READ_PRINTLN("too long to read checksum bytes");
_machineState = GPS_MS_ERROR;
return GPS_ERROR_TIMEOUT;
}
}
b = serial_read();
writeBuffer(b);
b = serial_read();
writeBuffer(b);
writeBuffer(0x00);
return parseSentence();
}
writeBuffer(b);
}
return GPS_STATUS_READING;
}
int main()
{
init();
initSentence( "the man washed the blue car" );
parseSentence();
emitFrame();
destroySentence();
initSentence( "a dog chased a dirty cat" );
parseSentence();
emitFrame();
destroySentence();
return 0;
}
void MAXM8interface::receive() {
static elapsedMicros timerSrl = 0;
static elapsedMillis timerMsg = 0;
newData = false;
timeout = false;
if (receiving) {
while(Serial3.available()) {
sentence += char(Serial3.read());
timerSrl = 0;
}
if (timerSrl >= 1000) { // 9600 baud is 833 us/byte
receiving = false;
if (parseSentence()) {
newData = true;
timerMsg = 0;
}
else {
newData = false;
}
}
}
else if(Serial3.available()) {
sentence += char(Serial3.read());
receiving = true;
timerSrl = 0;
}
if (timerMsg > 700 && !receiving) {
timerMsg = 0;
timeout = true;
gpsLock = false;
}
}
// Wait until the command sent gets an ACK back
void GPS::waitForAck(const uint32_t timeout)
{
uint32_t giveUpTime = 0;
if (timeout) {
giveUpTime = millis()+timeout;
}
while (!giveUpTime || millis() < giveUpTime) {
if (parseSentence() == PARSED_ACK) break;
}
}
void tiberius::mmap::SuffixTree::addStory(list<sentence> &sentences) {
parseSentence(sentences);
this->docCount++;
}
/**
* Counts number of SNR values in a GSV sentence above certain limits.
* Takes the first sentence of a GSV, counts the number of other sentences
* reads next sentences directly from file and tokenises them.
* iterates through the 1-3 sentences in the list, counting SNR values.
* @param in_sentence pointer to first tokenised sentence
* @param pointer to the stream that generated the sentence
* @return an integer representing the fix quality
*/
int make_gsv(list_ptr in_sentence, stream_ptr stream) {
//Get the number of GSV lines from second token in the sentence
int num_lines = atoi(get_head(&in_sentence)->next->node_data);
int good_snr_count = 0;
int min_snr_count = 0;
//Make a list to hold GSVs, up to 3
list_ptr gsv_lines;
init_list(&gsv_lines);
//passed in sentence tokens added to GSV list
node_ptr original_line;
init_node(&original_line, in_sentence);
add_to_list(&original_line, &gsv_lines);
//Add the other gsv lines to the list
int i;
for (i = 1; i < num_lines; i++) {
node_ptr gsv_line;
init_node(&gsv_line, parseSentence(read_sentence(stream)));
add_to_list(&gsv_line, &gsv_lines);
}
//Iterator for the GSV lines
node_ptr gsv_iterator = get_head(&gsv_lines);
//Iterator for sentence tokens in the GSV lines
node_ptr sentence_token;
while (gsv_iterator != NULL) {
int tokencount = 0; //track number of tokens encountered
int snr_value_token = 7; // first SNR in a line is 7th token
//get first token in sentence
sentence_token = get_head((list_ptr *) & gsv_iterator->node_data);
//go through each sentence and count values for good/min fix
while (sentence_token != NULL) {
if (tokencount == snr_value_token) {
if (!(strcmp(sentence_token->node_data, "") == 0)) {
int snr = atoi(sentence_token->node_data);
if (snr >= 35) {
good_snr_count++;
}
if ((snr >= 30) && (snr < 35)) {
min_snr_count++;
}
}
snr_value_token += 4; //next SNR in line : every 4 tokens
}
sentence_token = sentence_token->next;
tokencount++;
}
gsv_iterator = gsv_iterator -> next;
}
if (good_snr_count >= 3) {
return 2;
} else if ((good_snr_count + min_snr_count) >= 3) {
return 1;
} else {
return 0;
}
}
