本发明属于道路测量领域，特别涉及一种基于行车轨迹的道路平曲线半径测量方法。
背景技术：
目前，国内外对于道路几何参数运用人工测绘的方法采集，但该方法检测效率低、准确率低，要消耗大量的人力物力，在高速路上采集数据影响交通，不利于行车安全，不能实现路网级的数据采集及分析。
国内外对于道路水平曲线半径的测量方法主要通过卫星地图数据，并结合弦长法、弦平面圆法以及圆拟合法计算道路平曲线半径。但卫星地图的数据精度太低，且路面树木、广告牌、建筑物等的遮挡，会影响道路路线的描绘。同时，车载设备虽实现了自动化的数据采集，然而也带来了新的误差：检测过程中车辆的偏移颠簸都会影响检测的结果。然而，目前极少有研究针对检测车带来的误差，对测量结果进行校正。
技术实现要素：
为解决上述问题，本发明的目的是提供一种基于行车轨迹的道路平曲线半径测量方法。
本发明采用以下技术方案：一种基于行车轨迹的道路平曲线半径测量方法，其特征在于：包括以下步骤：
步骤s1：通过车载测量装置获取测试车辆在道路上行驶的数据并输入计算机中，行驶数据包括航向角数据、行驶仪数据，计算得到行车轨迹数据并描绘；
步骤s2：对于行车轨迹曲线段上的2个点，ith和i+nth为车辆在曲线段对应两点的位置，采用弧长法计算平曲线的半径；
步骤s3：对于行车轨迹曲线段上的2个点，ith和i+nth为车辆在曲线段对应两点的位置，采用弦线支距法计算平曲线的半径；
步骤s4：对每个行车轨迹曲线段随机选取包含2个点的2n组数据，其中n组数据通过步骤2进行计算，剩余n组数据通过步骤3进行计算，然后对得到的2n个结果求取平均值，该平均值作为道路平曲线半径的输出结果。
优选地，所述车载测量装置包括惯性测量单元和测距仪。
优选地，所述计算得到行车轨迹数据并描绘的方法是：
建立x、y坐标体系，并确定不同时间车辆在坐标轴上的具体位置；ti(xi，yi)表示车辆轨迹上的第ith个位置，ti(xi，yi)的坐标由以下公式(1)-(3)得到：
xi＝z×(di-di-1)×coshi-1(1)；
yi＝z×(di-di-1)×sinhi-1(2)；
其中，xi为ti横坐标；yi为ti的纵坐标；di为第i个测距仪数据；hi-1为第i-1个航向角的角度值；n为所述惯性测量单元采集数据的样本数；l为车辆行驶的总路程。
优选地，所述弧长法计算平曲线的半径的方法是：
其中，r为曲率半径；z为公式(3)的计算结果；di为第ith样本的测距仪数据；hi表示第i个航向角的角度值。
优选地，所述弦线支距法计算平曲线的半径的方法是：
其中r为曲率半径；
l为点ti+n(xi+n，yi+n)到点ti(xi，yi)的距离，且
m为点q(xj，yj)到点ti+n(xi+n，yi+n)的距离，且
其中，点q(xj，yj)是线ti+n到ti的中点，
优选地，所述步骤s4中n＝3，求取平均值之前去掉最大值和最小值。
本发明的技术方案测试车辆的行车轨迹数据与弧长法、弦线支距法相结合，以消除检测车轨迹偏移对平曲线测量的影响。通过本发明计算得到的道路平曲线半径，可降低检测车偏移带来的误差，提高道路测量的准确度。
附图说明
图1为本发明实施例中弧长法和弦线支距法计算过程的示意图。
具体实施方式
为让本专利的特征和优点能更明显易懂，下面结合具体实施例对本发明做进一步解释说明。
本发明中，道路的平曲线参数通过在道路上行驶的测试车辆的相关参数来反映或计算，在本实施例中，测试车辆在道路上行驶的数据通过惯性测量单元(imu)和测距仪(dmi)来采集，采集的数据主要包括：航向角数据和行驶仪数据。
本实施例中，选用的惯性测量单元(imu)由加速度计、陀螺仪组成。该仪器采集的数据通过rs232接口输出，可设定带宽1-200hz，1000hz的数字输出频率。加速度计用来测量三个方向的线加速，陀螺仪测量车辆三个方向的绝对角速率。利用a/d转换器进行imu各传感器的模拟变量，转换为数字信息后经过cpu解算，再经过温度补偿，刻度因子补偿、陀螺仪零偏与增量校准零偏修正、安装误差补偿等补偿方法处理后，输出出车辆的运动过程的角速率、和加速度信息。
本实施例所采用的基于行车轨迹的道路平曲线半径测量方法具体包括下述步骤：
步骤s1：通过车载测量装置获取测试车辆在道路上行驶的数据并输入计算机中，行驶数据包括航向角数据、行驶仪数据，计算得到行车轨迹数据并描绘；
计算得到行车轨迹数据并描绘的方法是：
建立x、y坐标体系，并确定不同时间车辆在坐标轴上的具体位置；ti(xi，yi)表示车辆轨迹上的第ith个位置，ti(xi，yi)的坐标由以下公式(1)-(3)得到：
xi＝z×(di-di-1)×coshi-1(1)；
yi＝z×(di-di-1)×sinhi-1(2)；
其中，xi为ti横坐标；yi为ti的纵坐标；di为第i个测距仪数据；hi-1为第i-1个航向角的角度值；n为所述惯性测量单元采集数据的样本数；l为车辆行驶的总路程
步骤s2：对于行车轨迹曲线段上的2个点，ith和i+nth为车辆在曲线段对应两点的位置，采用弧长法计算平曲线的半径；
弧长法计算平曲线的半径的具体方法是：
其中，r为曲率半径；z为公式(3)的计算结果；di为第ith样本的测距仪数据；hi表示第i个航向角的角度值。
步骤s3：对于行车轨迹曲线段上的2个点，ith和i+nth为车辆在曲线段对应两点的位置，采用弦线支距法计算平曲线的半径；
弦线支距法计算平曲线的半径的具体方法是：
其中r为曲率半径；
l为点ti+n(xi+n，yi+n)到点ti(xi，yi)的距离，且
m为点q(xj，yj)到点ti+n(xi+n，yi+n)的距离，且
其中，点q(xj，yj)是线ti+n到ti的中点，
步骤s4：对每个行车轨迹曲线段随机选取包含2个点的6组数据，其中3组数据通过步骤s2也就是弧长法进行计算，另外3组数据通过步骤s3也就是弦线支距法进行计算，然后对得到的6个结果去掉最大值和最小值之后求取平均值，通过该方法计算得到的平曲线半径，可降低检测车偏移带来的误差。
以上是本发明的较佳实施例，凡依本发明技术方案所作的改变，所产生的功能作用未超出本发明技术方案的范围时，均属于本发明的保护范围。