申请/专利权人：东南大学

申请日：2022-01-12

公开（公告）日：2024-07-05

公开（公告）号：CN114357794B

主分类号：G06F30/20

分类号：G06F30/20;G06F17/16;G06F119/02

优先权：

专利状态码：有效-授权

法律状态：2024.07.05#授权;2022.05.03#实质审查的生效;2022.04.15#公开

摘要：本发明公开了一种基于改进卡尔曼滤波的公交进站停车测评方法，该方法需要在被测对象上安装一套高性能双天线组合导航系统采集测评所需基础参数数据，包括位置、速度、航向角、加速度等，且需要事先测量被测公交长宽、后侧主天线在车辆上的相对位置，以及站台位置信息。采用相对位置推算的方法将所测量的公交上某一点轨迹推衍至四个角点轨迹，进行公交进站完成度测评；采用改进的卡尔曼滤波对横摆角速度和侧向加速度数据进行处理，进行公交进站稳定性测评。本发明与公交进站停车的实现原理和技术无关，从第三方的角度开展测评，具有测评指标多，测评结果准确的特点。

主权项：1.一种基于改进卡尔曼滤波的公交进站停车测评方法，其特征在于：利用组合导航系统获取被测公交车在行驶过程中的基础参数信息，采用相对位置推算和改进卡尔曼滤波进行数据处理，实现对进站停车完成时车辆侧面与站台距离、进站停车完成时车辆轴线与泊车位外侧边线夹角、进站停车完成时车头与车前标线的最大距离、以及被测公交车进站过程稳定性等指标的测评，具体步骤包括：步骤一：基础参数采集为被测公交车安装双天线组合导航系统，组合导航的系统时间以北斗时间为参考基准，测评所需的基础参数信息包括：进站过程中被测公交车的经纬度坐标、速度、横摆角速度、侧向加速度、航向角；被测公交车的参数，即车辆宽度、长度，后侧主天线至车头、车辆侧边的距离；站台边线的经纬度坐标，以四个点的坐标表示站台边线；步骤二：数据处理在获取测评所需基础参数的基础上，数据处理包括两部分，一部分是需要根据车后侧主天线的运动轨迹及车辆参数推算车辆四个角点的运动轨迹，此部分数据处理的目的是对公交进站停车的完成度进行评价；另一部分是考虑横摆角速度和侧向加速度数据受传感器噪声影响而波动太大，需要对该两组数据进行改进卡尔曼滤波处理，此部分数据处理的目的是对公交进站停车过程的稳定性进行评价；子步骤1：定义与计算被测公交车四角点运动轨迹以车辆左前角为起点，定义为A点，顺时针对被测公交车四个角点依次定义为A点，B点，C点，D点；车辆后侧主天线定义为E点；车头车尾中点分别定义为M点和N点；定义主天线至车头距离为Lf，至车辆侧边距离为Ll，车辆宽度为W，长度为L以便于计算；读取所得航向角定义为Dir；在获取被测公交车行驶轨迹时，因获取轨迹数据为组合导航所输出的经纬度信息，故需要对其进行高斯投影变换，使其单位化为米，便于解算测评指标项： 其中： Exx,y为横坐标变换函数，Eyx,y为纵坐标变换函数，x为纬度，y为经度；采用弧度制计算数据处理所需角度： 则根据三角函数可计算得到被测公交车四个角点运动轨迹为： 其中，Axx,y为A点横坐标变换函数，Ayx,y为A点纵坐标变换函数，Bxx,y为B点横坐标变换函数，Byx,y为B点纵坐标变换函数，Cxx,y为C点横坐标变换函数，Cyx,y为C点纵坐标变换函数，Dxx,y为D点横坐标变换函数，Dyx,y为D点纵坐标变换函数，x为纬度，y为经度；子步骤2：横摆角速度和侧向加速度的改进卡尔曼滤波处理横摆角速度和侧向加速度可以表征车辆运动过程的稳定性，但由于受传感器噪声影响，直接采集获取的横摆角速度和侧向加速度数据波动较大，直接用于判断稳定性会产生较大误差，故需要进行滤波处理；采用改进卡尔曼滤波器的方法，其处理过程如下：1由横摆角加速度与侧向加速度关系，可得： 其中，表示n-1时刻计算所得侧向加速度，表示n-1时刻计算所得横摆角速度，为n时刻先验侧向加速度，为n时刻先验横摆角速度，建立两者关系，V为车辆行驶速度；2计算k时刻的先验估计协方差矩阵： 其中为n时刻的先验估计协方差矩阵，Pn-1为n-1时刻的后验估计协方差矩阵，Q为过程误差矩阵；3计算卡尔曼增益： 其中H为状态变量到测量的状态转换矩阵，这里值为R为测量误差矩阵；4计算后验估计值： 其中为n时刻后验侧向加速度，为n时刻先验横摆角速度，两者为滤波后的所得结果,Zn为观测值矩阵，作为滤波的输入部分；5更新协方差矩阵： 6引入遗忘因子：在被测公交横摆角速度和侧向加速度数据的处理过程中，考虑车辆运动状态变化的瞬时性，新数据比老数据更能反映参数变化状况，故引入遗忘因子，修改新老数据在递推过程中的权重： 当γ较小时，遗忘较快；当γ较大时，遗忘较慢；此处为避免新数据对估值无法修正，故γ在0.95，0.995中取值；步骤三：公交进站停车测评子步骤1：完成度测评1进站停车完成时车辆轴线与泊车位外侧边线夹角测评首先，对于航向角的范围需要进行分类讨论： 再与车站外侧边线坐标整合计算： 其中X1，Y1，X2，Y2分别为已进行高斯投影坐标转换的车站外侧边线O点和P点坐标；当夹角大于0时，车头朝向车站外侧，当夹角小于0时，车尾朝向车站外侧；当夹角满足-3°≤θ＜3°时进站停车符合标准；2进站停车完成时测试车辆侧面距站台的距离测评车辆侧面距站台的距离可通过三角形面积进行计算：三边长分别为： 由海伦公式可知： 其中X3，Y3，X4，Y4分别为已进行高斯投影坐标转换的车站内侧边线S点和T点坐标；由此可得角点A距离站台的距离函数ADisx，y，并依次类推得到其他B，C，D三个角点距离站台的距离函数BDisx，y，CDisx，y，DDisx，y，可结合夹角情况判断车辆角点与站台的距离：当θ≤0时，取BDisx，y和CDisx，y中最小值，当θ≥0时，取ADisx，y和DDisx，y中最小值，所得值d1，d2为所求距离，当0.05m≤d1≤0.25m且0.05m≤d2≤0.25m时，进站停车符合要求；3进站停车完成时车头与车前标线的最大距离测评车头距车前边线距离通过三角形面积进行计算：三边长分别为： 由海伦公式可知： 其中X2，Y2，X3，Y3分别为已进行高斯投影坐标转换的车站边线P点和S点坐标；由此可得角点A距车前标线的距离函数AFDisx，y，并由此类推得角点B距车前标线的距离函数BFDisx，y可根据实际情况选择AFDisx，y或BFDisx，y中最大值作为最大距离Me，当0.05m≤Me＜0.25m时，符合进站停车要求；子步骤2：进站过程稳定性测评被测公交车进站停车过程的稳定性也是衡量进站停车功能的关键指标之一，需要满足进站过程中的侧向加速度和横摆角速度最大值小于一定阈值，即 其中，表示经过改进卡尔曼滤波处理的侧向加速度值，ay_threshold为侧向加速度阈值，表示经过改进卡尔曼滤波处理的横摆角速度值，ωz_threshold为横摆角速度阈值，在整个过程中横摆角速度和侧向加速度均未大于阈值，则进站停车稳定性符合标准。

全文数据：

权利要求：

百度查询： 东南大学 一种基于改进卡尔曼滤波的公交进站停车测评方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD