dmsv2/Dms/DynamicData.cpp

/**************************************************************************************************
                                   版本所有(C), 2020-2022, 北京普达迪泰
***************************************************************************************************
 文 件 名: DynamicData.cpp
 功能描述: Dynamic Task任务数据
 版 本 号: 1.00初版
 作    者: HYF
 生成日期; 2021－12－20
 最近修改:
 函数列表:
 修改历史:
     1.日    期 :2021－12－20
       作    者 : HYF
       修改内容 : 创建文件

**************************************************************************************************/
#include "pch.h"
#include <afx.h>
#include <afxtempl.h>
#include "DynamicData.h"
#include "PostureDataAngle.h"
#include "PostureDataPoint.h"
#include "PostureDataAngleManager.h"
#include "PostureDataPointManager.h"
#include "EquipTypePlaceManager.h"
#include "CppSQLite3.h"
#include "DictManager.h"
#include <math.h>

// DynamicData
DynamicData::DynamicData()
{
	m_pDictManager = new DictManager();
	m_pSeamaphore = new CSemaphore(1, 1);
}


DynamicData::DynamicData(DWORD taskId, LPCTSTR szEquipTypeCode, LPCTSTR szEquipCode, LPCTSTR szEquipPlace)
: m_taskId(taskId)
, m_szEquipTypeCode(szEquipTypeCode)
, m_szEquipCode(szEquipCode)
, m_szEquipPlace(szEquipPlace)
{
	m_pDictManager = new DictManager();
	m_pSeamaphore = new CSemaphore(1, 1);
}

DynamicData::~DynamicData()
{
	if (NULL != m_pDictManager) {
		delete m_pDictManager;
		m_pDictManager = NULL;
	}
	delete m_pSeamaphore;
}

