CN111322964B - 一种运动车辆的速度和外廓尺寸测量系统 - Google Patents
一种运动车辆的速度和外廓尺寸测量系统 Download PDFInfo
- Publication number
- CN111322964B CN111322964B CN202010181547.1A CN202010181547A CN111322964B CN 111322964 B CN111322964 B CN 111322964B CN 202010181547 A CN202010181547 A CN 202010181547A CN 111322964 B CN111322964 B CN 111322964B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- point
- frame body
- detector
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/24—Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/02—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness
- G01B11/04—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness specially adapted for measuring length or width of objects while moving
- G01B11/043—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness specially adapted for measuring length or width of objects while moving for measuring length
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/02—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness
- G01B11/04—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness specially adapted for measuring length or width of objects while moving
- G01B11/046—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness specially adapted for measuring length or width of objects while moving for measuring width
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/50—Systems of measurement based on relative movement of target
- G01S17/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明提出了一种运动车辆的速度和外廓尺寸测量系统。本发明中装置包括:架体竖直方向立柱、架体水平斜向横梁、步进电机、微处理器、检测器。本发明中方法以架体水平斜向横梁的左极限在地面上的投影为中心建立空间坐标系;微处理器通过检测器实时采集竖直距离,构建空间时间数组;根据竖直距离计算车辆高度;根据空间时间数组分别搜索车辆宽度右侧边缘点最大值和左侧边缘点最小值计算车辆宽度和车辆对称平面;根据车辆对称平面计算对称检测点间X轴检测点距离来计算车辆速度,根据空间时间数组分别搜索车辆长度后侧边缘点最大值和前侧边缘点最小值计算车辆扫描时长,根据车辆速度和车辆扫描时长计算车辆长度;本发明车辆三维尺寸的测量精度高。
Description
技术领域
本发明属于车辆检测技术领域,特别是涉及一种运动车辆的速度和外廓尺寸测量系统。
背景技术
随着高速公路逐渐取消收费站,研究更易安装更高精度的车辆三维测量装置已愈发重要。现阶段,对车辆进行扫描来获取三维信息的方法大致分为两类:第一种是直接测量,分别对车辆的三维进行三个方向上的扫描,这种方法精度最高,但对场地要求较高,并且不宜安装;第二种是间接测量,一般采用一个或两个扫描仪器获取宽度和高度信息,以及一个测速装置类获取速度信息,然后用速度与扫描时间的乘积来推算车辆的长度,从而得到车辆的外廓信息。
目前,采用的多是第二种方法,然而为了获取车辆的速度信息,不可避免的需要测速装置来获取速度信息,这样既增加了道路设备安装成本,也不利于安装。
中国专利申请CN1605033A提出了一种基于检测车辆最大或最小纵向位置移动的距离和时间来推算出车辆速度的方法。此方法在车头和车尾边缘等具有显著纵向位置检测,因此可用的数据量十分有限。中国专利申请CN108132025A提出了一种基于车头位置相邻不等长的两条扫描线来确定路程差并推算出时间。此方法采集的数据需位于车辆边角等位置,因此数据量同样有限。这两种方法的潜在要求是车头车尾形状近似矩形,而市场上大多数车辆车头车尾都带有一定弧度,特别是车头,因此计算误差较大。同时这两种方法采集数据两种方法都采用的是固定安装激光雷达进行信息采集,然而单个固定检测装置扫描采集时光线总是倾斜射出的,这对于带有弧度的车身曲线来说,会产生测量死角和误差。
发明内容
为了解决上述技术问题,本发明提出了一种运动车辆的外廓尺寸测量系统。
本发明装置的技术方案为一种运动车辆的速度和外廓尺寸测量装置,其特征在于,包括:
架体竖直方向立柱、架体水平斜向横梁、步进电机、微处理器、检测器;
所述架体竖直方向立柱支撑立于道路边缘,所述架体水平斜向横梁与所述架体竖直方向立柱呈直角连接,所述架体水平斜向横梁与与道路边缘线的夹角为α;所述检测器安装于所述架体水平斜向横梁下;所述步进电机安装于所述架体水平斜向横梁下;所述微处理器分别与所述的步进电机、检测器通过有线方式依次连接,所述微处理器位于架体竖直方向立柱上;
所述架体水平斜向横梁用于所述检测器来回移动的承载体,横梁的长度为车道宽度;
所述步进电机根据所述微处理器的控制信号,用于驱动所述检测器在架体水平斜向横梁上进行来回移动;
所述步进电机可正向驱动和反向驱动,用于驱动检测器往返移动;
所述检测器实时测量所述检测器至地面或车辆表面的竖直距离;所述检测器的移动范围为所述架体水平斜向横梁的长度;所述检测器由所述架体水平斜向横梁靠近所述架体竖直方向立柱的端点移动到远离所述架体竖直方向立柱的端点,或远离所述架体竖直方向立柱的端点移动到靠近所述架体竖直方向立柱的端点为一次扫描,每次扫描的数据为一组数据。
本发明方法的技术方案为一种运动车辆的速度和外廓尺寸测量方法,其特征在于,包括以下步骤:
步骤1:以架体水平斜向横梁的左极限在地面上的投影为中心建立空间坐标系,X轴轴向为道路两侧连线方向,Y轴轴向为道路沿线方向,Z轴轴向为架体竖直方向立柱的竖直方向;
步骤2:所述检测器初始位置位于所述架体水平斜向横梁靠近架体竖直方向立柱的端点,所述检测器在所述架体水平斜向横梁匀速往返移动,微处理器通过所述检测器实时采集竖直距离,根据竖直距离构建竖直距离数组,计算所述检测器实时位置,根据所述检测器实时位置进一步构建空间时间数组,通过空间时间数组定义检测点;
步骤3:根据竖直距离计算车辆高度;
步骤4:根据空间时间数组分别搜索车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值,通过车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆宽度;
步骤5:根据车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆对称平面,在空间坐标系中根据车辆对称平面分别构建左侧X轴检测点对称集合、右侧X轴检测点对称集合,根据左侧X轴检测点对称集合、右侧X轴检测点对称集合计算X轴检测点距离,根据X轴检测点距离计算车辆速度,根据空间时间数组分别搜索车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值,通过车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值分别对应的时刻计算车辆扫描时长,根据车辆速度以及车辆扫描时长计算车辆长度;
作为优选,步骤2中所述竖直距离数组为:
hm,n,m∈[1,M],n∈[1,N]
其中,hm,n表示第m个采样周期内第n个采集时刻的竖直距离,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量,每个采样周期的时长定义为T;
所述采样周期T定义为:所述检测器在所述架体水平斜向横梁上由靠近所述架体竖直方向立柱的一端匀速运动至远离所述架体竖直方向立柱的一端的时长或者由远离所述架体竖直方向立柱的一端匀速运动至靠近所述架体竖直方向立柱的一端的时长;
步骤2中所述竖直距离数组为:
第m个采样周期内第n个采集的竖直距离数组,定义如下:
(hm,n,tm,n),m∈[1,M],n∈[1,N]
其中,tm,n表示第m个采样周期内第n个采集时刻,通过所述微处理器进行计时,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量;
步骤2计算所述检测器实时位置为:
所述检测器实时位置为所述检测器位于所述架体水平斜向横梁的位置,具体计算如下:
m∈[1,M],n∈[1,N]
其中,lm,n表示第m个采样周期内第n个采集时刻的检测器实时位置,L表示所述架体水平斜向横梁的长度,tm,n表示第m个采样周期内第n个采集时刻,T表示每个采样周期的时长,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量;
步骤2所述空间时间数组为:
(xm,n,ym,n,hm,n,tm,n)
xm,n=lm,nsinα
ym,n=lm,ncosα
m∈[1,M],n∈[1,N]
其中,α表示所述架体水平斜向横梁与道路边缘线的夹角,xm,n表示所述检测器在第m个采样周期内第n个采集时刻的空间坐标系中X轴坐标,ym,n表示所述检测器在第m个采样周期内第n个采集时刻的空间坐标系中Y轴坐标,hm,n表示第m个采样周期内第n个采集时刻的竖直距离即,即所述检测器在第m个采样周期内第n个采集时刻的空间坐标系中Z轴坐标,tm,n表示第m个采样周期内第n个采集时刻,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量;
步骤2所述通过空间时间数组定义检测点为:将(xm,n,ym,n,hm,n,tm,n)定义为所述检测器在第m个采样周期内第n个采集时刻的检测点;
作为优选,步骤3所述根据竖直距离计算车辆高度为:
作为优选,步骤4根据空间时间数组搜索车辆宽度右侧边缘点最大值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n<0的检测点定义为车辆宽度右侧边缘点集合,具体为:
其中,I为车辆宽度右侧边缘点集合中检测点的数量;
根据车辆宽度右侧边缘点集合中空间坐标系中X轴坐标,搜索出空间坐标系中X轴坐标最大值为:
步骤4根据空间时间数组搜索车辆宽度左侧边缘点最小值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n>0的检测点定义为车辆宽度左侧边缘点集合,具体为:
其中,J为车辆宽度左侧边缘点集合中检测点的数量;
根据车辆宽度左侧边缘点集合中空间坐标系中X轴坐标,搜索出空间坐标系中X轴坐标最小值为:
步骤4所述计算车辆宽度为:
作为优选,步骤5所述根据车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆对称平面为:
步骤5所述在空间坐标系中根据车辆对称平面分别构建左侧X轴检测点对称集合、右侧X轴检测点对称集合为:
将空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中在步骤1所述空间坐标系中,搜索到车辆对称平面距离相等的检测点;
车辆对称平面左侧的检测点构建步骤5所述左侧X轴检测点对称集合:
其中,K为左侧X轴检测点对称集合中检测点的数量;
车辆对称平面右侧的检测点构建步骤5所述右侧X轴检测点对称集合:
其中,K为右侧X轴检测点对称集合中检测点的数量;
所述到车辆对称平面距离相等的检测点为:
步骤5所述左侧X轴检测点对称集合、右侧X轴检测点对称集合计算X轴检测点距离为:
在所述左侧X轴检测点对称集合中遍历每个检测点即:
则右侧X轴检测点对称集合和左侧X轴检测点对称集合中,对称点间距离为:
e∈[1,K],g∈[1,K]
其中,Δxe为第e个X轴检测点距离;
步骤5所述根据X轴检测点距离计算车辆速度为:
在所述左侧X轴检测点对称集合中,e∈[1,K],检测点所在数组组数为第mA,e组,则在所述空间时间数组(xm,n,ym,n,hm,n,tm,n),m∈[1,M],n∈[1,N]中,第mA,e组检测点集合可表示为:
步骤5所述车辆关于第e对右侧左侧对称点计算出的速度为:
将e∈[1,K]所有对称点算出的车辆速度加权平均后,可得车辆平均速度为:
步骤5所述根据空间时间数组分别搜索车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值为:
根据空间时间数组搜索车辆长度后侧边缘点最大值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n<0的检测点定义为车辆长度后侧边缘点集合,具体为:
其中,Q车辆长度后侧边缘点集合中检测点的数量;
根据车辆长度后侧边缘点集合中空间坐标系中Y轴坐标,搜索出空间坐标系中Y轴坐标最大值为:
步骤4根据空间时间数组搜索车辆长度前侧边缘点最小值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n>0的检测点定义为车辆长度前侧边缘点集合,具体为:
其中,P为车辆长度前侧边缘点集合中检测点的数量;
根据车辆长度前侧边缘点集合中空间坐标系中Y轴坐标,搜索出空间坐标系中Y轴坐标最小值为:
步骤5所述通过车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值分别对应的时刻计算车辆扫描时长为:
步骤5所述根据车辆速度以及车辆扫描时长计算车辆长度为:
本发明可以带来以下有益效果:本发明通过采用斜向来回移动的单个检测,可以做到对垂直扫描车身,解决了单个检测器无法获得车辆三维信息的问题和单个检测器出现车辆侧边死角的问题,同时用车身扫描数据推算出车辆速度的信息,车辆三维尺寸的测量精度高。
附图说明
图1:本发明装置框图;
图2:本发明装置安装视图;
图3:本发明车辆扫描示意图;
图4:本发明速度测量原理图;
图5:本发明方法流程图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,为本发明的装置示意图,本发明装置的技术方案为一种运动车辆的外廓尺寸测量装置,其特征在于,包括:
架体竖直方向立柱1、架体水平斜向横梁2、步进电机3、微处理器4、检测器5;
如图2所示,所述架体竖直方向立柱1支撑立于道路边缘,所述架体水平斜向横梁2与所述架体竖直方向立柱1呈直角连接,所述架体水平斜向横梁2与与道路边缘线的夹角为α=45°,α取值范围为45°~75°;所述检测器5安装于所述架体水平斜向横梁2下;所述步进电机3安装于所述架体水平斜向横梁下;所述4微处理器分别与所述的步进电机3、检测器5通过有线方式依次连接,所述微处理器4位于架体竖直方向立柱1上。
所述架体水平斜向横梁2选型用于所述检测器5来回移动的承载体,横梁的长度为车道宽度;
所述步进电机根据所述微处理器4的控制信号,用于驱动所述检测器5在架体水平斜向横梁2上进行来回移动;
所述步进电机3可正向驱动和反向驱动,用于驱动检测器5往返移动;
所述检测器实时测量所述检测器5至地面或车辆表面的竖直距离;所述检测器5的移动范围为所述架体水平斜向横梁2的长度;所述检测器5由所述架体水平斜向横梁2靠近所述架体竖直方向立柱1的端点移动到远离所述架体竖直方向立柱1的端点,或远离所述架体竖直方向立柱1的端点移动到靠近所述架体竖直方向立柱1的端点为一次扫描,每次扫描的数据为一组数据。
所述架体竖直方向立柱1选型为:立柱竖直高度为4米;
所述架体水平斜向横梁2选型为:横梁水平长度为L=3米;
所述步进电机3选型为:研控YK31323A三相混合式步进电机;
所述微处理器4选型为:ARMSTM32F103VE处理器;
下面结合图1至图5,以一辆BMW1系家用汽车为例介绍本发明的具体实施方式为本发明方法的技术方案为一种车辆外廓尺寸的测量方法,其中BMW1系家用汽车长、宽、高尺寸分别为4.45米、1.80米、1.55米,车速保持为5米/秒即18公里/小时,方法流程图如图5所示,具体包括以下步骤:
步骤1:以架体水平斜向横梁2的左极限在地面上的投影为中心建立空间坐标系,X轴轴向为道路两侧连线方向,Y轴轴向为道路沿线方向,Z轴轴向为架体竖直方向立柱1的竖直方向,图1和图2中空间坐标系即为所建立的空间坐标系;
步骤2:所述检测器5初始位置位于所述架体水平斜向横梁2靠近架体竖直方向立柱1的端点,所述检测器5在所述架体水平斜向横梁2匀速往返移动,在车身扫描形成的扫描效果如图3所示,微处理器4通过所述检测器实时采集竖直距离,根据竖直距离构建竖直距离数组,计算所述检测器5实时位置,根据所述检测器5实时位置进一步构建空间时间数组,通过空间时间数组定义检测点;
步骤2中所述竖直距离数组为:
hm,n,m∈[1,M],n∈[1,N]
其中,hm,n表示第m个采样周期内第n个采集时刻的竖直距离,在本次家用汽车通过过程中,M为采样周期的数量,M=10,N为每个采样周期内采集的竖直距离的数量,N=75,每个采样周期的时长定义为T=0.15秒;
所述采样周期T定义为:所述检测器在所述架体水平斜向横梁2上由靠近所述架体竖直方向立柱1的一端匀速运动至远离所述架体竖直方向立柱1的一端的时长或者由远离所述架体竖直方向立柱1的一端匀速运动至靠近所述架体竖直方向立柱1的一端的时长,如图3所示;
步骤2中所述竖直距离数组为:
第m个采样周期内第n个采集的竖直距离数组,定义如下:
(hm,n,tm,n),m∈[1,10],n∈[1,75]
其中,tm,n表示第m个采样周期内第n个采集时刻,通过所述微处理器4进行计时M=10为采样周期的数量,N=75为每个采样周期内采集的竖直距离的数量;
步骤2计算所述检测器5实时位置为:
所述检测器5实时位置为所述检测器5位于所述架体水平斜向横梁的位置,具体计算如下:
m∈[1,10],n∈[1,75]
其中,lm,n表示第m个采样周期内第n个采集时刻的检测器实时位置,L=3米表示所述架体水平斜向横梁2的长度,tm,n表示第m个采样周期内第n个采集时刻,T=0.15秒表示每个采样周期的时长,M=10为采样周期的数量,N=75为每个采样周期内采集的竖直距离的数量;
步骤2所述空间时间数组为:
(xm,n,ym,n,hm,n,tm,n)
xm,n=lm,nsin45°
ym,n=lm,ncos45°
m∈[1,10],n∈[1,75]
其中,α=45°表示所述架体水平斜向横梁2与道路边缘线的夹角,xm,n表示所述检测器5在第m个采样周期内第n个采集时刻的空间坐标系中X轴坐标,ym,n表示所述检测器5在第m个采样周期内第n个采集时刻的空间坐标系中Y轴坐标,hm,n表示第m个采样周期内第n个采集时刻的竖直距离即,即所述检测器5在第m个采样周期内第n个采集时刻的空间坐标系中Z轴坐标,tm,n表示第m个采样周期内第n个采集时刻,M=10为采样周期的数量,N=75为每个采样周期内采集的竖直距离的数量;
步骤2所述通过空间时间数组定义检测点为:将(xm,n,ym,n,hm,n,tm,n)定义为所述检测器在第m个采样周期内第n个采集时刻的检测点;
步骤3:根据竖直距离计算车辆高度:
步骤3所述根据竖直距离计算车辆高度为:
步骤4:根据空间时间数组分别搜索车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值,通过车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆宽度;
步骤4根据空间时间数组搜索车辆宽度右侧边缘点最大值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,10],n∈[1,75]中找出所有满足hm,n+1-hm,n<0的检测点定义为车辆宽度右侧边缘点集合,具体为:
其中,I为车辆宽度右侧边缘点集合中检测点的数量;
根据车辆宽度右侧边缘点集合中空间坐标系中X轴坐标,搜索出空间坐标系中X轴坐标最大值为:
步骤4根据空间时间数组搜索车辆宽度左侧边缘点最小值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,10],n∈[1,75]中找出所有满足hm,n+1-hm,n>0的检测点定义为车辆宽度左侧边缘点集合,具体为:
其中,J为车辆宽度左侧边缘点集合中检测点的数量;
根据车辆宽度左侧边缘点集合中空间坐标系中X轴坐标,搜索出空间坐标系中X轴坐标最小值为:
步骤4所述计算车辆宽度为:
步骤5:根据车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆对称平面,在空间坐标系中根据车辆对称平面分别构建左侧X轴检测点对称集合、右侧X轴检测点对称集合,根据左侧X轴检测点对称集合、右侧X轴检测点对称集合计算X轴检测点距离,根据X轴检测点距离计算车辆速度,根据空间时间数组分别搜索车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值,通过车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值分别对应的时刻计算车辆扫描时长,根据车辆速度以及车辆扫描时长计算车辆长度;
步骤5所述根据车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆对称平面为:
步骤5所述在空间坐标系中根据车辆对称平面分别构建左侧X轴检测点对称集合、右侧X轴检测点对称集合为:
将空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,10],n∈[1,75]中在步骤1所述空间坐标系中,搜索到车辆对称平面距离相等的检测点;
车辆对称平面左侧的检测点构建步骤5所述左侧X轴检测点对称集合:
其中,K为左侧X轴检测点对称集合中检测点的数量,K=7;
车辆对称平面右侧的检测点构建步骤5所述右侧X轴检测点对称集合:
其中,K为右侧X轴检测点对称集合中检测点的数量,K=7;
所述到车辆对称平面距离相等的检测点为:
步骤5所述左侧X轴检测点对称集合、右侧X轴检测点对称集合计算X轴检测点距离为:
在所述左侧X轴检测点对称集合中遍历每个检测点即:
则右侧X轴检测点对称集合和左侧X轴检测点对称集合中,对称点间距离为:
e∈[1,7],g∈[1,7]
其中,Δxe为第e个X轴检测点距离;
如图4所示,步骤5所述根据X轴检测点距离计算车辆速度为:
在所述左侧X轴检测点对称集合中,e∈[1,K],检测点所在数组组数为第mA,e组,则在所述空间时间数组(xm,n,ym,n,hm,n,tm,n),m∈[1,M],n∈[1,N]中,第mA,e组检测点集合可表示为:
步骤5所述车辆关于第e对右侧左侧对称点计算出的速度为:
将e∈[1,7]所有对称点算出的车辆速度加权平均后,可得车辆平均速度为:
以家用汽车为例,右侧左侧第3对检测点信息分别为x4,49,y4,49,h4,49,t4,49和(x5,31,y5,31,h5,31,t5,31),则C点在左侧检测点所在组数第组中检测点信息为(x5,49,y5,49,h5,49,t5,49),则
Δx5=x4,49-x5,31=2.025米-1t249米=0.776米
t5,49-t4,49=0.155秒
则关于第5对右侧左侧对称点计算出的速度为
通过将e∈[1,7]所有对称点算出的车辆速度加权平均后可得:
步骤5所述根据空间时间数组分别搜索车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值为:
根据空间时间数组搜索车辆长度后侧边缘点最大值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,10],n∈[1,75]中找出所有满足hm,n+1-hm,n<0的检测点定义为车辆长度后侧边缘点集合,具体为:
其中,Q车辆长度后侧边缘点集合中检测点的数量;
根据车辆长度后侧边缘点集合中空间坐标系中Y轴坐标,搜索出空间坐标系中Y轴坐标最大值为:
步骤4根据空间时间数组搜索车辆长度前侧边缘点最小值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,10],n∈[1,75]中找出所有满足hm,n+1-hm,n>0的检测点定义为车辆长度前侧边缘点集合,具体为:
其中,P为车辆长度前侧边缘点集合中检测点的数量;
根据车辆长度前侧边缘点集合中空间坐标系中Y轴坐标,搜索出空间坐标系中Y轴坐标最小值为:
步骤5所述通过车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值分别对应的时刻计算车辆扫描时长为:
步骤5所述根据车辆速度以及车辆扫描时长计算车辆长度为:
通过计算出的车辆长宽高尺寸和实际尺寸相比,可知本发明方法精度高。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (5)
1.一种基于运动车辆的速度和外廓尺寸测量装置的测量方法,其特征在于:
所述运动车辆的速度和外廓尺寸测量装置包括:
架体竖直方向立柱、架体水平斜向横梁、步进电机、微处理器、检测器;
所述架体竖直方向立柱支撑立于道路边缘,所述架体水平斜向横梁与所述架体竖直方向立柱呈直角连接,所述架体水平斜向横梁与道路边缘线的夹角为α;所述检测器安装于所述架体水平斜向横梁下;所述步进电机安装于所述架体水平斜向横梁下;所述微处理器分别与所述的步进电机、检测器通过有线方式依次连接,所述微处理器位于架体竖直方向立柱上;
所述架体水平斜向横梁用于所述检测器来回移动的承载体,横梁的长度为车道宽度;
所述步进电机根据所述微处理器的控制信号,用于驱动所述检测器在架体水平斜向横梁上进行来回移动;
所述步进电机可正向驱动和反向驱动,用于驱动检测器往返移动;
所述检测器实时测量所述检测器至地面或车辆表面的竖直距离;所述检测器的移动范围为所述架体水平斜向横梁的长度;所述检测器由所述架体水平斜向横梁靠近所述架体竖直方向立柱的端点移动到远离所述架体竖直方向立柱的端点,或远离所述架体竖直方向立柱的端点移动到靠近所述架体竖直方向立柱的端点为一次扫描,每次扫描的数据为一组数据;
所述测量方法包括以下步骤:
步骤1:以架体水平斜向横梁的左极限在地面上的投影为中心建立空间坐标系,X轴轴向为道路两侧连线方向,Y轴轴向为道路沿线方向,Z轴轴向为架体竖直方向立柱的竖直方向;
步骤2:所述检测器初始位置位于所述架体水平斜向横梁靠近架体竖直方向立柱的端点,所述检测器在所述架体水平斜向横梁匀速往返移动,微处理器通过所述检测器实时采集竖直距离,根据竖直距离构建竖直距离数组,计算所述检测器实时位置,根据所述检测器实时位置进一步构建空间时间数组,通过空间时间数组定义检测点;
步骤3:根据竖直距离计算车辆高度;
步骤4:根据空间时间数组分别搜索车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值,通过车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆宽度;
步骤5:根据车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆对称平面,在空间坐标系中根据车辆对称平面分别构建左侧X轴检测点对称集合、右侧X轴检测点对称集合,根据左侧X轴检测点对称集合、右侧X轴检测点对称集合计算X轴检测点距离,根据X轴检测点距离计算车辆速度,根据空间时间数组分别搜索车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值,通过车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值分别对应的时刻计算车辆扫描时长,根据车辆速度以及车辆扫描时长计算车辆长度。
2.根据权利要求1所述的基于运动车辆的速度和外廓尺寸测量装置的测量方法,其特征在于:步骤2中所述竖直距离数组为:
hm,n,m∈[1,M],n∈[1,N]
其中,hm,n表示第m个采样周期内第n个采集时刻的竖直距离,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量,每个采样周期的时长定义为T;
所述采样周期T定义为:所述检测器在所述架体水平斜向横梁上由靠近所述架体竖直方向立柱的一端匀速运动至远离所述架体竖直方向立柱的一端的时长或者由远离所述架体竖直方向立柱的一端匀速运动至靠近所述架体竖直方向立柱的一端的时长;
步骤2中所述竖直距离数组为:
第m个采样周期内第n个采集的竖直距离数组,定义如下:
(hm,n,tm,n),m∈[1,M],n∈[1,N]
其中,tm,n表示第m个采样周期内第n个采集时刻,通过所述微处理器进行计时,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量;
步骤2计算所述检测器实时位置为:
所述检测器实时位置为所述检测器位于所述架体水平斜向横梁的位置,具体计算如下:
其中,lm,n表示第m个采样周期内第n个采集时刻的检测器实时位置,L表示所述架体水平斜向横梁的长度,tm,n表示第m个采样周期内第n个采集时刻,T表示每个采样周期的时长,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量;
步骤2所述空间时间数组为:
(xm,n,ym,n,hm,n,tm,n)
xm,n=lm,nsinα
ym,n=lm,ncosα
m∈[1,M],n∈[1,N]
其中,α表示所述架体水平斜向横梁与道路边缘线的夹角,xm,n表示所述检测器在第m个采样周期内第n个采集时刻的空间坐标系中X轴坐标,ym,n表示所述检测器在第m个采样周期内第n个采集时刻的空间坐标系中Y轴坐标,hm,n表示第m个采样周期内第n个采集时刻的竖直距离,即所述检测器在第m个采样周期内第n个采集时刻的空间坐标系中Z轴坐标,tm,n表示第m个采样周期内第n个采集时刻,M为采样周期的数量,N为每个采样周期内采集的竖直距离的数量;
步骤2所述通过空间时间数组定义检测点为:将(xm,n,ym,n,hm,n,tm,n)定义为所述检测器在第m个采样周期内第n个采集时刻的检测点。
4.根据权利要求1所述的基于运动车辆的速度和外廓尺寸测量装置的测量方法,其特征在于:步骤4根据空间时间数组搜索车辆宽度右侧边缘点最大值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n<0的检测点定义为车辆宽度右侧边缘点集合,具体为:
其中,I为车辆宽度右侧边缘点集合中检测点的数量;
根据车辆宽度右侧边缘点集合中空间坐标系中X轴坐标,搜索出空间坐标系中X轴坐标最大值为:
步骤4根据空间时间数组搜索车辆宽度左侧边缘点最小值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n>0的检测点定义为车辆宽度左侧边缘点集合,具体为:
其中,J为车辆宽度左侧边缘点集合中检测点的数量;
根据车辆宽度左侧边缘点集合中空间坐标系中X轴坐标,搜索出空间坐标系中X轴坐标最小值为:
步骤4所述计算车辆宽度为:
5.根据权利要求1所述的基于运动车辆的速度和外廓尺寸测量装置的测量方法,其特征在于:步骤5所述根据车辆宽度右侧边缘点最大值、车辆宽度左侧边缘点最小值计算车辆对称平面为:
步骤5所述在空间坐标系中根据车辆对称平面分别构建左侧X轴检测点对称集合、右侧X轴检测点对称集合为:
将空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中在步骤1所述空间坐标系中,搜索到车辆对称平面距离相等的检测点;
车辆对称平面左侧的检测点构建步骤5所述左侧X轴检测点对称集合:
其中,K为左侧X轴检测点对称集合中检测点的数量;
车辆对称平面右侧的检测点构建步骤5所述右侧X轴检测点对称集合:
其中,K为右侧X轴检测点对称集合中检测点的数量;
所述到车辆对称平面距离相等的检测点为:
步骤5所述左侧X轴检测点对称集合、右侧X轴检测点对称集合计算X轴检测点距离为:
在所述左侧X轴检测点对称集合中遍历每个检测点即:
则右侧X轴检测点对称集合和左侧X轴检测点对称集合中,对称点间距离为:
其中,Δxe为第e个X轴检测点距离;
步骤5所述根据X轴检测点距离计算车辆速度为:
步骤5所述车辆关于第e对右侧左侧对称点计算出的速度为:
将e∈[1,K]所有对称点算出的车辆速度加权平均后,可得车辆平均速度为:
步骤5所述根据空间时间数组分别搜索车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值为:
根据空间时间数组搜索车辆长度后侧边缘点最大值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n<0的检测点定义为车辆长度后侧边缘点集合,具体为:
其中,Q车辆长度后侧边缘点集合中检测点的数量;
根据车辆长度后侧边缘点集合中空间坐标系中Y轴坐标,搜索出空间坐标系中Y轴坐标最大值为:
步骤4根据空间时间数组搜索车辆长度前侧边缘点最小值为:
在所述空间时间数组(xm,n,ym,n,hm,n,tm,n)中,m∈[1,M],n∈[1,N]中找出所有满足hm,n+1-hm,n>0的检测点定义为车辆长度前侧边缘点集合,具体为:
其中,P为车辆长度前侧边缘点集合中检测点的数量;
根据车辆长度前侧边缘点集合中空间坐标系中Y轴坐标,搜索出空间坐标系中Y轴坐标最小值为:
步骤5所述通过车辆长度后侧边缘点最大值、车辆长度前侧边缘点最小值分别对应的时刻计算车辆扫描时长为:
步骤5所述根据车辆速度以及车辆扫描时长计算车辆长度为:
其中,Lcar为车辆长度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010181547.1A CN111322964B (zh) | 2020-03-16 | 2020-03-16 | 一种运动车辆的速度和外廓尺寸测量系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010181547.1A CN111322964B (zh) | 2020-03-16 | 2020-03-16 | 一种运动车辆的速度和外廓尺寸测量系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111322964A CN111322964A (zh) | 2020-06-23 |
CN111322964B true CN111322964B (zh) | 2021-01-15 |
Family
ID=71167537
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010181547.1A Active CN111322964B (zh) | 2020-03-16 | 2020-03-16 | 一种运动车辆的速度和外廓尺寸测量系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111322964B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105492862A (zh) * | 2013-07-01 | 2016-04-13 | 萨科希瑞斯先进控制有限公司 | 用于光学地形状检测和/或检查物体的方法和设备 |
CN106017334A (zh) * | 2016-08-01 | 2016-10-12 | 山东科大微机应用研究所有限公司 | 一种可移动式激光扫描车辆外轮廓尺寸的测量方法 |
CN107609734A (zh) * | 2017-08-03 | 2018-01-19 | 西南交通大学 | 一种高速铁路规格化列车运行图的周期确定方法 |
CN108132025A (zh) * | 2017-12-24 | 2018-06-08 | 上海捷崇科技有限公司 | 一种车辆三维轮廓扫描构建方法 |
CN109828282A (zh) * | 2019-01-31 | 2019-05-31 | 浙江工业大学 | 一种基于激光雷达的车辆外廓尺寸自动检测系统及方法 |
US10401147B2 (en) * | 2005-05-10 | 2019-09-03 | Continental Advanced Lidar Solutions Us, Llc | Dimensioning system |
CN110763142A (zh) * | 2019-11-05 | 2020-02-07 | 广西云高智能停车设备有限公司 | 一种慢速运动车辆外廓尺寸测量方法 |
-
2020
- 2020-03-16 CN CN202010181547.1A patent/CN111322964B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10401147B2 (en) * | 2005-05-10 | 2019-09-03 | Continental Advanced Lidar Solutions Us, Llc | Dimensioning system |
CN105492862A (zh) * | 2013-07-01 | 2016-04-13 | 萨科希瑞斯先进控制有限公司 | 用于光学地形状检测和/或检查物体的方法和设备 |
CN106017334A (zh) * | 2016-08-01 | 2016-10-12 | 山东科大微机应用研究所有限公司 | 一种可移动式激光扫描车辆外轮廓尺寸的测量方法 |
CN107609734A (zh) * | 2017-08-03 | 2018-01-19 | 西南交通大学 | 一种高速铁路规格化列车运行图的周期确定方法 |
CN108132025A (zh) * | 2017-12-24 | 2018-06-08 | 上海捷崇科技有限公司 | 一种车辆三维轮廓扫描构建方法 |
CN109828282A (zh) * | 2019-01-31 | 2019-05-31 | 浙江工业大学 | 一种基于激光雷达的车辆外廓尺寸自动检测系统及方法 |
CN110763142A (zh) * | 2019-11-05 | 2020-02-07 | 广西云高智能停车设备有限公司 | 一种慢速运动车辆外廓尺寸测量方法 |
Non-Patent Citations (1)
Title |
---|
一种基于车道线检测的自动驾驶预行驶区域判别方法;高嵩等;《激光杂志》;20180731;第39卷(第7期);第37-41页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111322964A (zh) | 2020-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111352112B (zh) | 基于视觉、激光雷达和毫米波雷达的目标检测方法 | |
CN108132025B (zh) | 一种车辆三维轮廓扫描构建方法 | |
AU2014202300B2 (en) | Traffic monitoring system for speed measurement and assignment of moving vehicles in a multi-target recording module | |
CN102679889B (zh) | 车辆尺寸的测量方法和装置 | |
Sugimoto et al. | Obstacle detection using millimeter-wave radar and its visualization on image sequence | |
US5475494A (en) | Driving environment surveillance apparatus | |
US6628804B1 (en) | Method and apparatus for measuring speed of vehicle | |
CN109752701A (zh) | 一种基于激光点云的道路边沿检测方法 | |
US20050196034A1 (en) | Obstacle detection system and method therefor | |
CN109059792A (zh) | 动态三维隧道断面形变检测及分析系统、方法及装置 | |
JP2004530144A (ja) | 画像情報を提供する方法 | |
CN113552554A (zh) | 多线激光雷达以及使用多线激光雷达进行探测的方法 | |
CN106370884A (zh) | 基于双目相机计算机视觉技术的车辆测速方法 | |
CN208736365U (zh) | 动态三维隧道断面形变检测及分析系统 | |
CN101206229A (zh) | 一种基于线阵ccd图像的车辆速度匹配方法 | |
CN112735135A (zh) | 高速运动车辆超限检测方法 | |
CN110530290A (zh) | 隧道断面的激光扫描测量装置及方法 | |
CN110189363A (zh) | 一种机场场面移动目标低视角视频测速方法 | |
CN111322964B (zh) | 一种运动车辆的速度和外廓尺寸测量系统 | |
WO2018180245A1 (ja) | 出力装置、制御方法、プログラム及び記憶媒体 | |
CN116385516B (zh) | 一种静态车辆外廓检测方法、系统、装置及存储介质 | |
JP2019211403A (ja) | 対象位置計測装置及び対象位置計測プログラム | |
CN115407305B (zh) | 一种基于激光雷达的水平二维风场获取方法和装置 | |
CN111539305A (zh) | 一种地图构建方法及系统、车辆及存储介质 | |
CN116263320A (zh) | 车辆测量方法、装置、系统及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |