109 lines
2.3 KiB
C++
109 lines
2.3 KiB
C++
|
|
// stdafx.cpp : 只包括标准包含文件的源文件
|
|
// Vcs-Client.pch 将作为预编译头
|
|
// stdafx.obj 将包含预编译类型信息
|
|
|
|
#include "stdafx.h"
|
|
|
|
|
|
|
|
#define MIN_XYZ_VALUE (-999999)
|
|
float* g_xys = new float[3000 * 3000 * 2];
|
|
int g_xyz_flag = 0;
|
|
|
|
|
|
#define Q_R 1500
|
|
#define X0 1500
|
|
#define Y0 1500
|
|
|
|
inline float abs_m(float lf)
|
|
{
|
|
if (lf < 0) lf *= -1;
|
|
return lf;
|
|
}
|
|
|
|
// 以c为基准, 计算两个向量的夹角
|
|
float getAngelOfTwoVector(Point2f &pt1, Point2f &pt2, Point2f &c)
|
|
{
|
|
float theta = atan2(pt1.y - c.y, pt1.x - c.x) - atan2(pt2.y - c.y, pt2.x - c.x);
|
|
if (theta > CV_PI)
|
|
theta -= 2 * CV_PI;
|
|
if (theta < -CV_PI)
|
|
theta += 2 * CV_PI;
|
|
|
|
theta = -1*theta * 180.0 / CV_PI;
|
|
return theta;
|
|
}
|
|
|
|
|
|
//字符串分割
|
|
void splitString(const string& s, vector<string>& v, const string& c)
|
|
{
|
|
string::size_type pos1, pos2;
|
|
pos2 = s.find(c);
|
|
pos1 = 0;
|
|
while (string::npos != pos2)
|
|
{
|
|
v.push_back(s.substr(pos1, pos2 - pos1));
|
|
pos1 = pos2 + c.size();
|
|
pos2 = s.find(c, pos1);
|
|
}
|
|
if (pos1 != s.length())
|
|
v.push_back(s.substr(pos1));
|
|
}
|
|
|
|
CString g_strSavePath = "";
|
|
CString g_strCurTime = "";
|
|
|
|
void LogOutToFile(const char* fmt, ...)
|
|
{
|
|
static CRITICAL_SECTION stCritical;
|
|
static BOOL bInit = FALSE;
|
|
static CString strLogPath;
|
|
if (FALSE == bInit)
|
|
{
|
|
bInit = TRUE;
|
|
GetModuleFileName(NULL, strLogPath.GetBuffer(2048), 2047);
|
|
strLogPath.ReleaseBuffer();
|
|
strLogPath = strLogPath.Left(strLogPath.ReverseFind('\\'));
|
|
strLogPath += "\\log\\runtime.log";
|
|
|
|
InitializeCriticalSection(&stCritical);
|
|
}
|
|
|
|
EnterCriticalSection(&stCritical);
|
|
|
|
va_list ap;
|
|
va_start(ap, fmt);
|
|
char pBuffer[800] = "";
|
|
if (vsnprintf_s(pBuffer, 796, _TRUNCATE, fmt, ap) > 0)
|
|
{
|
|
|
|
if (strlen(pBuffer) == 0 || pBuffer[strlen(pBuffer) - 1] != '\n')
|
|
{
|
|
pBuffer[strlen(pBuffer) + 1] = '\0';//最后再追加一个结束符，因为原结束符需要修改为换行符
|
|
pBuffer[strlen(pBuffer)] = '\n';
|
|
}
|
|
}
|
|
va_end(ap);
|
|
|
|
TRACE("%s\n", pBuffer);
|
|
|
|
FILE* pFile = NULL;
|
|
fopen_s(&pFile, strLogPath.GetBuffer(), "ab+");
|
|
if (NULL != pFile)
|
|
{
|
|
char acTime[32] = { 0 };
|
|
SYSTEMTIME stTime;
|
|
GetLocalTime(&stTime);
|
|
sprintf_s(acTime, 32, "[%02d-%02d %02d:%02d:%02d.%03d] ", stTime.wMonth, stTime.wDay, stTime.wHour, stTime.wMinute, stTime.wSecond, stTime.wMilliseconds);
|
|
|
|
fwrite(acTime, 1, strlen(acTime), pFile);
|
|
fwrite(pBuffer, 1, strlen(pBuffer), pFile);
|
|
fwrite("\r\n", 1, strlen("\r\n"), pFile);
|
|
fclose(pFile);
|
|
}
|
|
|
|
LeaveCriticalSection(&stCritical);
|
|
}
|