#ifdef HAVE_CONFIG_H
# include <config.h>
-#endif
+#endif
#include <iostream>
#include <cstdio>
// open the gps file
file = path; file.append( "gps.dat.gz" );
- if ( (fgps = gzopen( file.c_str(), "r" )) == NULL ) {
- printf("Cannot open %s\n", file.c_str());
+ std::string fdata = file.local8BitStr();
+
+ if ( (fgps = gzopen( fdata.c_str(), "r" )) == NULL ) {
+ printf("Cannot open %s\n", fdata.c_str());
return false;
}
// open the imu file
file = path; file.append( "imu.dat.gz" );
- if ( (fimu = gzopen( file.c_str(), "r" )) == NULL ) {
- printf("Cannot open %s\n", file.c_str());
+ fdata = file.local8BitStr();
+ if ( (fimu = gzopen( fdata.c_str(), "r" )) == NULL ) {
+ printf("Cannot open %s\n", fdata.c_str());
return false;
}
// open the nav file
file = path; file.append( "nav.dat.gz" );
- if ( (fnav = gzopen( file.c_str(), "r" )) == NULL ) {
- printf("Cannot open %s\n", file.c_str());
+ fdata = file.local8BitStr();
+
+ if ( (fnav = gzopen( fdata.c_str(), "r" )) == NULL ) {
+ printf("Cannot open %s\n", fdata.c_str());
return false;
}
// open the servo file
file = path; file.append( "servo.dat.gz" );
- if ( (fservo = gzopen( file.c_str(), "r" )) == NULL ) {
- printf("Cannot open %s\n", file.c_str());
+ fdata = file.local8BitStr();
+
+ if ( (fservo = gzopen( fdata.c_str(), "r" )) == NULL ) {
+ printf("Cannot open %s\n", fdata.c_str());
return false;
}
// open the health file
file = path; file.append( "health.dat.gz" );
- if ( (fhealth = gzopen( file.c_str(), "r" )) == NULL ) {
- printf("Cannot open %s\n", file.c_str());
+ fdata = file.local8BitStr();
+
+ if ( (fhealth = gzopen( fdata.c_str(), "r" )) == NULL ) {
+ printf("Cannot open %s\n", fdata.c_str());
return false;
}
myread( ch, log, tmpbuf, 2 );
uint8_t cksum0 = (unsigned char)tmpbuf[0];
uint8_t cksum1 = (unsigned char)tmpbuf[1];
-
+
if ( validate_cksum( id, size, savebuf, cksum0, cksum1, ignore_checksum ) )
{
parse_msg( id, savebuf, gpspacket, imupacket, navpacket, servopacket,
{
char tmpbuf[256];
char savebuf[256];
- int result = 0;
// cout << "in next_message()" << endl;
// scan for sync characters
int scan_count = 0;
uint8_t sync0, sync1;
- result = serial_read( serial, log, tmpbuf, 2 );
+ serial_read( serial, log, tmpbuf, 2 );
sync0 = (unsigned char)tmpbuf[0];
sync1 = (unsigned char)tmpbuf[1];
while ( (sync0 != START_OF_MSG0 || sync1 != START_OF_MSG1) && !myeof ) {
uint8_t cksum1 = (unsigned char)tmpbuf[1];
// cout << "cksum0 = " << (int)cksum0 << " cksum1 = " << (int)cksum1
// << endl;
-
+
if ( validate_cksum( id, size, savebuf, cksum0, cksum1, ignore_checksum ) )
{
parse_msg( id, savebuf, gpspacket, imupacket, navpacket, servopacket,
cout << "Check sum failure!" << endl;
return -1;
-
+
}