/**************************************************************************************************
函 数 名 :Clear
功能描述 :清空数据
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::Clear()
{
    while (!m_AngleList.IsEmpty())
	{
		delete m_AngleList.RemoveHead();
	}

    while (!m_PointList.IsEmpty())
	{
		delete m_PointList.RemoveHead();
	}

}

/**************************************************************************************************
函 数 名 :SaveToDB
功能描述 :批量存储到数据库
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::SaveToDB()
{
	m_pSeamaphore->Lock();
    SaveAngleToDB();
    SavePointToDB();
	m_pSeamaphore->Unlock();
}

/**************************************************************************************************
函 数 名 :SaveLineToDB
功能描述 :存储Line到数据库
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::SaveAngleToDB()
{
    POSITION   pos;
    PostureDataAngle *pAngle = NULL;
    PostureDataAngleManager *pAngleManager = new PostureDataAngleManager();
    pAngleManager->Delete(m_taskId, m_szEquipCode, m_szEquipPlace);
    BOOL bRet = TRUE;

	if (m_AngleList.GetCount() > 0)
	{
		pos = m_AngleList.GetHeadPosition();
		while (pos != NULL)
		{
			pAngle = (PostureDataAngle *)m_AngleList.GetNext(pos);
			if (pAngle != NULL)
			{
				bRet = pAngleManager->Add(*pAngle);
				if (bRet != TRUE)
				{
					AfxMessageBox("推力线数据存储失败！");
					break;
				}
			}
		}
	}
    delete pAngleManager;
}

/**************************************************************************************************
函 数 名 :SavePointToDB
功能描述 :存储Line到数据库
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::SavePointToDB()
{
    POSITION   pos;
    PostureDataPoint *pPoint = NULL;
    PostureDataPointManager *pPointManager = new PostureDataPointManager();
    pPointManager->Delete(m_taskId);
    BOOL bRet = TRUE;

	if (m_PointList.GetCount() > 0)
	{
		pos = m_PointList.GetHeadPosition();
		while (pos != NULL)
		{
			pPoint = (PostureDataPoint *)m_PointList.GetNext(pos);
			if (pPoint != NULL)
			{
				bRet = pPointManager->Add(*pPoint);
				if (bRet != TRUE)
				{
					AfxMessageBox("Point数据存储失败！");
					break;
				}
			}
		}
	}

    delete pPointManager;
}


/**************************************************************************************************
函 数 名 :AddPoint
功能描述 :新增推力线关联点
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::AddPoint(PostureDataPoint *pNewPoint)
{
    POSITION   pos;
    PostureDataPoint *pPoint = NULL;

    pos = m_PointList.GetHeadPosition();
	while (pos != NULL)
	{
		pPoint = (PostureDataPoint *)m_PointList.GetNext(pos);
		if (pPoint == NULL) break;  

        CString szPointCode = pPoint->GetPointCode();
        if (szPointCode.Compare(pNewPoint->GetPointCode()) == 0) 
        {
            delete pPoint;
            m_PointList.RemoveAt(pos);
        }
    }

	CString szPointCode = pNewPoint->GetPointCode();
	double szPointX = pNewPoint->GetPointAX();
	double szPointY = pNewPoint->GetPointAY();
	double szPointZ = pNewPoint->GetPointAZ();



	pNewPoint->SetPointTitle(m_pDictManager->GetDictItemTitle(szPointCode, szPointCode));
	pNewPoint->SetPointAX(szPointZ);
	pNewPoint->SetPointAY(szPointY);
	pNewPoint->SetPointAZ(-szPointX);

    m_PointList.AddTail(pNewPoint);
}

/**************************************************************************************************
函 数 名 :AddAngle
功能描述 :新增推力线关联点
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::AddAngle(PostureDataAngle *pNewAngle)
{
    POSITION   pos;
    PostureDataAngle *pAngle = NULL;

    pos = m_AngleList.GetHeadPosition();
	while (pos != NULL)
	{
		pAngle = (PostureDataAngle *)m_AngleList.GetNext(pos);
		if (pAngle == NULL) break;  

        CString szEquipPlace = pAngle->GetEquipPlace();
        if (szEquipPlace.Compare(pNewAngle->GetEquipPlace()) == 0) 
        {
            delete pAngle;
            m_AngleList.RemoveAt(pos);
        }
    }

    m_AngleList.AddTail(pNewAngle);
}

/**************************************************************************************************
函 数 名 :CalcAngle
功能描述 :新增推力线偏角
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::CalcAngle()
{
    POSITION pos;
    PostureDataPoint *pPoint = NULL;
    PostureDataPoint *pAS1   = NULL;
    PostureDataPoint *pAE1   = NULL;

	CString szPoint1;
	CString szPoint2;

	// 获取分机用于计算推力线的起点和终点代号
	EquipTypePlaceManager *pPlaceManager = new EquipTypePlaceManager();
	CppSQLite3Query q = pPlaceManager->Query(m_szEquipTypeCode, m_szEquipPlace);
	if (q.eof()) {
		LOG::E("没有配置当前分机用于计算推力线偏角的起终点！");
		q.finalize();
		return;
	}

	szPoint1.Format("%s", q.getStringField("point_start"));
	szPoint2.Format("%s", q.getStringField("point_end"));
	q.finalize();


    // 1.获取结点
    pos = m_PointList.GetHeadPosition();
	while (pos != NULL)
	{
		pPoint = (PostureDataPoint *)m_PointList.GetNext(pos);
		if (pPoint == NULL) break;  

        CString szPointCode = pPoint->GetPointCode();
        if (szPointCode.Compare(szPoint1) == 0)
        {
            pAS1 = pPoint;
        }
        else if (szPointCode.Compare(szPoint2) == 0)
        {
            pAE1 = pPoint;
        }
    }

    if ((pAS1 == NULL) || (pAE1 == NULL))
    {
        LOG::E("推力线结点数据不完整!");
        return;
    }
    
    // 2.获取坐标值
    DOUBLE fX1 = pAS1->GetPointAX(); 
    DOUBLE fY1 = pAS1->GetPointAY(); 
    DOUBLE fZ1 = pAS1->GetPointAZ(); 
    
    DOUBLE fX2 = pAE1->GetPointAX(); 
    DOUBLE fY2 = pAE1->GetPointAY(); 
    DOUBLE fZ2 = pAE1->GetPointAZ(); 
   
    // 3.计算偏角数据
    DOUBLE v1 = (fX2-fX1)*(fX2-fX1);
    DOUBLE v2 = (fY2-fY1)*(fY2-fY1);
    DOUBLE v3 = (fZ2-fZ1)*(fZ2-fZ1);

    DOUBLE fLength = sqrt(v1 + v2 + v3);
    DOUBLE ax = acos((fX2-fX1)/fLength) * 180 / PI;
    DOUBLE ay = acos((fY2-fY1)/fLength) * 180 / PI;
    DOUBLE az = acos((fZ2-fZ1)/fLength) * 180 / PI;

	// 4.计算调校量
	DOUBLE ex = ax - 0;
	DOUBLE ey = ay - 90;
	DOUBLE ez = az - (11/6);

    // 5. 保存数据
    PostureDataAngle *pAngle = new PostureDataAngle();
    pAngle->SetTaskId(m_taskId);
    pAngle->SetEquipCode(m_szEquipCode);
    pAngle->SetEquipPlace(m_szEquipPlace);
    pAngle->SetLineId(1);
    pAngle->SetLineTitle("AS1AE1");
    pAngle->SetLineCode("AS1AE1");
    pAngle->SetLineStartX(fX1);
    pAngle->SetLineStartY(fY1);
    pAngle->SetLineStartZ(fZ1);
    pAngle->SetLineEndX(fX2);
    pAngle->SetLineEndY(fY2);
    pAngle->SetLineEndZ(fZ2);
    pAngle->SetAngleAX(ax);
    pAngle->SetAngleAY(ay);
    pAngle->SetAngleAZ(az);
	pAngle->SetAngleEX(ex);
	pAngle->SetAngleEY(ey);
	pAngle->SetAngleEZ(ez);
    
    this->AddAngle(pAngle);
}


/**************************************************************************************************
函 数 名 :CalcAngle
功能描述 :新增推力线偏角
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::CalcTestAngle()
{
	POSITION pos;
	PostureDataPoint *pPoint = NULL;
	PostureDataPoint *pAS1 = NULL;
	PostureDataPoint *pAE1 = NULL;

	CString szPoint1("CODE1");
	CString szPoint2("CODE2");

	// 1.获取结点
	pos = m_PointList.GetHeadPosition();
	while (pos != NULL)
	{
		pPoint = (PostureDataPoint *)m_PointList.GetNext(pos);
		if (pPoint == NULL) break;

		CString szPointCode = pPoint->GetPointCode();
		if (szPointCode.Compare(szPoint1) == 0)
		{
			pAS1 = pPoint;
		}
		else if (szPointCode.Compare(szPoint2) == 0)
		{
			pAE1 = pPoint;
		}
	}

	if ((pAS1 == NULL) || (pAE1 == NULL))
	{
		LOG::E("推力线结点数据不完整!");
		return;
	}

	// 2.获取坐标值
	DOUBLE fX1 = pAS1->GetPointAX();
	DOUBLE fY1 = pAS1->GetPointAY();
	DOUBLE fZ1 = pAS1->GetPointAZ();

	DOUBLE fX2 = pAE1->GetPointAX();
	DOUBLE fY2 = pAE1->GetPointAY();
	DOUBLE fZ2 = pAE1->GetPointAZ();

	// 3.计算偏角数据
	DOUBLE v1 = (fX1 - fX2);
	DOUBLE v2 = (fY1 - fY2);
	DOUBLE v3 = (fZ1 - fZ2);

	DOUBLE ax = atan( v2 / v3) * 180 / PI;
	DOUBLE ay = atan( v1 / v3) * 180 / PI;
	DOUBLE az = atan( v1/v2) * 180 / PI;

	// 4.计算调校量
	DOUBLE ex = ax - 0;
	DOUBLE ey = ay - 0;
	DOUBLE ez = az - (11 / 6);

	// 5. 保存数据
	PostureDataAngle *pAngle = new PostureDataAngle();
	pAngle->SetTaskId(m_taskId);
	pAngle->SetEquipCode(m_szEquipCode);
	pAngle->SetEquipPlace(m_szEquipPlace);
	pAngle->SetLineId(1);
	pAngle->SetLineTitle("AS1AE1");
	pAngle->SetLineCode("AS1AE1");
	pAngle->SetLineStartX(fX1);
	pAngle->SetLineStartY(fY1);
	pAngle->SetLineStartZ(fZ1);
	pAngle->SetLineEndX(fX2);
	pAngle->SetLineEndY(fY2);
	pAngle->SetLineEndZ(fZ2);
	pAngle->SetAngleAX(ax);
	pAngle->SetAngleAY(ay);
	pAngle->SetAngleAZ(az);
	pAngle->SetAngleEX(ex);
	pAngle->SetAngleEY(ey);
	pAngle->SetAngleEZ(ez);

	this->AddAngle(pAngle);
}

/**************************************************************************************************
函 数 名 :GetAngle
功能描述 :根据条件查询推力线偏角数据
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
PostureDataAngle* DynamicData::GetAngle(DWORD taskId, LPCTSTR szEquipPlace)
{

    POSITION pos;
    PostureDataAngle *pAngle = NULL;

    if (m_taskId != taskId) return NULL;

    // 1.获取结点
    pos = m_AngleList.GetHeadPosition();
	while (pos != NULL)
	{
		pAngle = (PostureDataAngle *)m_PointList.GetNext(pos);
		if (pAngle == NULL) break;  

        CString szEquipPlace = pAngle->GetEquipPlace();
        if (szEquipPlace.Compare(szEquipPlace) == 0)
        {
            return pAngle;
        }
    }

    return NULL;
}

/**************************************************************************************************
函 数 名 :PrintData
功能描述 :调试打印
输入参数 :无
输出参数 :无
返 回 值 :void
**************************************************************************************************/
void DynamicData::PrintData()
{
    CStdioFile file;
    CString szFile("D:\\data2.txt");
    if (!file.Open(szFile, CFile::typeText|CFile::modeCreate|CFile::modeReadWrite))
    {
       LOG::E(_T("打开文件失败"));
       return ;
    }
    
    this->PrintPoint(&file);
    this->PrintAngle(&file);

    file.Close();
}


