专利名称：一种车载式大波浪路形测量方法及其测量系统的制作方法
技术领域：
本发明涉及一种路形测量方法，特别是关于一种基于惯性原理的车载式大波浪路形测量方法及其测量系统。
背景技术：
针对大波浪路面，为了准确获得路面形状，需要测得坡度上每一点沿纵向的标高。 所谓的标高，指的是某一点到基准面的竖向高度。标高是确定地面点位置的要素之一。目 前，测量标高最常用的方法为水准测量。水准测量是用水准仪和水准尺测量地面上两点之 间高差的方法，是沿水准路线逐点向前推进的方式实施。在大地测量中，因边线较长，两点 之间的高差必须考虑到地球弯曲差和大气垂直折光的作用，这就造成了测量结果的不准确 性。而且该方法测量过程需要几个人合作完成，测量效率低下，无法进行快速车载式测量。 同时该方法由于人为因素，测量误差也不容易控制。
发明内容
针对上述问题，本发明的目的是提供一种测量效率和准确性较高、测量方法简单且适合车载使用进行快速测量的车载式大波浪路形测量方法及其测量系统。为实现上述目的，本发明采取以下技术方案一种车载式大波浪路形测量方法，其 包括以下步骤1)设置一包括单轴加速度计、陀螺仪、光电编码器、单片机和车载式计算机 的测量系统；2)对单轴加速度计、陀螺仪和光电编码器进行标定，将得到传感器与实际测 量值之间的比例参数输入到车载式计算机内；3)利用单轴加速度计测量检测车起始状态 的俯仰角利用陀螺仪作为角速度测量仪，根据上述步骤3)中获得的起始状态的俯 仰角θ ^，得到任意时刻的俯仰角θ1;5)利用光电编码器测量检测车行驶过程中的任意相 邻两时刻的行驶里程As ;6)将所述步骤3)至步骤5)中三个传感器测量到的数据由单片 机内的模数转换器进行采集、转换，并将数据输入到车载计算机中；7)由车载式计算机内 的数据处理模块对三个传感器所测量到的数据进行处理，得到在大波浪路面上任意时刻所 处位置点的坐标值，根据坐标累加原理绘出相应的路形曲线图，由车载式计算机实时窗口 进行显示出相应路面形状。所述步骤3)中，所述检测车起始状态的所述俯仰角θ ^为θ ^ = arcsin(gA/g)， 式中，A为所述单轴加速度计的轴；gA为重力加速度g在A轴上的分量。所述步骤4)中，任意时刻的所述俯仰角θ i为肩=略+ f COdt，当(tl-t0)足够小
<formula>formula see original document page 4</formula>
时，则得到任意时刻的俯仰角θ i为<formula>formula see original document page 4</formula>上式中，t0为初始时刻；θ 0为起 始状态的俯仰角A1为任意时刻；ω为陀螺转子的角速度。所述步骤5)中，任意相邻两时刻的所述行驶里程As为As = eXN，式中，e为 所述光电编码器的一个脉冲所对应的所述检测车步长，e = L/n，L为所述检测车车轮的周 长，η为所述检测车车轮转一圈时，所述光电编码器输出脉冲的个数；N为相邻两时刻累计 的脉冲数。
所述步骤7)中，所述检测车在大波浪路面上任意时刻所处位置点的所述坐标值
(X — /V,ν χ cos 0
,Λ . J，式中，Δ S为任意相邻两时刻的行驶里程；Θ χ为任意时刻的俯仰 h - Asx sin Ux角。一种实现上述测量方法的车载式大波浪路形测量系统，其特征在于它包括一个 单轴加速度计、一个陀螺仪、一个光电编码器、一个单片机和一台加装到被检测车内的车载 式计算机；所述单轴加速度计和陀螺仪安装在一起固定在被检测车的底盘靠近质心的位 置；所述光电编码器固定在被检测车的右后车轮上；所述单片机和车载式计算机固定在被 检测车内的工作坐椅附近；所述单轴加速度计、陀螺仪和光电编码器并联连接所述单片机 的模数转换器端口，将实时采集的数据通过所述单片机的串口送入所述车载式计算机内， 由所述车载式计算机内的数据处理模块对所述单片机输入的数据进行计算处理。
所述单轴加速度计采用ADI公司生产的型号为ADXL190的单轴加速度计。所述陀螺仪采用ADI公司生产的型号为ADXRS610的陀螺仪。所述光电编码器采用台湾松野ES40系列的型号为SY-ES40-RB600的光电编码器。本发明由于采取以上技术方案，具有以下优点1、本发明由于采用陀螺仪作为检测 车的角速度测量仪，对任意时刻所对应的俯仰角进行测量，由单片机内的模数转换器采集 该测量数据，并经过数据处理模块实时获取检测车的俯仰角，因此具有较高的精度和灵敏 度，保证了测量结果的准确性。2、本发明由于采用单轴加速度计测量检测车启动前的俯仰 角，即静止时的俯仰角，因此弥补了陀螺仪在陀螺转子静止或沿固定方向转动时无输出信 号的缺点，保证了整个系统采集数据的完整性。3、本发明由于采用光电编码器测量检测车 所行驶的里程，因此实现了测量方法简单、可靠的性能。本发明可以广泛应用于各种路形测 量中。
图1是本发明测量系统的结构示意2是本发明的系统测量流程示意3是本发明的单轴加速度计测量原理示意4是本发明的测量系统工作原理示意图
具体实施例方式下面结合附图和实施例对本发明进行详细的描述。如图1所示，本发明的测量系统主要包括一个单轴加速度计1、一个陀螺仪2、一个 光电编码器3、一个单片机4和一台加装到被检测车内的车载式计算机5。其中，单轴加速 度计1和陀螺仪2均安装在被检测车的底盘靠近质心的位置；光电编码器3固定在被检测 车的右后车轮上，保证与车轮同心并同速转动；单片机4和车载式计算机5固定在被检测车 内，可供测量实验操作。单轴加速度计1、陀螺仪2和光电编码器3并联连接于单片机4内 的A/D转换(模数转换)器端口，由单片机4实时采集测得的数据，并进行A/D转换，再将 转换后的数据通过单片机4的串口送入车载式计算机5内，由车载式计算机5内的数据处 理模块对单片机4输入的数据进行计算处理。
上述实施例中，单轴加速度计1采用ADI公司生产的型号为ADXL190的单轴加 速度计。ADXL190是集单轴加速度传感器于一体的单片集成电路加速度计，典型噪声值为 4mg/(Hz)l/2，检测加速度信号可以低于40mg。该单轴加速度计既可以测量动态加速度(如 典型震动和冲击)，又可以测量静态加速度(如重力加速度和惯性)。
上述实施例中，陀螺仪2采用ADI公司生产的型号为ADXRS610的陀螺仪。 ADXRS610陀螺仪采用集成微电子机械系统(iMEMS)工艺和BIMOS工艺的角速度传感器，内 部同时集成有角速率传感器和信号处理电路，因此具有尺寸小、功耗低、抗冲击和振动性好 的优点。 上述实施例中，光电编码器3采用台湾松野ES40系列的型号为SY-ES40-RB600的 光电编码器。光电编码器3安装在检测车任一车轴上，其精度可达到车轮每旋转一周，编码 器产生600个脉冲，不仅信号采集速度快，而且精度较高。如图2所示，本发明的车载式大波浪路形测量方法，其步骤如下1)设置一包括单轴加速度计1、一个陀螺仪2、一个光电编码器3、一个单片机4和 一台车载式计算机5的测量系统；2)对单轴加速度计1、陀螺仪2和光电编码器3进行标定，将传感器得到实际测量 值与额定值之间的比例参数输入到车载式计算机5内；3)如图3所示，利用单轴加速度计1测量检测车起始状态(例如，初始时刻、)的 俯仰角θ。为<formula>formula see original document page 6</formula>(1)式中，A为单轴加速度计1的轴，在安装单轴加速度计时，要保证A轴与检测车行 驶的方向一致；gA为重力加速度g在A轴上的分量；4)利用陀螺仪2作为角速度测量仪，根据上述步骤3)中获得的起始状态的俯仰角 θ…可以得到任意时刻的俯仰角θ工为<formula>formula see original document page 6</formula>
当(、-、)足够小时，则可以得到任意时刻的俯仰角θ工为θ = θ +ω (tft。)，(3)公式(2)和公式(3)中，、为初始时刻；θ ^为起始状态的俯仰角；、为任意时刻； ω为陀螺转子的角速度；5)利用光电编码器3测量检测车行驶过程中的任意相邻两时刻的行驶里程Δ s 为<formula>formula see original document page 6</formula>(4)式中，e为光电编码器的一个脉冲所对应的检测车步长，e = L/n, L为检测车车轮 的周长，η为检测车车轮转一圈时，光电编码器输出脉冲的个数；N为相邻两时刻累计的脉 冲数；6)将步骤3)至步骤5)中三个传感器测量到的数据由单片机4内的A/D转换器进 行采集并转换，并将数据输入到车载计算机5中；7)由车载式计算机5内的数据处理模块对输入的数据进行处理，将三个传感器所 测量到的数据进行相互处理，可以得到在大波浪路面上任意时刻所处位置点的坐标值(X， h)，并由车载计算机5内的数据处理模块将实时获得的坐标值根据坐标累加原理绘出相应的路形曲线图(如图4所示，图中χ为横坐标，h为纵坐标，θ为俯仰角，s为被检测车行驶 里程)，由车载式计算机5实时窗口进行显示出相应路面形状；其中坐标值(x，h)为<formula>formula see original document page 7</formula>(5) [h = Ayxsin^1式中，Δ S为任意相邻两时刻的行驶里程；θ i为任意时刻的俯仰角。上述各实施例仅用于说明本发明，其中各部件的结构、连接方式等都是可以有所 变化的，凡是在本发明技术方案的基础上进行的等同变换和改进，均不应排除在本发明的 保护范围之外。
权利要求
一种车载式大波浪路形测量方法，其包括以下步骤1)设置一包括单轴加速度计、陀螺仪、光电编码器、单片机和车载式计算机的测量系统；2)对单轴加速度计、陀螺仪和光电编码器进行标定，将得到传感器与实际测量值之间的比例参数输入到车载式计算机内；3)利用单轴加速度计测量检测车起始状态的俯仰角θ0；4)利用陀螺仪作为角速度测量仪，根据上述步骤3)中获得的起始状态的俯仰角θ0，得到任意时刻的俯仰角θ1；5)利用光电编码器测量检测车行驶过程中的任意相邻两时刻的行驶里程Δs；6)将所述步骤3)至步骤5)中三个传感器测量到的数据由单片机内的模数转换器进行采集、转换，并将数据输入到车载计算机中；7)由车载式计算机内的数据处理模块对三个传感器所测量到的数据进行处理，得到在大波浪路面上任意时刻所处位置点的坐标值，根据坐标累加原理绘出相应的路形曲线图，由车载式计算机实时窗口进行显示出相应路面形状。
2.如权利要求1所述的一种车载式大波浪路形测量方法，其特征在于所述步骤3) 中，所述检测车起始状态的所述俯仰角θ0为<formula>formula see original document page 2</formula>式中，A为所述单轴加速度计的轴；gA为重力加速度g在A轴上的分量。
3.如权利要求1所述的一种车载式大波浪路形测量方法，其特征在于所述步骤4) 中，任意时刻的所述俯仰角θ工为；<formula>formula see original document page 2</formula>当(Vt0)足够小时，则得到任意时刻的俯仰角θ i为<formula>formula see original document page 2</formula>上式中，、为初始时刻；θ ^为起始状态的俯仰角；ti为任意时刻；ω为陀螺转子的角速度。
4.如权利要求1所述的一种车载式大波浪路形测量方法，其特征在于所述步骤5) 中，任意相邻两时刻的所述行驶里程As为As = eXN,式中，e为所述光电编码器的一个脉冲所对应的所述检测车步长，e = L/n, L为所述检 测车车轮的周长，η为所述检测车车轮转一圈时，所述光电编码器输出脉冲的个数；N为相 邻两时刻累计的脉冲数。
5.如权利要求1所述的一种车载式大波浪路形测量方法，其特征在于所述步骤7) 中，所述检测车在大波浪路面上任意时刻所处位置点的所述坐标值(x，h)为<formula>formula see original document page 2</formula>式中，Δ s为任意相邻两时刻的行驶里程；θ工为任意时刻的俯仰角。
6.一种实现如权利要求1 5任意一项所述测量方法的车载式大波浪路形测量系统， 其特征在于它包括一个单轴加速度计、一个陀螺仪、一个光电编码器、一个单片机和一台加装到被检测车内的车载式计算机；所述单轴加速度计和陀螺仪安装在一起固定在被检测 车的底盘靠近质心的位置；所述光电编码器固定在被检测车的右后车轮上；所述单片机和 车载式计算机固定在被检测车内的工作坐椅附近；所述单轴加速度计、陀螺仪和光电编码 器并联连接所述单片机的模数转换器端口，将实时采集的数据通过所述单片机的串口送入 所述车载式计算机内，由所述车载式计算机内的数据处理模块对所述单片机输入的数据进 行计算处理。
7.如权利要求6所述测量方法的车载式大波浪路形测量系统，其特征在于所述单轴 加速度计采用ADI公司生产的型号为ADXL190的单轴加速度计。
8.如权利要求6所述测量方法的车载式大波浪路形测量系统，其特征在于所述陀螺 仪采用ADI公司生产的型号为ADXRS610的陀螺仪。
9.如权利要求6所述测量方法的车载式大波浪路形测量系统，其特征在于所述光电 编码器采用台湾松野ES40系列的型号为SY-ES40-RB600的光电编码器。
全文摘要
本发明涉及一种车载式大波浪路形测量方法及其测量系统，该方法包括以下步骤1)设置一包括单轴加速度计、陀螺仪、光电编码器、单片机和车载式计算机的测量系统；2)对单轴加速度计、陀螺仪和光电编码器进行标定；3)利用单轴加速度计测量检测车起始状态的俯仰角；4)利用陀螺仪和起始状态的俯仰角，得到任意时刻的俯仰角；5)利用光电编码器测量任意相邻两时刻的行驶里程；6)将三个传感器测量到的数据由单片机内模数转换器采集后输入车载计算机；7)由车载式计算机内的数据处理模块对所测量到的数据进行处理，得到路形曲线图，并实时显示出相应路面形状。本发明采用陀螺仪作为检测车的角速度测量仪，具有较高的精度和灵敏度，保证了测量结果的准确性。本发明可以广泛应用于各种路形测量中。
文档编号E01C23/01GK101798793SQ20101011767
公开日2010年8月11日 申请日期2010年3月3日 优先权日2010年3月3日
发明者杨殿阁, 连小珉, 韩毅 申请人:清华大学