CN112486215B - 一种辅助飞行器装填的测控系统 - Google Patents

一种辅助飞行器装填的测控系统 Download PDF

Info

Publication number
CN112486215B
CN112486215B CN202011405821.5A CN202011405821A CN112486215B CN 112486215 B CN112486215 B CN 112486215B CN 202011405821 A CN202011405821 A CN 202011405821A CN 112486215 B CN112486215 B CN 112486215B
Authority
CN
China
Prior art keywords
aircraft
detection unit
pose detection
control system
box body
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202011405821.5A
Other languages
English (en)
Other versions
CN112486215A (zh
Inventor
郭文增
张方瑞
刘亚奇
赵愿
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Specialized Machinery
Original Assignee
Beijing Institute of Specialized Machinery
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Specialized Machinery filed Critical Beijing Institute of Specialized Machinery
Priority to CN202011405821.5A priority Critical patent/CN112486215B/zh
Publication of CN112486215A publication Critical patent/CN112486215A/zh
Application granted granted Critical
Publication of CN112486215B publication Critical patent/CN112486215B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • G05D3/20Control of position or direction using feedback using a digital comparing device
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64FGROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
    • B64F1/00Ground or aircraft-carrier-deck installations
    • B64F1/36Other airport installations
    • GPHYSICS
    • G08SIGNALLING
    • G08CTRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
    • G08C17/00Arrangements for transmitting signals characterised by the use of a wireless electrical link
    • G08C17/02Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明涉及一种辅助飞行器装填的测控系统,属于飞行器装填技术领域。使用本测控系统,可以实时检测并显示飞行器相对于箱体的位姿差,并给出操作者操作提示信息,提高装填作业的效率和操作安全性,与现有的装填车配合可实现半自主甚至完全自主装填,可以大大提高装填的效率及操作安全性,为实现全自动装填奠定基础。

Description

一种辅助飞行器装填的测控系统
技术领域
本发明涉及飞行器装填技术领域,具体涉及一种辅助飞行器装填的测控系统。
背景技术
飞行器装填的作业效率影响着飞行器发射的效率,从而对战争的成败起着重要作用,飞行器装填设备越来越受到各国军方的重视。大型飞行器需要多点支撑,所以大型飞行器的装填车含有1个推车(主要采用液力或电力驱动,提供飞行器进出箱的推拉力)和多个支车(主要采用手动或电动方式,用于调整飞行器和箱体的对准)。在装填过程中,需要多名操作者协同调整各支车的支撑以保证飞行器和箱体的位姿对准;而各支车的调整引起飞行器挠性变形从而使相对位姿改变,此时需要重新调整相关支车来对准,否则有可能造成装填力过大甚至破坏飞行器。采用上述边监测装填力边调节支撑小车的反复作业方式,导致装填效率低下而且存在安全隐患。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是:如何设计一种辅助飞行器装填的测控系统。
(二)技术方案
为了解决上述技术问题,本发明提供了一种辅助飞行器装填的测控系统,包括飞行器与箱体相对位姿检测单元和计算机控制系统,可辅助进行飞行器装填工作;
所述飞行器与箱体相对位姿检测单元包括位姿检测单元,位姿检测单元的壳体加工成异型形状,与飞行器末端面配合安装,通过螺钉可将各个位姿检测单元固定在对应的位置上;位姿检测单元包括单片机、双轴倾角传感器、超声波传感器,通过所述双轴倾角传感器检测飞行器的绝对俯仰角和绝对翻滚角;通过所述超声波传感器分别检测飞行器和箱体的升降位移差和横向位移差,单片机用于基于超声波传感器计算飞行器相对于箱体的偏航角差;
所述计算机控制系统用于通过和飞行器与箱体相对位姿检测单元进行通信,实时地基于飞行器和箱体的升降位移差和横向位移差显示飞行器相对于箱体的位姿差,对整个装填过程进行三维动态显示,并给出操作者操作提示信息。
优选地,所述位姿检测单元通过Zigbee无线方式和计算机控制系统进行通信,然后安装在飞行器末端面的矩形凹槽;位姿检测单元安装完成后,通过其内部的基于重力作用的双轴倾角传感器可读取飞行器的绝对俯仰角Rd和绝对翻滚角Pd,而飞行器相对于箱体的偏航角差ΔYd则由单片机通过以下计算方法得到:
前、后安装的两组超声波传感器的固定安装距离为S,分别读取到的飞行器到箱体侧壁的距离为S和S,则偏航角差
Figure BDA0002814114120000021
优选地,所述计算机控制系统通过Zigbee总线接收位姿检测单元的位姿信息,并实时显示检测到的飞行器相对于箱体的相对位姿差,包括俯仰角差ΔR、翻滚角差ΔP、偏航角差ΔYd、升降位移差ΔL、横向位移差ΔT,其中通过调整使姿态差接近为0时,得到飞行器和箱体的升降位移差ΔL和横向位移差ΔT。
优选地,所述位姿检测单元还包括充电接口、锂电池,充电接口用于锂电池的充电,锂电池用于位姿检测单元的供电。
优选地,所述位姿检测单元还包括电源开关,用于实现位姿检测单元的开启与关闭。
优选地,所述位姿检测单元还包括显示屏,用来显示电量等信息。
优选地,所述飞行器6末端面的矩形凹槽的位置在飞行器加工中保证:上下矩形凹槽中心点连线和左右矩形凹槽中心点连线正交,且左右矩形凹糟中心点连线和两侧弹翼对称点连线平行;每个位姿检测单元的后端加工成T型块,飞行器末端面加工的凹槽与位姿检测单元的T型块配合定位,然后通过锁定孔将位姿检测单元锁定在飞行器上。
优选地,所述单片机为CC2530单片机。
本发明还提供了一种所述的系统的工作方法。
本发明还提供了一种所述的系统在飞行器装填技术领域中的应用。
(三)有益效果
使用本测控系统,可以实时检测并显示飞行器相对于箱体的位姿差,并给出操作者操作提示信息,提高装填作业的效率和操作安全性,与现有的装填车配合可实现半自主甚至完全自主装填,可以大大提高装填的效率及操作安全性,为实现全自动装填奠定基础。
附图说明
图1是本发明的辅助飞行器装填测控系统图;
图2是飞行器转运车和箱体图;
图3是飞行器装填车和飞行器图;
图4是本发明中的位姿检测单元组成示意图。
图中:1、箱体;2、飞行器装运车;3、底盘;4、推车;5、支车;6、飞行器;7、位姿检测单元;8、单片机;9、充电接口;10、电源开关;11、锂电池;12、双轴倾角传感器;13、前超声波传感器;14、后超声波传感器;15、显示屏;16、Zigbee天线。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
本发明提供一种辅助飞行器装填的测控系统,主要包括飞行器与箱体相对位姿检测单元和计算机控制系统,可辅助进行飞行器装填工作;
所述飞行器与箱体相对位姿检测单元包括四个相同的位姿检测单元,每个位姿检测单元的壳体加工成异型形状,与飞行器末端面配合安装,通过螺钉可将各个位姿检测单元固定在对应的位置上;每个位姿检测单元主要由单片机、充电接口、电源开关、锂电池、双轴倾角传感器、超声波传感器和显示屏组成:通过所述双轴倾角传感器检测飞行器的绝对俯仰角和绝对翻滚角;通过所述超声波传感器分别检测飞行器和箱体的升降位移差和横向位移差,单片机用于基于超声波传感器计算飞行器相对于箱体的偏航角差。
所述计算机控制系统包括触屏一体机和测控软件,用于通过和飞行器与箱体相对位姿检测单元进行通信,实时地基于飞行器和箱体的升降位移差和横向位移差显示飞行器相对于箱体的位姿差,对整个装填过程进行三维动态显示,并给出操作者操作提示信息。
所述位姿检测单元通过Zigbee无线方式和计算机控制系统进行通信,然后安装在飞行器末端面的矩形凹槽(如图1所示,为了安装所述位姿检测单元,在飞行器的末端面上加工有矩形凹槽作为安装基准);位姿检测单元安装完成后,通过其内部的基于重力作用的双轴倾角传感器可以方便地读取飞行器的绝对俯仰角Rd和绝对翻滚角Pd(相对于大地坐标系),而飞行器相对于箱体的偏航角差ΔYd则通过以下计算方法得到:
位姿检测单元前、后安装的两组超声波传感器的固定安装距离为S,分别读取到的飞行器到箱体侧壁的距离为S和S,则偏航角差
Figure BDA0002814114120000051
通过机构的调整使姿态差接近为0时,此时飞行器和箱体的升降位移差ΔL=|S-S|和横向位移差ΔT=|S-S|。
所述计算机控制系统,通过Zigbee总线接收位姿检测单元的位姿信息,并留有232总线、485总线、CAN总线接口便于和装填车的控制系统通信扩展;测控软件能够实时显示检测到的飞行器相对于箱体的相对位姿差,包括俯仰角差ΔR、翻滚角差ΔP、偏航角差ΔYd、升降位移差ΔL、横向位移差ΔT。
下面结合图2、图3、图4说明本发明的辅助飞行器装填测控系统的工作原理。
如图2和图3所示,现在主流的飞行器装填系统主要包括飞行器转运车2和飞行器装填车两部分:其中飞行器转运车2用于箱体1的转运工作;而飞行器装填车主要由推车4和支车5组成,用来将飞行器6装入箱体1,用于飞行器的进出箱。四个相同的位姿检测单元7安装在飞行器6末端面的凹槽中(凹槽的位置需要在飞行器加工中保证,上下凹槽中心点连线和左右凹槽中心点连线正交,且左右凹糟中心点连线和两侧弹翼对称点连线平行);每个位姿检测单元7的后端加工成T型块,飞行器6末端面加工的凹槽与位姿检测单元的T型块配合定位,然后通过锁定孔将位姿检测单元7锁定在飞行器6上。
如图3和图4所示,位姿检测单元7内部安装有双轴倾角传感器12,用于检测飞行器6的绝对俯仰角Rd和绝对翻滚角Pd(相对于大地坐标系),然后通过倾角仪对箱体的绝对俯仰角Rx和绝对翻滚角Px进行一次型测量,并将数值填写到计算机控制系统的测控软件中,飞行器6和箱体1的俯仰角差ΔR、翻滚角差ΔP将自动解算并实时显示在触屏一体机屏幕上;偏航角差ΔYd(飞行器6相对于箱体1)则通过左(右)安装的位姿检测单元7计算得到:位姿检测单元7的前超声波传感器13和后超声波传感器14的固定安装距离为S,分别读取到的到箱体侧壁的距离为S和S,则相对偏航角
Figure BDA0002814114120000061
通过机构的调整使姿态差接近为0时,此时飞行器6和箱体1的升降位移差ΔL=|S-S|和横向位移差ΔT=|S-S|。除了双轴倾角传感器12、前超声波传感器13、后超声波传感器14外,位姿检测单元7还包括CC2530单片机8(集成了无线Zigbee协议,用于位姿计算及通过Zigbee天线16和计算机控制系统的通信)、充电接口9(用于锂电池的充电)、电源开关10(用于位姿检测单元7的开启与关闭)、锂电池(用于位姿检测单元7的供电)、显示屏15(主要用来显示电量等信息)等。
计算机控制系统包括一块带有触摸屏的工控一体机和软件系统。计算机控制系统按照操作者的使用习惯可以安装到车体的任一合适位置,通过三维建模软件建立飞行器6和箱体1整体的三维模型,通过立体图像实时动态显示二者之间的相对俯仰角差ΔR、翻滚角差ΔP、偏航角差ΔYd、升降位移差ΔL、横向位移差ΔT。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。

Claims (8)

1.一种辅助飞行器装填的测控系统,其特征在于,包括飞行器与箱体相对位姿检测单元和计算机控制系统,辅助进行飞行器装填工作;
所述飞行器与箱体相对位姿检测单元包括位姿检测单元,位姿检测单元的壳体加工成异型形状,与飞行器末端面配合安装,通过螺钉将各个位姿检测单元固定在对应的位置上;位姿检测单元包括单片机、双轴倾角传感器、超声波传感器,通过所述双轴倾角传感器检测飞行器的绝对俯仰角和绝对翻滚角;通过所述超声波传感器分别检测飞行器和箱体的升降位移差和横向位移差,单片机用于基于超声波传感器计算飞行器相对于箱体的偏航角差;
所述计算机控制系统用于通过和飞行器与箱体相对位姿检测单元进行通信,实时地基于飞行器和箱体的俯仰角差、翻滚角差、偏航角差、升降位移差和横向位移差显示飞行器相对于箱体的位姿差,对整个装填过程进行三维动态显示,并给出操作者操作提示信息。
2.如权利要求1所述的测控系统,其特征在于,所述位姿检测单元通过Zigbee无线方式和计算机控制系统进行通信,然后安装在飞行器末端面的矩形凹槽;位姿检测单元安装完成后,通过其内部的基于重力作用的双轴倾角传感器可读取飞行器的绝对俯仰角Rd和绝对翻滚角Pd,而飞行器相对于箱体的偏航角差ΔYd则由单片机通过以下计算方法得到:
前、后安装的两组超声波传感器的固定安装距离为S,分别读取到的飞行器到箱体侧壁的距离为S和S,则偏航角差
Figure FDA0003894252660000021
3.如权利要求1所述的测控系统,其特征在于,所述位姿检测单元还包括充电接口、锂电池,充电接口用于锂电池的充电,锂电池用于位姿检测单元的供电。
4.如权利要求1所述的测控系统,其特征在于,所述位姿检测单元还包括电源开关,用于实现位姿检测单元的开启与关闭。
5.如权利要求1所述的测控系统,其特征在于,所述位姿检测单元还包括显示屏,用来显示电量信息。
6.如权利要求2所述的测控系统,其特征在于,所述飞行器末端面的矩形凹槽的位置在飞行器加工中保证:上下矩形凹槽中心点连线和左右矩形凹槽中心点连线正交,且左右矩形凹糟中心点连线和两侧弹翼对称点连线平行;每个位姿检测单元的后端加工成T型块,飞行器末端面加工的凹槽与位姿检测单元的T型块配合定位,然后通过锁定孔将位姿检测单元锁定在飞行器上。
7.如权利要求1所述的测控系统,其特征在于,所述单片机为CC2530单片机。
8.一种如权利要求1至7中任一项所述的系统在飞行器装填技术领域中的应用。
CN202011405821.5A 2020-12-02 2020-12-02 一种辅助飞行器装填的测控系统 Active CN112486215B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011405821.5A CN112486215B (zh) 2020-12-02 2020-12-02 一种辅助飞行器装填的测控系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011405821.5A CN112486215B (zh) 2020-12-02 2020-12-02 一种辅助飞行器装填的测控系统

Publications (2)

Publication Number Publication Date
CN112486215A CN112486215A (zh) 2021-03-12
CN112486215B true CN112486215B (zh) 2022-12-02

Family

ID=74939797

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011405821.5A Active CN112486215B (zh) 2020-12-02 2020-12-02 一种辅助飞行器装填的测控系统

Country Status (1)

Country Link
CN (1) CN112486215B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116243643B (zh) * 2023-05-11 2023-07-21 航天极创物联网研究院(南京)有限公司 一种超长刚体的水平装填测控系统以及水平装填系统

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006051893A (ja) * 2004-08-12 2006-02-23 Seiko Epson Corp 位置・姿勢検出システム
CN108119140B (zh) * 2017-12-29 2019-10-15 郑州智谷工业技术有限公司 一种采煤机掘进姿态调整系统
CN110081878B (zh) * 2019-05-17 2023-01-24 东北大学 一种多旋翼无人机的姿态及位置确定方法
CN110132268A (zh) * 2019-06-10 2019-08-16 西北工业大学 一种车载飞行器初始姿态获取方法
CN210221110U (zh) * 2019-07-31 2020-03-31 浙江理工大学 微型飞行器航空姿态测量显示装置

Also Published As

Publication number Publication date
CN112486215A (zh) 2021-03-12

Similar Documents

Publication Publication Date Title
EP2500311B1 (en) Crane jib attitude and heading reference system and method
CN107168186B (zh) 基于六轴组合传感器的四点自动调平系统及其工作方法
CN109579831B (zh) 矿用悬臂式掘进机可视化辅助导引方法和系统
WO2018155709A1 (ja) ダンプトラック及び後退支援装置
CN112486215B (zh) 一种辅助飞行器装填的测控系统
CN104101326B (zh) 一种基于空间几何分析的盾构姿态自动测量方法及装置
WO2018179596A1 (ja) 建設機械
CN105300339A (zh) 用于将区段对准的方法和设备
US20180169768A1 (en) Machine tool with an assembly configuration with a cantilevered tool
CN112731930A (zh) 一种基于惯性导航装置的悬臂式掘进机控制系统
CN111823228A (zh) 一种室内跟随机器人系统和运行方法
KR20220153299A (ko) 천공 장치 및 이를 포함하는 천공 관리 시스템
CN109814561A (zh) 受矿位姿确定方法、装置、系统及存储介质
CN101010558A (zh) 用于确定机动车辆的车轮对准的设备
CN108928327B (zh) 升降控制方法、装置以及换电站、控制器和介质
CN113858193A (zh) 电池抓取方法和装置
CN218865001U (zh) 一种预埋槽道智能检测系统
CN208085855U (zh) 一种基于轮毂电机的移动机器人底盘装置
CN114800518B (zh) 基于嵌入式框架的多移动机器人协同控制实验平台
CN207273234U (zh) 一种导向机器人
CN104908605A (zh) 一种模块化锂电池的bms分散检测集中管理系统
CN109084932A (zh) 一种调整六维力/力矩传感器标校坐标系的方法和系统
WO2021010108A1 (ja) ガイダンスシステム
CN114322982A (zh) 一种铰接式底盘结构凿岩台车的车体定位装置及方法
CN210348274U (zh) 一种具有姿态调整功能的管道机器人

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant