13,10 → 13,11 |
#include <sys/time.h> |
|
void print_data(char * data, std::string type, char * color) { |
char buffer [100]; |
char buffer [20]; |
timeval timestamp; |
gettimeofday(×tamp, 0); |
sprintf(buffer, "%i.%03i", timestamp.tv_sec, (timestamp.tv_usec+500)/1000); |
//alternative to show human readable output |
/* |
time_t rawtime; |
struct tm * timeinfo; |
33,10 → 34,38 |
#endif |
} |
|
void FlightLog::log_data(char * data, int length) { |
printf("raw data:"); |
for( int i = 0 ; i < length; i++ ){ |
printf("%c", data[i]); |
} |
printf(" hex:"); |
for( int i = 0 ; i < length ; i++ ){ |
printf( "%02hhx " , data[i] ); |
} |
printf( "\n" ); |
} |
|
void FlightLog::info(char * data) { |
print_data(data, "INFO", INFO_COLOR); |
} |
|
void FlightLog::info_FC(char * data) { |
print_data(data, "INFO FC", INFO_FC_COLOR); |
} |
|
void FlightLog::info_NC(char * data) { |
print_data(data, "INFO NC", INFO_NC_COLOR); |
} |
|
void FlightLog::info_GPS(char * data) { |
print_data(data, "INFO GPS", INFO_GPS_COLOR); |
} |
|
void FlightLog::info_MK3(char * data) { |
print_data(data, "INFO MK3", INFO_MK3_COLOR); |
} |
|
void FlightLog::warning(char * data) { |
print_data(data, "WARNING", WARNING_COLOR); |
} |