车辆导航方法和系统.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN106123908A(43)申请公布日2016.11.16(21)申请号201610810800.9(22)申请日2016.09.08(71)申请人北京京东尚科信息技术有限公司地址100195北京市海淀区杏石口路65号西杉创意园西区11C楼东段1-4层西段1-4层申请人北京京东世纪贸易有限公司(72)发明人宁润苏(74)专利代理机构中科专利商标代理有限责任公司11021代理人吕雁葭(51)Int.Cl.G01C21/34(2006.01)权利要求书4页说明书7页附图3页(54)发明名称车辆导航方法和系统(57)摘要本发明提供了一种车辆导航方法，包括：测量车辆的加速度和角速度，根据测得的加速度和角速度通过捷联惯性导航算法得到车辆的航向角变化量的量测值和位置；测量车辆左右相对的两个车轮各自的行进距离，将测得的左右相对的两个车轮各自的行进距离之差除以这两个车轮的间距，计算得到所述航向角变化量的计算值；根据所述量测值和所述计算值得到所述航向角变化量的最优解；以及根据车辆的位置和所述航向角变化量的最优解来调整车辆运动，使车辆回到预设的行驶轨迹上。本发明还提供了一种车辆导航系统。CN106123908ACN106123908A权利要求书1/4页1.一种车辆导航方法，包括：测量车辆的加速度和角速度，根据测得的加速度和角速度通过捷联惯性导航算法得到车辆的航向角变化量的量测值和位置；测量车辆左右相对的两个车轮各自的行进距离，将测得的左右相对的两个车轮各自的行进距离之差除以这两个车轮的间距，计算得到所述航向角变化量的计算值；根据所述量测值和所述计算值得到所述航向角变化量的最优解；以及根据车辆的位置和所述航向角变化量的最优解来调整车辆运动，使车辆回到预设的行驶轨迹上。2.根据权利要求1所述的方法，其中：航向角变化量的量测值Δθkg＝hk+vk，hk＝ωk·Δt；以及航向角变化量的计算值Δθkg＝uk+wk，uk＝UR(k)-UL(k)/W，其中：vk为量测噪声，wk为系统噪声，k为车辆的状态编号，按时间先后从小到大依次取值，ωk为车辆在状态k的瞬时角速度，UR(k)和UL(k)分别为状态k-1到状态k之间，右车轮和左车轮行进的距离，W为右车轮和左车轮的车轮间距。3.根据权利要求2所述的方法，其中，根据所述量测值和所述计算值得到车辆航向角变化量的最优解包括：使用预测方程和更新方程得到状态k的航向角变化量的最优解Δθk，其中：所述预测方程为：所述更新方程为：其中P为预测均方误差阵，代表预测均方误差阵估计值，k-1表示状态k的前一状态，Q为系统噪声的方差矩阵，初始状态的预测均方误差阵P0通过对具体环境分析给出，状态k下的预测均方误差阵Pk则通过迭代方法解算，R为量测噪声的方差矩阵。4.根据权利要求1所述的方法，还包括：在车辆行驶经过在地面铺设的二维码阵列中的二维码时，获取二维码图像；分析所述二维码图像，得到车辆经过所述二维码时的精确位置和精确航向角；以及根据所述精确位置和精确航向角来调整车辆运动，使车辆回到预设的行驶轨迹上。5.根据权利要求4所述的方法，还包括：从获取二维码的时刻开始，每隔预定时间对车辆的位置和航向角变化量进行保存；当得到根据二维码确定的精确位置和精确航向角时，将当前时刻与获取二维码的时刻之间车辆的位置和航向角变化量提取出来，对所述精确位置和精确航向角进行补偿，得到2CN106123908A权利要求书2/4页当前车辆的位置和航向角。6.根据权利要求4所述的方法，还包括：对扫描二维码时刻车辆加速度和角速度进行提取；认为在得到根据二维码确定的精确位置和精确航向角的时刻与获取二维码的时刻之间，车辆加速度角速度信息不变，算出这段时间内车的位移和航向角变化量，将其与根据二维码确定的精确位置和精确航向角数据求和，得到当前车辆的位置和航向角。7.一种车辆导航系统，包括：惯性测量单元，测量车辆的加速度和角速度；惯导计算单元，根据测得的加速度和角速度通过捷联惯性导航算法得到车辆的航向角变化量的量测值和位置；分别安装在车辆的左右两侧相对车轮上的两个编码器，车轮每转动一定位移，编码器发出一个脉冲；运动学计算单元，通过计算脉冲个数得到在采样时间内所述两个车轮各自的行进距离，将测得的左右相对的两个车轮各自的行进距离之差除以这两个车轮的间距，计算得到所述航向角变化量的计算值；融合单元，根据所述量测值和所述计算值得到所述航向角变化量的最优解；以及导航解算单元，根据车辆的位置和所述航向角变化量的最优解来调整车辆运动，使车辆回到预设的行驶轨迹上。8.根据权利要求7所述的系统，其中：航向角变化量的量测值Δθkg＝hk+vk，hk＝ωk·Δt；以及航向角变化量的计算值Δθkg＝uk+wk，uk＝UR