一种控制无人机超视距丢GPS后返航到HOME位置的方法及装置

基本信息

申请号 CN201910203640.5 申请日 -
公开(公告)号 CN109839113A 公开(公告)日 2019-06-04
申请公布号 CN109839113A 申请公布日 2019-06-04
分类号 G01C21/20(2006.01)I; G01C21/16(2006.01)I; G01S19/49(2010.01)I; G05D1/10(2006.01)I 分类 测量;测试;
发明人 敬文义; 王鹏; 张生德 申请(专利权)人 成都中科遥数智创科技有限公司
代理机构 北京国谦专利代理事务所(普通合伙) 代理人 成都中科遥数智创科技有限公司
地址 610000 四川省成都市天府新区华阳街道长江东二路56号1栋1层1室
法律状态 -

摘要

摘要 本发明提供一种控制无人机超视距丢GPS后返航到HOME位置的方法,包括标定HOME位置的坐标P0;利用惯导估算其决定返航的位置坐标P1、返航速度V以及无人机此刻的航向信息H0;根据HOME位置的坐标P0、决定返航的位置坐标P1、返航速度V和预设的无人机盘旋半径R,获取无人机实际返航的位置坐标P2及无人机横滚的姿态角以及坐标P1和P0之间的连线与坐标P2和P0之间的连线的夹角β;根据航向信息H0与夹角β,获取无人机实际返航时的航向信息H1;根据P2和P0之间的距离以及飞机返航的速度V,获取无人机的返航时间T;命令无人机盘旋至P2位置时,沿航向H1以横滚姿态角的方式飞行时间T后,即返航到HOME位置。本发明的方法能够精确地控制无人机返航到HOME位置。