// 打印输出点数据
void DynamicData::PrintPoint(CStdioFile *pFile)
{
    POSITION   pos;
    PostureDataPoint *pPoint = NULL;
    CString szLine;

    szLine.Format("------------------------------------------------------------------------------------\n");
    pFile->WriteString(szLine);
    szLine.Format("taskId  equipCode  equipPlace  pointId   pointTitle       pointAX     pointAY     pointAZ \n");
    pFile->WriteString(szLine);

	pos = m_PointList.GetHeadPosition();
	while (pos != NULL)
	{
		pPoint = (PostureDataPoint *)m_PointList.GetNext(pos);
		if (pPoint != NULL)
		{
		    szLine.Format(" %d      %20s      %20s       %d       %s          %.3f           %.3f          %.3f\n" 
                          ,pPoint->GetTaskId()
                          ,pPoint->GetEquipCode()
                          ,pPoint->GetEquipPlace()
                          ,pPoint->GetPointId()
                          ,pPoint->GetPointTitle()
                          ,pPoint->GetPointAX()
                          ,pPoint->GetPointAY()
                          ,pPoint->GetPointAZ());
            pFile->WriteString(szLine);
		}
	}
}

// 打印输出Angle
void DynamicData::PrintAngle(CStdioFile *pFile)
{
    POSITION   pos;
    PostureDataAngle *pAngle = NULL;

    CString szLine;
    szLine.Format("-------------------------------------------------------------------------------------------------------------------------\n");
    pFile->WriteString(szLine);
    szLine.Format("  taskId    equipCode  equipPlace  lineid  lineTitle lineCode   startx starty  starty endx endy endz anglex angley anglez\n");
    pFile->WriteString(szLine);

	pos = m_AngleList.GetHeadPosition();
	while (pos != NULL)
	{
		pAngle = (PostureDataAngle *)m_AngleList.GetNext(pos);
		if (pAngle != NULL)
		{
		    szLine.Format(" %10d     %20s      %20s     %d       %20s      %20s       [%.3f     %.3f    %.3f]    [%.3f     %.3f     %.3f]     [%.3f      %.3f     %.3f]\n" 
                          ,pAngle->GetTaskId()
                          ,pAngle->GetEquipCode()
                          ,pAngle->GetEquipPlace()
                          ,pAngle->GetLineId()
                          ,pAngle->GetLineTitle()
                          ,pAngle->GetLineCode()
                          ,pAngle->GetLineStartX()
                          ,pAngle->GetLineStartY()
                          ,pAngle->GetLineStartY()
                          ,pAngle->GetLineEndX()
                          ,pAngle->GetLineEndY()
                          ,pAngle->GetLineEndY()
                          ,pAngle->GetAngleAX()
                          ,pAngle->GetAngleAY()
                          ,pAngle->GetAngleAZ());

            pFile->WriteString(szLine);
		}
	}
}