一种巡逻车用路线循迹方法
基本信息
申请号 | CN202011405525.5 | 申请日 | - |
公开(公告)号 | CN112697128A | 公开(公告)日 | 2021-04-23 |
申请公布号 | CN112697128A | 申请公布日 | 2021-04-23 |
分类号 | G01C21/00 | 分类 | 测量;测试; |
发明人 | 周晓宇;陈传飞;薛巨峰;范东睿 | 申请(专利权)人 | 盐城中科高通量计算研究院有限公司 |
代理机构 | 南京众联专利代理有限公司 | 代理人 | 刘趁新 |
地址 | 224000 江苏省盐城市盐都区盐龙街道智能终端创业园二期14号楼 | ||
法律状态 | - |
摘要
摘要 | 本发明一种巡逻车用路线循迹方法,根据远程指令,加载对应路线问题,对路线文件进行解析处理;模拟车辆行驶轨迹,对路线可行性进行检查;获取高精度定位数据,判断定位精度是否符合要求;将路线切割成若干个段;转换坐标系;根据车辆实时位置计算车辆与偏差值;通过车辆实时位置和航向,得出向量方程,对两个方程式的斜率求差,得出航向偏差值,点到直线的距离得出中心偏移距离;根据车辆偏差值,计算出车辆应调整参数,最后加上累计偏差进行调节修正;根据雷达反馈,判断车辆周边状态;下发控制指令,通过对路线文件进行解析处理,模拟车辆行驶轨迹,对路线可行性进行检查,最后再根据雷达反馈,判断车辆周边状态,下发控制指令。 |
