#include <Main/globals.hxx>
#include <Main/fg_props.hxx>
+#include <Main/fg_os.hxx>
#include <Main/util.hxx>
-
#include "generic.hxx"
switch (_out_message[i].type) {
case FG_INT:
+ {
val = _out_message[i].offset +
_out_message[i].prop->getIntValue() * _out_message[i].factor;
-
- if (binary_byte_order == BYTE_ORDER_MATCHES_NETWORK_ORDER) {
- *((int32_t*)&buf[length]) = (int32_t)val;
- } else {
- *((uint32_t*)&buf[length]) = sg_bswap_32((uint32_t)val);
+ int32_t intVal = val;
+ if (binary_byte_order != BYTE_ORDER_MATCHES_NETWORK_ORDER) {
+ intVal = (int32_t) sg_bswap_32((uint32_t)intVal);
}
+ memcpy(&buf[length], &intVal, sizeof(int32_t));
length += sizeof(int32_t);
break;
+ }
case FG_BOOL:
- *((int8_t*)&buf[length])
- = _out_message[i].prop->getBoolValue() ? true : false;
+ buf[length] = (char) (_out_message[i].prop->getBoolValue() ? true : false);
length += 1;
break;
val = _out_message[i].offset +
_out_message[i].prop->getFloatValue() * _out_message[i].factor;
- int fixed = (int)(val * 65536.0f);
- if (binary_byte_order == BYTE_ORDER_MATCHES_NETWORK_ORDER) {
- *((int32_t*)&buf[length]) = (int32_t)fixed;
- } else {
- *((uint32_t*)&buf[length]) = sg_bswap_32((uint32_t)fixed);
+ int32_t fixed = (int)(val * 65536.0f);
+ if (binary_byte_order != BYTE_ORDER_MATCHES_NETWORK_ORDER) {
+ fixed = (int32_t) sg_bswap_32((uint32_t)fixed);
}
+ memcpy(&buf[length], &fixed, sizeof(int32_t));
length += sizeof(int32_t);
break;
}
+
case FG_FLOAT:
+ {
val = _out_message[i].offset +
_out_message[i].prop->getFloatValue() * _out_message[i].factor;
+ u32 tmpun32;
+ tmpun32.floatVal = static_cast<float>(val);
- if (binary_byte_order == BYTE_ORDER_MATCHES_NETWORK_ORDER) {
- *((float*)&buf[length]) = val;
- } else {
- u32 tmpun32;
- tmpun32.floatVal = static_cast<float>(val);
- *((uint32_t*)&buf[length]) = sg_bswap_32(tmpun32.intVal);
+ if (binary_byte_order != BYTE_ORDER_MATCHES_NETWORK_ORDER) {
+ tmpun32.intVal = sg_bswap_32(tmpun32.intVal);
}
+ memcpy(&buf[length], &tmpun32.intVal, sizeof(uint32_t));
length += sizeof(uint32_t);
break;
+ }
case FG_DOUBLE:
+ {
val = _out_message[i].offset +
_out_message[i].prop->getFloatValue() * _out_message[i].factor;
+ u64 tmpun64;
+ tmpun64.doubleVal = val;
- if (binary_byte_order == BYTE_ORDER_MATCHES_NETWORK_ORDER) {
- *((double*)&buf[length]) = val;
- } else {
- u64 tmpun64;
- tmpun64.doubleVal = val;
- *((uint64_t*)&buf[length]) = sg_bswap_64(tmpun64.longVal);
+ if (binary_byte_order != BYTE_ORDER_MATCHES_NETWORK_ORDER) {
+ tmpun64.longVal = sg_bswap_64(tmpun64.longVal);
}
- length += sizeof(int64_t);
+ memcpy(&buf[length], &tmpun64.longVal, sizeof(uint64_t));
+ length += sizeof(uint64_t);
break;
+ }
default: // SG_STRING
const char *strdata = _out_message[i].prop->getStringValue();
- int strlength = strlen(strdata);
+ int32_t strlength = strlen(strdata);
if (binary_byte_order == BYTE_ORDER_NEEDS_CONVERSION) {
SG_LOG( SG_IO, SG_ALERT, "Generic protocol: "
/* Format for strings is
* [length as int, 4 bytes][ASCII data, length bytes]
*/
- if (binary_byte_order == BYTE_ORDER_MATCHES_NETWORK_ORDER) {
- *((int32_t*)&buf[length]) = strlength;
- } else {
- *((int32_t*)&buf[length]) = sg_bswap_32(strlength);
+ if (binary_byte_order != BYTE_ORDER_MATCHES_NETWORK_ORDER) {
+ strlength = sg_bswap_32(strlength);
}
+ memcpy(&buf[length], &strlength, sizeof(int32_t));
length += sizeof(int32_t);
strncpy(&buf[length], strdata, strlength);
length += strlength;
}
if (binary_footer_type != FOOTER_NONE) {
- if (binary_byte_order == BYTE_ORDER_MATCHES_NETWORK_ORDER) {
- *((int32_t*)&buf[length]) = binary_footer_value;
- } else {
- *((int32_t*)&buf[length]) = sg_bswap_32(binary_footer_value);
+ int32_t intValue = binary_footer_value;
+ if (binary_byte_order != BYTE_ORDER_MATCHES_NETWORK_ORDER) {
+ intValue = sg_bswap_32(binary_footer_value);
}
+ memcpy(&buf[length], &intValue, sizeof(int32_t));
length += sizeof(int32_t);
}
case FG_DOUBLE:
val = _out_message[i].offset +
- _out_message[i].prop->getFloatValue() * _out_message[i].factor;
- snprintf(tmp, 255, _out_message[i].format.c_str(), (float)val);
+ _out_message[i].prop->getDoubleValue() * _out_message[i].factor;
+ snprintf(tmp, 255, _out_message[i].format.c_str(), (double)val);
break;
default: // SG_STRING
}
}
} else {
- do {
- if (!binary_mode) {
- length = io->readline( buf, FG_MAX_MSG_SIZE );
- if ( length > 0 ) {
- parse_message();
- }
- } else {
- length = io->read( buf, binary_record_length );
- if ( length == binary_record_length ) {
- parse_message();
- } else if ( length > 0 ) {
- SG_LOG( SG_IO, SG_ALERT,
- "Generic protocol: Received binary "
- "record of unexpected size, expected: "
- << binary_record_length << " but received: "
- << length);
- }
+ if (!binary_mode) {
+ while ((length = io->readline( buf, FG_MAX_MSG_SIZE )) > 0 ) {
+ parse_message();
}
- } while ( length == binary_record_length );
+ } else {
+ while ((length = io->read( buf, binary_record_length ))
+ == binary_record_length ) {
+ parse_message();
+ }
+
+ if ( length > 0 ) {
+ SG_LOG( SG_IO, SG_ALERT,
+ "Generic protocol: Received binary "
+ "record of unexpected size, expected: "
+ << binary_record_length << " but received: "
+ << length);
+ }
+ }
}
}
return true;
error_out:
if (exitOnError) {
- fgExit(1);
+ fgOSExit(1);
return true; // should not get there, but please the compiler
} else
return false;
}
- if (binary_record_length == -1) {
- binary_record_length = record_length;
- } else if (binary_record_length < record_length) {
- SG_LOG(SG_IO, SG_ALERT,
- "generic protocol: Requested binary record length shorter than "
- " requested record representation.");
- binary_record_length = record_length;
+ if( binary_mode ) {
+ if (binary_record_length == -1) {
+ binary_record_length = record_length;
+ } else if (binary_record_length < record_length) {
+ SG_LOG(SG_IO, SG_ALERT,
+ "generic protocol: Requested binary record length shorter than "
+ " requested record representation.");
+ binary_record_length = record_length;
+ }
}
}