|
|
|
|
|
#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 <20><><EFBFBD>÷ɻ<C3B7><C9BB><EFBFBD>λ<EFBFBD><CEBB><EFBFBD>ݲ<EFBFBD><DDB2><EFBFBD>
|
|
|
|
|
|
//* @param DataFKD <20>ɻ<EFBFBD>ң<EFBFBD><D2A3>
|
|
|
|
|
|
//**********************************************/
|
|
|
|
|
|
//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 <20><><EFBFBD>÷ɻ<C3B7><C9BB><EFBFBD>̬<EFBFBD><CCAC><EFBFBD>ݲ<EFBFBD><DDB2><EFBFBD>
|
|
|
|
|
|
//* @param DataFKD <20>ɻ<EFBFBD>ң<EFBFBD><D2A3>
|
|
|
|
|
|
//**********************************************/
|
|
|
|
|
|
//void CalcDestination::setFlyAttitudeParmeter(const DataFKD& data)
|
|
|
|
|
|
//{
|
|
|
|
|
|
// _calcData.FlyHeadingAngle = data.DataA7.Heading;
|
|
|
|
|
|
// _calcData.FlyPitchAngle = data.DataA7.Pitch;
|
|
|
|
|
|
// _calcData.FlyRollAngle = data.DataA7.Roll;
|
|
|
|
|
|
//}
|
|
|
|
|
|
//
|
|
|
|
|
|
///**********************************************
|
|
|
|
|
|
//* @func setPodAttitudeParmerter
|
|
|
|
|
|
//* @brief <20><><EFBFBD>õ<EFBFBD><C3B5><EFBFBD><EFBFBD><EFBFBD>̬<EFBFBD><CCAC><EFBFBD>ݲ<EFBFBD><DDB2><EFBFBD>
|
|
|
|
|
|
//* @param DataFKD <20>ɻ<EFBFBD>ң<EFBFBD><D2A3>
|
|
|
|
|
|
//**********************************************/
|
|
|
|
|
|
//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. <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|
|
|
|
|
//}
|
|
|
|
|
|
//
|
|
|
|
|
|
///**********************************************
|
|
|
|
|
|
//* @func setDesLocation
|
|
|
|
|
|
//* @brief <20><><EFBFBD>ÿ<EFBFBD>Ͷ<EFBFBD><CDB6><EFBFBD><EFBFBD>Ŀ<EFBFBD><C4BF><EFBFBD>㶨λ<E3B6A8><CEBB><EFBFBD><EFBFBD>
|
|
|
|
|
|
//* @param DataFKD <20>ɻ<EFBFBD>ң<EFBFBD><D2A3>
|
|
|
|
|
|
//**********************************************/
|
|
|
|
|
|
//void CalcDestination::setDesLocation(double lat, double lon, float height)
|
|
|
|
|
|
//{
|
|
|
|
|
|
// _airDropLocation.Dislatitude = lat;
|
|
|
|
|
|
// _airDropLocation.DisLongitude = lon;
|
|
|
|
|
|
// _airDropLocation.DisHeight = height;
|
|
|
|
|
|
//}
|
|
|
|
|
|
//
|
|
|
|
|
|
///**********************************************
|
|
|
|
|
|
//* @func calcDesLocation
|
|
|
|
|
|
//* @brief <20><><EFBFBD>ݷɻ<DDB7><C9BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̬<EFBFBD><CCAC><EFBFBD>ݼ<EFBFBD><DDBC><EFBFBD>Ŀ<EFBFBD><C4BF><EFBFBD><EFBFBD><EFBFBD>Ķ<EFBFBD>λ<EFBFBD><CEBB>Ϣ
|
|
|
|
|
|
//* @param DataFKD <20>ɻ<EFBFBD>ң<EFBFBD><D2A3>
|
|
|
|
|
|
//**********************************************/
|
|
|
|
|
|
//void CalcDestination::calcDesLocation(DES_LOCATION& desLoaction)
|
|
|
|
|
|
//{
|
|
|
|
|
|
// desLoaction = calcDisLocation2(_calcData);
|
|
|
|
|
|
//}
|
|
|
|
|
|
//
|
|
|
|
|
|
///**********************************************
|
|
|
|
|
|
//* @func calcDesLocation
|
|
|
|
|
|
//* @brief <20><><EFBFBD>ݷɻ<DDB7><C9BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̬<EFBFBD><CCAC><EFBFBD>ݼ<EFBFBD><DDBC><EFBFBD>Ŀ<EFBFBD><C4BF><EFBFBD><EFBFBD><EFBFBD>Ķ<EFBFBD>λ<EFBFBD><CEBB>Ϣ
|
|
|
|
|
|
//* @param DataFKD <20>ɻ<EFBFBD>ң<EFBFBD><D2A3>
|
|
|
|
|
|
//**********************************************/
|
|
|
|
|
|
//void CalcDestination::calcPodNeedAngle(POD_NEED_ANGLE& needAngle)
|
|
|
|
|
|
//{
|
|
|
|
|
|
// auto angle = calcPodNeedAngle2(_calcData, _airDropLocation);
|
|
|
|
|
|
// needAngle.directionAngle = angle.directionAngle;
|
|
|
|
|
|
// needAngle.PitchAngle = angle.PitchAngle;
|
|
|
|
|
|
//}
|
