#include "stdAfx.h"
#include "CalcDestination.h"
//
//
//CalcDestination::CalcDestination()
//{
//	memset(&_calcData, 0 , sizeof(CALC_DES_DATA));
//	memset(&_airDropLocation, 0 , sizeof(DES_LOCATION));
//}
//
//CalcDestination::~CalcDestination()
//{
//}
//
///**********************************************
//* @func          setFlyParameter
//* @brief         设置飞机定位数据参数
//* @param		 DataFKD 飞机遥测
//**********************************************/
//void CalcDestination::setFlyLocationParameter(const DataFKD& data)
//{
//	_calcData.FlyCurrentLongitude = data.DataA2.GPSLongitude;//data.DataA8.OEM718DLon;
//	_calcData.FlyCurrentLatitude = data.DataA2.GPSLatitude;//data.DataA8.OEM718DLat;
//	_calcData.FlyCurrentHeight = data.DataA2.HBHeight;//data.DataA8.OEM718DAlt;
//}
//
///**********************************************
//* @func          setFlyAttitudeParmeter
//* @brief         设置飞机姿态数据参数
//* @param		 DataFKD 飞机遥测
//**********************************************/
//void CalcDestination::setFlyAttitudeParmeter(const DataFKD& data)
//{
//	_calcData.FlyHeadingAngle = data.DataA7.Heading;
//	_calcData.FlyPitchAngle = data.DataA7.Pitch;
//	_calcData.FlyRollAngle = data.DataA7.Roll;
//}
//
///**********************************************
//* @func          setPodAttitudeParmerter
//* @brief         设置吊舱姿态数据参数
//* @param		 DataFKD 飞机遥测
//**********************************************/
//void CalcDestination::setPodAttitudeParmerter(const DataFKD& data)
//{
//	_calcData.PodDirectionAngle = data.DataAC.sub1.PodYaw;
//	_calcData.PodPitchAngle = data.DataAC.sub1.PodPitch;
//	_calcData.PodRollAngle = data.DataAC.sub1.PodRoll;
//	_calcData.LaserDistance = data.DataAC.sub2.TargetDistance;//100;//data.DataAC.sub1. 激光测距距离参数
//}
//
///**********************************************
//* @func          setDesLocation
//* @brief         设置空投靶向目标点定位数据
//* @param		 DataFKD 飞机遥测
//**********************************************/
//void CalcDestination::setDesLocation(double lat, double lon, float height)
//{
//	_airDropLocation.Dislatitude = lat;
//	_airDropLocation.DisLongitude = lon;
//	_airDropLocation.DisHeight = height;
//}
//
///**********************************************
//* @func          calcDesLocation
//* @brief         根据飞机与吊舱姿态数据计算目标点的定位信息
//* @param		 DataFKD 飞机遥测
//**********************************************/
//void CalcDestination::calcDesLocation(DES_LOCATION& desLoaction)
//{
//	desLoaction = calcDisLocation2(_calcData);
//}
//
///**********************************************
//* @func          calcDesLocation
//* @brief         根据飞机与吊舱姿态数据计算目标点的定位信息
//* @param		 DataFKD 飞机遥测
//**********************************************/
//void CalcDestination::calcPodNeedAngle(POD_NEED_ANGLE& needAngle)
//{
//	auto angle = calcPodNeedAngle2(_calcData, _airDropLocation);
//	needAngle.directionAngle = angle.directionAngle;
//	needAngle.PitchAngle = angle.PitchAngle;
//}