You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
85 lines
3.0 KiB
C++
85 lines
3.0 KiB
C++
#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;
|
|
//}
|