一种基于机器狗的无人机临时机巢控制方法、系统及设备与流程
本发明涉及无人机机巢,尤其涉及一种基于机器狗的无人机临时机巢控制方法、系统及设备。
背景技术:
1、现有无人机机巢控制方法中,无人机机巢直接安装在地面机器狗上,且该地面机器狗持续跟随无人机同步移动,始终位于无人机正下方区域,以确保无人机在任意时刻均可进行下降充电。在无人机执行任务期间,机器狗大部分飞行时间处于非充电状态,但是搭载机巢的地面机器狗为保持始终位于无人机正下方的跟随状态,必须持续移动以匹配无人机的空间位置变化,导致机器狗在绝大多数时间内处于无效移动或低效移动状态,增加了电量消耗,缩短了机器狗的可持续作业时长,存在资源浪费问题。同时,这种方法采用固定尺寸的无人机机巢,只能针对单一尺寸的无人机进行一对一充电,当同一作业区域内存在多型号无人机混合作业时,需要配置多台搭载无人机机巢的机器狗进行充电,增加了设备采购成本,存在部署灵活性差的问题。
技术实现思路
1、本发明实施例提供一种基于机器狗的无人机临时机巢控制方法、系统及设备,以解决现有技术中无人机机巢控制方法存在的资源浪费和部署灵活性差的问题。
2、第一方面,本发明提供一种基于机器狗的无人机临时机巢控制方法,所述基于机器狗的无人机临时机巢控制方法包括:
3、步骤100,控制终端获取目标无人机的第一位置坐标、第一剩余电量、电池总容量、对角线电机轴距、起落架高度和机身最大宽度,机器狗的第二位置坐标,以及n个待选的充电位置坐标;n为正整数;
4、步骤200,所述控制终端根据所述对角线电机轴距、所述起落架高度及所述机身最大宽度,确定所述机器狗的四肢向上抬起的四肢目标展开跨度和四肢目标提升高度;
5、步骤300,所述控制终端根据所述四肢目标展开跨度和所述四肢目标提升高度,确定所述机器狗从站立状态转换为趴卧状态下的目标髋关节角度和目标膝关节角度,将所述四肢目标展开跨度、所述四肢目标提升高度、所述目标髋关节角度及所述目标膝关节角度发送给所述机器狗;
6、步骤400,所述控制终端根据所述第一位置坐标、所述第二位置坐标、n个所述待选的充电位置坐标、所述第一剩余电量、所述电池总容量、所述目标髋关节角度及所述目标膝关节角度,确定所述目标无人机和所述机器狗到达n个所述待选的充电位置坐标的综合能源消耗值,选择n个所述综合能源消耗值中的最小值对应的待选的充电位置坐标作为所述目标无人机的实际充电位置坐标,将所述实际充电位置坐标发送给所述目标无人机和所述机器狗;
7、步骤500,所述机器狗到达所述实际充电位置坐标,根据所述四肢目标展开跨度、所述四肢目标提升高度、所述目标髋关节角度及所述目标膝关节角度转动四肢,从站立状态转换为趴卧状态,实现临时机巢的搭建。
8、第二方面,本发明提供一种基于机器狗的无人机临时机巢控制系统,所述基于机器狗的无人机临时机巢控制系统包括目标无人机、机器狗以及控制终端,所述控制终端分别与所述目标无人机和所述机器狗通信连接,所述目标无人机与所述机器狗通信连接;
9、所述控制终端用于:
10、获取所述目标无人机的第一位置坐标、第一剩余电量、电池总容量、对角线电机轴距、起落架高度和机身最大宽度,所述机器狗的第二位置坐标,以及n个待选的充电位置坐标;n为正整数;
11、根据所述对角线电机轴距、所述起落架高度及所述机身最大宽度,确定所述机器狗的四肢向上抬起的四肢目标展开跨度和四肢目标提升高度;
12、根据所述四肢目标展开跨度和所述四肢目标提升高度,确定所述机器狗从站立状态转换为趴卧状态下的目标髋关节角度和目标膝关节角度,将所述四肢目标展开跨度、所述四肢目标提升高度、所述目标髋关节角度及所述目标膝关节角度发送给所述机器狗;
13、根据所述第一位置坐标、所述第二位置坐标、n个所述待选的充电位置坐标、所述第一剩余电量、所述电池总容量、所述目标髋关节角度及所述目标膝关节角度,确定所述目标无人机和所述机器狗到达n个所述待选的充电位置坐标的综合能源消耗值,选择n个所述综合能源消耗值中的最小值对应的待选的充电位置坐标作为所述目标无人机的实际充电位置坐标,将所述实际充电位置坐标发送给所述目标无人机和所述机器狗;
14、所述机器狗用于:
15、到达所述实际充电位置坐标,根据所述四肢目标展开跨度、所述四肢目标提升高度、所述目标髋关节角度及所述目标膝关节角度转动四肢,从站立状态转换为趴卧状态,实现临时机巢的搭建;
16、获取各个机器狗肢端定位点的面积和各个所述机器狗肢端定位点的位置坐标,将各个所述机器狗肢端定位点的面积和各个所述机器狗肢端定位点的位置坐标发送给所述目标无人机;
17、根据所述目标无人机发送的目标飞行姿态角和四肢目标提升高度,确定所述机器狗的四肢实际抬升高度,根据所述四肢实际抬升高度,完成临时机巢的搭建优化;
18、所述目标无人机用于:
19、到达所述实际充电位置坐标,获取第三位置坐标、第一飞行速度、飞行姿态角和机器狗图像;
20、根据所述机器狗图像、各个所述机器狗肢端定位点的面积及各个所述机器狗肢端定位点的位置坐标,确定所述目标无人机的速度矢量偏差;
21、根据所述第三位置坐标、所述第一飞行速度及所述飞行姿态角,确定所述目标无人机的目标飞行姿态角,将所述目标飞行姿态角发送给机器狗;
22、根据所述速度矢量偏差和所述四肢实际抬升高度,完成自主降落和充电。
23、第三方面,本发明提供一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如第一方面所述的基于机器狗的无人机临时机巢控制方法。
24、上述基于机器狗的无人机临时机巢控制方法,控制终端获取目标无人机的第一位置坐标、第一剩余电量、电池总容量、对角线电机轴距、起落架高度和机身最大宽度,机器狗的第二位置坐标,以及各个待选的充电位置坐标;随后控制终端根据对角线电机轴距、起落架高度及机身最大宽度,确定机器狗的四肢向上抬起的四肢目标展开跨度和四肢目标提升高度;控制终端根据四肢目标展开跨度和四肢目标提升高度,确定机器狗从站立状态转换为趴卧状态下的目标髋关节角度和目标膝关节角度,并将四肢目标展开跨度、四肢目标提升高度、目标髋关节角度及目标膝关节角度发送给机器狗;控制终端根据第一位置坐标、第二位置坐标、各个待选的充电位置坐标、第一剩余电量、电池总容量、目标髋关节角度及目标膝关节角度,确定目标无人机和机器狗到达各个待选的充电位置坐标的综合能源消耗值,选择各个综合能源消耗值中的最小值对应的待选的充电位置坐标作为目标无人机的实际充电位置坐标,将实际充电位置坐标发送给目标无人机和机器狗;最后机器狗到达所述实际充电位置坐标,根据所述四肢目标展开跨度、所述四肢目标提升高度、所述目标髋关节角度及所述目标膝关节角度转动四肢,从站立状态转换为趴卧状态,实现临时机巢的搭建。
25、相对现有技术,本发明针对现有固定式无人机机巢只能适配单一型号无人机问题,通过控制终端获取目标无人机的对角线电机轴距、起落架高度及机身最大宽度等物理参数,自适应解算四肢目标展开跨度与目标趴卧高度,并进一步通过逆运动学求解目标髋关节角度与目标膝关节角度,使同一机器狗能够根据不同类型无人机的尺寸参数动态调整笼式机巢的空间构型,实现了单一机器狗对多型号无人机的兼容适配,有效降低了多机型作业场景下的设备部署成本与运维复杂度,提升了无人机机巢部署的灵活性;同时针对现有机器狗因长期处于无效移动状态,存在严重的资源浪费问题,引入基于无人机第一位置坐标、第一剩余电量、电池总容量,机器狗第二位置坐标,以及各待选充电位置坐标等多源信息的综合能源消耗值评估机制,通过综合考量无人机飞抵充电点的飞行能耗、机器狗移动至充电点的地面移动能耗、充电能量消耗以及机器狗四肢展开能耗等多维指标,选择综合能源消耗值最小的位置作为实际充电位置坐标,使机器狗仅在需要执行充电任务时按最优路径移动至目标位置,避免了跟随模式下机器狗的冗余移动能耗,显著提升了机器狗的能源利用效率与可持续作业时长。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com