20240702，98/985 天进吊舱+13所吊舱控制
CaoYuHui
9 months ago
parent
93690fb1cd
commit
ee4224a0fb
Binary file not shown.
Binary file not shown.
@ -0,0 +1,84 @@
|
|||||||
|
#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;
|
||||||
|
//}
|
||||||
@ -0,0 +1,34 @@
|
|||||||
|
#pragma once
|
||||||
|
#include "calc_api.h"
|
||||||
|
//#include "framelib/FrameFKD_JE.h"
|
||||||
|
//
|
||||||
|
//class CalcDestination : public CBCGPPropertyPage
|
||||||
|
//{
|
||||||
|
//public:
|
||||||
|
// CalcDestination();
|
||||||
|
// virtual ~CalcDestination();
|
||||||
|
//
|
||||||
|
// //设置飞机位置信息参数
|
||||||
|
// void setFlyLocationParameter(const DataFKD& data);
|
||||||
|
//
|
||||||
|
// //设置飞机姿态信息参数
|
||||||
|
// void setFlyAttitudeParmeter(const DataFKD& data);
|
||||||
|
//
|
||||||
|
// //设置吊舱姿态信息参数
|
||||||
|
// void setPodAttitudeParmerter(const DataFKD& data);
|
||||||
|
//
|
||||||
|
// //设置空投靶向目标点定位数据
|
||||||
|
// void setDesLocation(double lat, double lon, float height);
|
||||||
|
//
|
||||||
|
// //计算目标点位置
|
||||||
|
// void calcDesLocation(DES_LOCATION& desLoaction);
|
||||||
|
//
|
||||||
|
// //计算空投目标点转向与俯仰应变化的角度
|
||||||
|
// void calcPodNeedAngle(POD_NEED_ANGLE& needAngle);
|
||||||
|
//
|
||||||
|
//private:
|
||||||
|
// CALC_DES_DATA _calcData; //空投靶向目标需求飞机、吊舱相关数据
|
||||||
|
// DES_LOCATION _desLocation;//目标点位置信息
|
||||||
|
// DES_LOCATION _airDropLocation;//空投点位置信息
|
||||||
|
//};
|
||||||
|
//
|
||||||
@ -0,0 +1,42 @@
|
|||||||
|
#pragma once
|
||||||
|
#include "resource.h"
|
||||||
|
#include "global.h"
|
||||||
|
//#include "framelib/FrameFKD_JE.h"
|
||||||
|
//
|
||||||
|
//
|
||||||
|
//class CalcDestinationDLG :
|
||||||
|
// public CBCGPPropertyPage
|
||||||
|
//{
|
||||||
|
// DECLARE_DYNAMIC(CalcDestinationDLG)
|
||||||
|
//
|
||||||
|
//public:
|
||||||
|
// CalcDestinationDLG(CWnd* pParent = NULL);
|
||||||
|
// virtual ~CalcDestinationDLG();
|
||||||
|
//
|
||||||
|
// enum { IDD = IDD_DLG_AIR_DROP};
|
||||||
|
//
|
||||||
|
//protected:
|
||||||
|
// virtual void DoDataExchange(CDataExchange* pDX); // DDX/DDV Ö§³Ö
|
||||||
|
// //virtual BOOL OnInitDialog();
|
||||||
|
// DECLARE_MESSAGE_MAP()
|
||||||
|
//
|
||||||
|
//private:
|
||||||
|
// double _airDropLon;
|
||||||
|
// double _airDropLat;
|
||||||
|
// float _airDropHeight;
|
||||||
|
// POD_NEED_ANGLE _podNeedAngle;
|
||||||
|
// float _podYaw;
|
||||||
|
// float _podPitch;
|
||||||
|
// DES_LOCATION _desLocation;
|
||||||
|
//
|
||||||
|
// double _desLon;
|
||||||
|
// double _desLat;
|
||||||
|
// float _desHeight;
|
||||||
|
//public:
|
||||||
|
// afx_msg void onBtnClickedSetFlyLocation();
|
||||||
|
// afx_msg void onBtnClickedSetAirLocation();
|
||||||
|
// afx_msg void onBtnClickedCalcAngle();
|
||||||
|
// afx_msg void onBtnClickedCalc();
|
||||||
|
// afx_msg void OnBnClickedButtonTurn();
|
||||||
|
//};
|
||||||
|
//
|
||||||
Binary file not shown.
Loading…
Reference in New Issue