c0 += (uint8_t)buf[i];
c1 += c0;
// cout << "c0 = " << (unsigned int)c0 << " c1 = " << (unsigned int)c1
- // << " [" << (unsigned int)buf[i] << "]" << endl;
+ // << " [" << (unsigned int)(uint8_t)buf[i] << "]" << endl;
}
- cout << "c0 = " << (unsigned int)c0 << " (" << (unsigned int)cksum0
- << ") c1 = " << (unsigned int)c1 << " (" << (unsigned int)cksum1
- << ")" << endl;
+ // cout << "c0 = " << (unsigned int)c0 << " (" << (unsigned int)cksum0
+ // << ") c1 = " << (unsigned int)c1 << " (" << (unsigned int)cksum1
+ // << ")" << endl;
if ( c0 == cksum0 && c1 == cksum1 ) {
return true;
// read message id and size
myread( ch, log, tmpbuf, 1 ); uint8_t id = (unsigned char)tmpbuf[0];
myread( ch, log, tmpbuf, 1 ); uint8_t size = (unsigned char)tmpbuf[0];
- cout << "message = " << (int)id << " size = " << (int)size << endl;
+ // cout << "message = " << (int)id << " size = " << (int)size << endl;
// load message
if ( ch->get_type() == sgFileType ) {
serial_read( serial, log, tmpbuf, 2 );
uint8_t id = (unsigned char)tmpbuf[0];
uint8_t size = (unsigned char)tmpbuf[1];
- cout << "message = " << (int)id << " size = " << (int)size << endl;
+ // cout << "message = " << (int)id << " size = " << (int)size << endl;
// load message
serial_read( serial, log, savebuf, size );
}
while ( input.is_enabled() ) {
- cout << "looking for next message ..." << endl;
+ // cout << "looking for next message ..." << endl;
int id = track.next_message( &input, &output, &gpspacket,
&imupacket, &navpacket, &servopacket,
&healthpacket );
- cout << "message id = " << id << endl;
+ // cout << "message id = " << id << endl;
count++;
if ( id == GPS_PACKET ) {