基于C语言的简易地面控制站SimpGCS设计源码

#include <stdio.h> #include <stdlib.h> #include <time.h> #include <string.h> #include <string> #include <algorithm> #include "utils.h" //////////////////////////////////////////////////////////////////////////////// /// string utils //////////////////////////////////////////////////////////////////////////////// inline int char_is_delims(char c, char d) { if( c == d ) return 1; else return 0; } StringArray split_text(const std::string &intext, const std::string &delims) { StringArray r; int st; int n, nd, i, j, k, dd; char *buf; const char *pb, *pd; n = intext.size(); nd = delims.size(); pb = intext.c_str(); pd = delims.c_str(); buf = new char[n+10]; st = 0; i = 0; k = 0; buf[0] = 0; while( i<n ) { for(dd = 0, j=0; j<nd; j++) dd += char_is_delims(pb[i], pd[j]); if( dd > 0 ) { buf[k] = 0; r.push_back(buf); k = 0; st = 1; } else { buf[k++] = pb[i]; st = 0; } i++; } // process last character if( st == 0 ) { buf[k] = 0; r.push_back(buf); } else { buf[0] = 0; r.push_back(buf); } delete [] buf; return r; } std::string join_text(const StringArray& sa, const std::string& delims) { std::string s; for(int i=0; i<sa.size(); i++) { if( i == 0 ) s = sa[i]; else s = s + delims + sa[i]; } return s; } std::string& str_toupper(std::string &s) { for(size_t i=0; i < s.size(); i++) { s[i] = toupper(s[i]); } return s; } std::string& str_tolower(std::string &s) { for(size_t i=0; i < s.size(); i++) { s[i] = tolower(s[i]); } return s; } std::string trim(const std::string &s) { std::string delims = " \t\n\r", r; std::string::size_type i, j; i = s.find_first_not_of(delims); j = s.find_last_not_of(delims); if( i == std::string::npos ) { r = ""; return r; } if( j == std::string::npos ) { r = ""; return r; } r = s.substr(i, j-i+1); return r; } std::string& trim2(std::string& s) { if (s.empty()) { return s; } std::string& r = s; std::string::iterator c; // Erase whitespace before the string for (c = r.begin(); c != r.end() && isspace(*c++);); r.erase(r.begin(), --c); // Erase whitespace after the string for (c = r.end(); c != r.begin() && isspace(*--c);); r.erase(++c, r.end()); return r; } // string trim functions std::string ltrim(const std::string &s) { std::string delims = " \t\n\r", r; std::string::size_type i; i = s.find_first_not_of(delims); if( i == std::string::npos ) r = ""; else r = s.substr(i, s.size() - i); return r; } std::string rtrim(const std::string &s) { std::string delims = " \t\n\r", r; std::string::size_type i; i = s.find_last_not_of(delims); if( i == std::string::npos ) r = ""; else r = s.substr(0, i+1); return r; } int str_to_int(const std::string &s) { return atoi(s.c_str()); } float str_to_float(const std::string &s) { return atof(s.c_str()); } double str_to_double(const std::string &s) { return atof(s.c_str()); } //////////////////////////////////////////////////////////////////////////////// /// time utils //////////////////////////////////////////////////////////////////////////////// int64_t time_utc(struct tm *tm); #ifdef _WIN32 // WIN #include <windows.h> #include <io.h> #include <time.h> #include <ctype.h> #include <sys/types.h> #include <sys/stat.h> uint64_t tm_get_millis(void) { return GetTickCount(); } uint64_t tm_get_ms(void) { return GetTickCount(); } uint64_t tm_get_us(void) { FILETIME t; uint64_t t_ret; // get UTC time GetSystemTimeAsFileTime(&t); t_ret = 0; t_ret |= t.dwHighDateTime; t_ret <<= 32; t_ret |= t.dwLowDateTime; // convert 100 ns to [ms] return t_ret/10; } double tm_getTimeStamp(void) { FILETIME t; uint64_t t_ret; double ts; // get UTC time GetSystemTimeAsFileTime(&t); t_ret = 0; t_ret |= t.dwHighDateTime; t_ret <<= 32; t_ret |= t.dwLowDateTime; // convert 100 ns to second ts = 1.0 * t_ret / 1e7; return ts; } uint32_t tm_getTimeStampUnix(void) { FILETIME t; uint64_t t_ret; uint32_t ts; // get UTC time GetSystemTimeAsFileTime(&t); t_ret = 0; t_ret |= t.dwHighDateTime; t_ret <<= 32; t_ret |= t.dwLowDateTime; // convert 100 ns to second ts = t_ret / 10000000; return ts; } void tm_sleep(uint32_t t) { Sleep(t); } void tm_sleep_us(uint64_t t) { HANDLE timer; LARGE_INTEGER ft; // Convert to 100 nanosecond interval, negative value indicates relative time ft.QuadPart = -(10*t); timer = CreateWaitableTimer(NULL, TRUE, NULL); SetWaitableTimer(timer, &ft, 0, NULL, NULL, 0); WaitForSingleObject(timer, INFINITE); CloseHandle(timer); } const char * strp_weekdays[] = { "sunday", "monday", "tuesday", "wednesday", "thursday", "friday", "saturday"}; const char * strp_monthnames[] = { "january", "february", "march", "april", "may", "june", "july", "august", "september", "october", "november", "december"}; bool strp_atoi(const char * & s, int & result, int low, int high, int offset) { bool worked = false; char * end; unsigned long num = strtoul(s, & end, 10); if (num >= (unsigned long)low && num <= (unsigned long)high) { result = (int)(num + offset); s = end; worked = true; } return worked; } char * strptime(const char *s, const char *format, struct tm *tm) { bool working = true; while (working && *format && *s) { switch (*format) { case '%': { ++format; switch (*format) { case 'a': case 'A': // weekday name tm->tm_wday = -1; working = false; for (size_t i = 0; i < 7; ++ i) { size_t len = strlen(strp_weekdays[i]); if (!strnicmp(strp_weekdays[i], s, len)) { tm->tm_wday = i; s += len; working = true; break; } else if (!strnicmp(strp_weekdays[i], s, 3)) { tm->tm_wday = i; s += 3; working = true; break; } } break; case 'b': case 'B': case 'h': // month name tm->tm_mon = -1; working = false; for (size_t i = 0; i < 12; ++ i) { size_t len = strlen(strp_monthnames[i]); if (!strnicmp(strp_monthnames[i], s, len)) { tm->tm_mon = i; s += len; working = true; break; } else if (!strnicmp(strp_monthnames[i], s, 3)) { tm->tm_mon = i; s += 3; working = true; break; } } break; case 'd': case 'e': // day of month number working = strp_atoi(s, tm->tm_mday, 1,