Quick fix for ascii generic input line separator problem
This commit is contained in:
parent
12f694f06d
commit
ae8438333c
2 changed files with 31 additions and 15 deletions
|
@ -272,13 +272,13 @@ bool FGGeneric::gen_message() {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
bool FGGeneric::parse_message_binary() {
|
bool FGGeneric::parse_message_binary(int length) {
|
||||||
char *p2, *p1 = buf;
|
char *p2, *p1 = buf;
|
||||||
int32_t tmp32;
|
int32_t tmp32;
|
||||||
double val;
|
double val;
|
||||||
int i = -1;
|
int i = -1;
|
||||||
|
|
||||||
p2 = p1 + FG_MAX_MSG_SIZE;
|
p2 = p1 + length;
|
||||||
while ((++i < (int)_in_message.size()) && (p1 < p2)) {
|
while ((++i < (int)_in_message.size()) && (p1 < p2)) {
|
||||||
|
|
||||||
switch (_in_message[i].type) {
|
switch (_in_message[i].type) {
|
||||||
|
@ -353,14 +353,23 @@ bool FGGeneric::parse_message_binary() {
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
bool FGGeneric::parse_message_ascii() {
|
bool FGGeneric::parse_message_ascii(int length) {
|
||||||
char *p2, *p1 = buf;
|
char *p2, *p1 = buf;
|
||||||
double val;
|
double val;
|
||||||
int i = -1;
|
int i = -1;
|
||||||
|
int chunks = _in_message.size();
|
||||||
|
int line_separator_size = line_separator.size();
|
||||||
|
|
||||||
while ((++i < (int)_in_message.size()) &&
|
if (length < line_separator_size ||
|
||||||
p1 && strcmp(p1, line_separator.c_str())) {
|
line_separator.compare(buf + length - line_separator_size) != 0) {
|
||||||
|
|
||||||
|
SG_LOG(SG_IO, SG_WARN,
|
||||||
|
"Input line does not end with expected line separator." );
|
||||||
|
} else {
|
||||||
|
buf[length - line_separator_size] = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
while ((++i < chunks) && p1) {
|
||||||
p2 = strstr(p1, var_separator.c_str());
|
p2 = strstr(p1, var_separator.c_str());
|
||||||
if (p2) {
|
if (p2) {
|
||||||
*p2 = 0;
|
*p2 = 0;
|
||||||
|
@ -398,11 +407,11 @@ bool FGGeneric::parse_message_ascii() {
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
bool FGGeneric::parse_message() {
|
bool FGGeneric::parse_message(int length) {
|
||||||
if (binary_mode) {
|
if (binary_mode) {
|
||||||
return parse_message_binary();
|
return parse_message_binary(length);
|
||||||
} else {
|
} else {
|
||||||
return parse_message_ascii();
|
return parse_message_ascii(length);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -450,7 +459,7 @@ bool FGGeneric::process() {
|
||||||
if (!binary_mode) {
|
if (!binary_mode) {
|
||||||
length = io->readline( buf, FG_MAX_MSG_SIZE );
|
length = io->readline( buf, FG_MAX_MSG_SIZE );
|
||||||
if ( length > 0 ) {
|
if ( length > 0 ) {
|
||||||
parse_message();
|
parse_message( length );
|
||||||
} else {
|
} else {
|
||||||
SG_LOG( SG_IO, SG_ALERT, "Error reading data." );
|
SG_LOG( SG_IO, SG_ALERT, "Error reading data." );
|
||||||
return false;
|
return false;
|
||||||
|
@ -458,7 +467,7 @@ bool FGGeneric::process() {
|
||||||
} else {
|
} else {
|
||||||
length = io->read( buf, binary_record_length );
|
length = io->read( buf, binary_record_length );
|
||||||
if ( length == binary_record_length ) {
|
if ( length == binary_record_length ) {
|
||||||
parse_message();
|
parse_message( length );
|
||||||
} else {
|
} else {
|
||||||
SG_LOG( SG_IO, SG_ALERT,
|
SG_LOG( SG_IO, SG_ALERT,
|
||||||
"Generic protocol: Received binary "
|
"Generic protocol: Received binary "
|
||||||
|
@ -470,12 +479,12 @@ bool FGGeneric::process() {
|
||||||
} else {
|
} else {
|
||||||
if (!binary_mode) {
|
if (!binary_mode) {
|
||||||
while ((length = io->readline( buf, FG_MAX_MSG_SIZE )) > 0 ) {
|
while ((length = io->readline( buf, FG_MAX_MSG_SIZE )) > 0 ) {
|
||||||
parse_message();
|
parse_message( length );
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
while ((length = io->read( buf, binary_record_length ))
|
while ((length = io->read( buf, binary_record_length ))
|
||||||
== binary_record_length ) {
|
== binary_record_length ) {
|
||||||
parse_message();
|
parse_message( length );
|
||||||
}
|
}
|
||||||
|
|
||||||
if ( length > 0 ) {
|
if ( length > 0 ) {
|
||||||
|
@ -549,6 +558,13 @@ FGGeneric::reinit()
|
||||||
if (input) {
|
if (input) {
|
||||||
_in_message.clear();
|
_in_message.clear();
|
||||||
read_config(input, _in_message);
|
read_config(input, _in_message);
|
||||||
|
if (!binary_mode && (line_separator.size() == 0 ||
|
||||||
|
*line_separator.rbegin() != '\n')) {
|
||||||
|
|
||||||
|
SG_LOG(SG_IO, SG_WARN,
|
||||||
|
"Warning: Appending newline to line separator in generic input.");
|
||||||
|
line_separator.push_back('\n');
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
|
@ -42,7 +42,7 @@ public:
|
||||||
~FGGeneric();
|
~FGGeneric();
|
||||||
|
|
||||||
bool gen_message();
|
bool gen_message();
|
||||||
bool parse_message();
|
bool parse_message(int length);
|
||||||
|
|
||||||
// open hailing frequencies
|
// open hailing frequencies
|
||||||
bool open();
|
bool open();
|
||||||
|
@ -95,8 +95,8 @@ private:
|
||||||
|
|
||||||
bool gen_message_ascii();
|
bool gen_message_ascii();
|
||||||
bool gen_message_binary();
|
bool gen_message_binary();
|
||||||
bool parse_message_ascii();
|
bool parse_message_ascii(int length);
|
||||||
bool parse_message_binary();
|
bool parse_message_binary(int length);
|
||||||
void read_config(SGPropertyNode *root, vector<_serial_prot> &msg);
|
void read_config(SGPropertyNode *root, vector<_serial_prot> &msg);
|
||||||
bool exitOnError;
|
bool exitOnError;
|
||||||
};
|
};
|
||||||
|
|
Loading…
Reference in a new issue