一种巡逻车用路线循迹方法

基本信息

申请号 CN202011405525.5 申请日 -
公开(公告)号 CN112697128A 公开(公告)日 2021-04-23
申请公布号 CN112697128A 申请公布日 2021-04-23
分类号 G01C21/00 分类 测量;测试;
发明人 周晓宇;陈传飞;薛巨峰;范东睿 申请(专利权)人 盐城中科高通量计算研究院有限公司
代理机构 南京众联专利代理有限公司 代理人 刘趁新
地址 224000 江苏省盐城市盐都区盐龙街道智能终端创业园二期14号楼
法律状态 -

摘要

摘要 本发明一种巡逻车用路线循迹方法,根据远程指令,加载对应路线问题,对路线文件进行解析处理;模拟车辆行驶轨迹,对路线可行性进行检查;获取高精度定位数据,判断定位精度是否符合要求;将路线切割成若干个段;转换坐标系;根据车辆实时位置计算车辆与偏差值;通过车辆实时位置和航向,得出向量方程,对两个方程式的斜率求差,得出航向偏差值,点到直线的距离得出中心偏移距离;根据车辆偏差值,计算出车辆应调整参数,最后加上累计偏差进行调节修正;根据雷达反馈,判断车辆周边状态;下发控制指令,通过对路线文件进行解析处理,模拟车辆行驶轨迹,对路线可行性进行检查,最后再根据雷达反馈,判断车辆周边状态,下发控制指令。