一種巡邏車用路線循跡方法

基本信息

申請?zhí)?/td> CN202011405525.5 申請日 -
公開(公告)號 CN112697128A 公開(公告)日 2021-04-23
申請公布號 CN112697128A 申請公布日 2021-04-23
分類號 G01C21/00 分類 測量;測試;
發(fā)明人 周曉宇;陳傳飛;薛巨峰;范東睿 申請(專利權(quán))人 鹽城中科高通量計算研究院有限公司
代理機構(gòu) 南京眾聯(lián)專利代理有限公司 代理人 劉趁新
地址 224000 江蘇省鹽城市鹽都區(qū)鹽龍街道智能終端創(chuàng)業(yè)園二期14號樓
法律狀態(tài) -

摘要

摘要 本發(fā)明一種巡邏車用路線循跡方法,根據(jù)遠程指令,加載對應(yīng)路線問題,對路線文件進行解析處理;模擬車輛行駛軌跡,對路線可行性進行檢查;獲取高精度定位數(shù)據(jù),判斷定位精度是否符合要求;將路線切割成若干個段;轉(zhuǎn)換坐標(biāo)系;根據(jù)車輛實時位置計算車輛與偏差值;通過車輛實時位置和航向,得出向量方程,對兩個方程式的斜率求差,得出航向偏差值,點到直線的距離得出中心偏移距離;根據(jù)車輛偏差值,計算出車輛應(yīng)調(diào)整參數(shù),最后加上累計偏差進行調(diào)節(jié)修正;根據(jù)雷達反饋,判斷車輛周邊狀態(tài);下發(fā)控制指令,通過對路線文件進行解析處理,模擬車輛行駛軌跡,對路線可行性進行檢查,最后再根據(jù)雷達反饋,判斷車輛周邊狀態(tài),下發(fā)控制指令。