CN103247199B - 一种机动车移动位置和姿态的精确测量方法 - Google Patents
一种机动车移动位置和姿态的精确测量方法 Download PDFInfo
- Publication number
- CN103247199B CN103247199B CN201310179787.8A CN201310179787A CN103247199B CN 103247199 B CN103247199 B CN 103247199B CN 201310179787 A CN201310179787 A CN 201310179787A CN 103247199 B CN103247199 B CN 103247199B
- Authority
- CN
- China
- Prior art keywords
- motor vehicle
- rtk gps
- point
- examination
- coordinates
- 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
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种机动车移动位置和姿态的精确测量方法,包括有测量前的准备和实时测量步骤,测量前的准备包括有建立RTKGPS基准站、建立无线数据通信链路、绘制考试场地或考试道路电子地图、在机动车上安装车载检测设备和测量机动车轮廓关键点的相对坐标;实时测量包括测量计算机动车在考试场地或考试道路电子地图上的精确三维位置坐标、姿态角以及与其它各种标志、标线和静态物体的位置关系。本发明无需在考试场地或考试道路上设置测量设备,测量时直接采用车载检测设备与基准站的通讯实现检测,降低了机动车位置和姿态检测设备使用时的运营成本;且检测方式简单,操作方便,可不间断进行检测,测量精准度高。
Description
技术领域
本发明涉及机动车驾驶技能自动检测技术领域,具体是一种基于载波相位实时动态差分技术(RTK)、全球卫星定位技术(GPS)、地理信息***处理技术(GIS)、无线数据通讯技术和计算机技术实现的、用于对已知场地或道路上机动车的位置和姿态进行实时、精确测量的方法。
背景技术
驾驶人在取得机动车驾驶证前,需要通过场地驾驶技能和道路驾驶技能的考试,即俗称的“科目二考试”和“科目三考试”;前者用于考核驾驶人在常见道路、常见交通环境、常见气候条件和突发交通状况下对机动车的操控能力,以及对交通事件的处理能力;后者用于考核驾驶人在实际道路驾驶机动车时对机动车的操控能力、对交通法规的识别和遵守能力、对道路交通情况的处理能力、以及文明驾驶、安全驾驶的意识。
在科目二考试和科目三考试中,有许多项目的考核涉及对机动车是否碰杆、是否压线、车身是否出线、车身与道路上停车线之间的距离、车轮是否压饼等项目的检测;原有的科目二自动化考试***需要在考试场地上埋设大量传感器来对车辆的位置状态、行驶信息进行采集,科目三只能做到人工考试;这使得机动车驾驶技能的考试难于实现自动化,自动化评判项目比例低,且考试场地建设成本大,维修维护困难。
发明内容
本发明要解决的技术问题是提供一种机动车移动位置和姿态的精确测量方法,可对机动车位置和姿态进行实时精确的检测,进而实现机动车驾驶技能考试的自动化。
本发明的技术方案为:
一种机动车移动位置和姿态的精确测量方法,具体包括以下步骤:
(1)、测量前的准备:包括有建立RTK GPS基准站、建立无线数据通信链路、绘制考试场地或考试道路电子地图、在机动车上安装车载检测设备和测量机动车轮廓关键点的相对坐标;
a、建立RTK GPS基准站:以RTK GPS基准站为原点确立整个考试场地或考试道路的三维空间坐标系,以东西向、南北向和高度分别作为三维坐标系的X轴、Y轴、Z轴;
b、建立无线数据通信链路:在RTK GPS基准站和RTK GPS移动站之间建立无线数据通信链路;
c、绘制考试场地或考试道路电子地图:将手持式RTK GPS移动站放置于考试场地或考试道路上的各种标志、标线和静态物体所处的位置处,并通过载波相位信息实时动态差分技术进行测绘,得到各种标志、标线和静态物体在考试场地或考试道路的空间坐标系中的精确坐标值或坐标方程,最后将绘制好的考试场地或考试道路电子地图存储于检测计算机中;
d、在机动车上安装车载检测设备:载检测设备包括两个安装于机动车车体外部的车载式RTK GPS移动站、一个无线数据接受电台和一个检测计算机;
e、测量机动车轮廓关键点的相对坐标:将手持式RTK GPS移动站放置于机动车轮廓的各关键点位置并通过载波相位信息实时动态差分技术进行测绘,得到机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值;
(2)、实时测量:测量计算机动车在考试场地或考试道路电子地图上的精确三维位置坐标、姿态角以及与其它各种标志、标线和静态物体的位置关系,具体包括以下步骤:
a、首先利用两个车载式RTK GPS移动站,在机动车移动时可以得到机动车上两个车载式RTK GPS移动站的经度、纬度和高度数据,并将此数据传送到检测计算机中,检测计算机经过坐标变换,得到两个车载式RTK GPS移动站的三维位置坐标,并通过计算得到机动车的姿态角;
b、检测计算机根据两个车载式RTK GPS移动站的三维位置坐标和机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值数据,计算得到机动车轮廓各关键点的三维位置坐标,即得到机动车在考试场地或考试道路电子地图中的准确轮廓位置;
c、检测计算机根据机动车轮廓各关键点的三维位置坐标和各种标志、标线和静态物体在考试场地或考试道路的空间坐标系中的精确坐标值或坐标方程计算得到机动车相对各种标志、标线和静态物体的距离。
所述的载波相位信息实时动态差分技术包括以下步骤:首先RTK GPS基准站把通过GPS卫星自身观测得到的载波相位信息传送到RTK GPS移动站上,然后RTK GPS移动站接收RTK GPS基准站发送的载波相位信息,同时RTK GPS移动站实时接收GPS卫星发送的移动站自身载波相位信息,最后根据差分解算,得到RTK GPS移动站在考试场地或考试道路三维空间坐标系中的坐标值。
所述的机动车轮廓的关键点包括有前、后保险杠的凸出点,机动车投影在大地平面的四个端点,机动车左、右面的凸出点,机动车左、右后视镜的凸出点,机动车四个车轮的内、外侧触地点。
所述的无线数据通信链路即在RTK GPS基准站上连接无线数据发射电台,在RTK GPS移动站连接与无线数据发射电台配合的无线数据接受电台,通过两者的发射-接受实现无线信息传输。
所述的两个车载式RTK GPS移动站安装于机动车的车顶,且位于机动车前后中心连线上。
所述的机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值的测量计算方法是:首先通过载波相位信息实时动态差分技术得到静止的机动车上的两个车载式RTK GPS移动站的三维坐标值分别为S10(x10,y10,z10)、S20(x20,y20,z20),并通过载波相位信息实时动态差分技术得到某机动车轮廓某一关键点Pi的三维坐标值为Pi0(Pix0,Piy0,Piz0),则Pi点分别与两个车载式RTK GPS移动站相对的三维坐标值为PiS1(Pix0-x10,Piy0-y10,Piz0-z10)、PiS2(Pix0-x20,Piy0-y20,Piz0-z20);依次类推,可以得到机动车轮廓的各关键点的相对三维坐标值。
所述的机动车的姿态角的计算即采用“二点定位法”计算得到,具体包括以下步骤:机动车上两个车载式RTK GPS移动站的坐标值随机动车移动而发生变化,其坐标值通过载波相位信息实时动态差分技术实时测得为S1(x1,y1,z1)、S2(x2,y2,z2),且S1、S2点组成的向量与机动车运动方向一致;机动车与三个坐标面YOZ、XOZ、XOY的夹角等于向量与这三个坐标面的夹角θx、θy、θz,其中:
若x2>x1,θx为正;若x2<x1,θx为负;
若y2>y1,θy为正;若y2<y1,θy为负;
若z2>z1,θz为正;若z2<z1,θz为负;
所述的机动车轮廓关键点的三维位置坐标定义为Pi(Pix,Piy,Piz),其三维实时坐标值为:
最后通过得到的Pi(Pix,Piy,Piz)与考试场地或考试道路电子地图比较后,得到机动车车身在该考试场地或考试道路上的准确轮廓位置。
所述的机动车相对各种标志、标线和静态物体的距离具体采用以下步骤计算得到:
①、机动车与标线间的位置关系:
标线的空间直线方程采用下式来表示:{A1x+B1y+C1z+D1=0,A2x+B2y+C2z+D2=0},其中,A1、B1、C1、D1、A2、B2、C2、D2均为直线方程系数,空间直线方程的起始点和结束点分别为(x1,y1,z1),(x2,y2,z2)];则机动车车身轮廓的关键点Pi(Pix,Piy,Piz)到该标线的距离d为:
其中:δ1=A1Pix+B1Piy+C1Piz+D1,δ2=A2Pix+B2Piy+C2Piz+D2,
②、机动车与“点状”静态物体间的位置关系:
机动车前、后、左、右四个侧面分别用以下四个空间平面方程来描述:{Aix+Biy+Ciz+Di=0,i=1,2,3,4},其中,i代表不同侧面的定义,Ai、Bi、Ci、Di均为方程系数,“点状”静态物体的三维坐标为S(Sx,Sy,Sz),则机动车四个侧面分别到“点状”静态物体的距离di为:
③、机动车与静态物体间的位置关系:
静态物体在考试场地或考试道路的电子地图中用一个区域π{(XWl,Xw2),(Yw1,Yw2),(Zw1,Zw2)}来表示,机动车四个车轮的位置通常用其内、外侧着地点Wi{Wix,Wiy,Wiz},i=1,2来确定,其中,i代表车轮内外侧的定义,然后找车车轮的实时位置坐标Wi是否位于静态物体区域π内来判断是否压轧静态物体。
本发明的优点:
(1)、本发明无需在考试场地或考试道路安装任何机动车位置和姿态检测设备,节省大量场地检测设备和基础建设投入,投资少,施工周期短;
(2)、本发明用于检测信号和计算处理的车载检测设备集中安装于考车上,降低了机动车位置和姿态检测设备使用时的运营成本,由于在考试场地和考试道路上没有设备,不需要设备维护,无配件消耗,管理成本低;
(3)、本发明在机动车驾驶技能考试***中使用,可以提高考试项目的自动化检测比例,大大提高机动车驾驶技能考试***的规范化、自动化、智能化程度;
(4)、本发明提高了机动车驾驶技能考试和训练效率,可以连续不间断地发车,可以选择多个起点和终点,可以考试和训练同时进行;
(5)、本发明的使用,可以在同一个考场或考试道路进行各种不同车型的考训,节约大量土地资源,大大降低考训中心或学校的土地建设成本,满足社会发展对驾驶技能培训和考试的需求;
(6)、本发明提高了驾驶技能自动化考试***的升级扩展能力,评判规则的修改只需升级软件就可完成,考试能力增减只需修改考试项目数量配置文件即可。
附图说明
图1是本发明的结构示意图。
图2是本发明RTK GPS基准站的工作原理图。
图3是本发明车载检测设备的工作原理图。
具体实施方式
一种机动车移动位置和姿态的精确测量方法,具体包括以下步骤:
(1)、测量前的准备:包括有建立RTK GPS基准站2、建立无线数据通信链路、绘制考试场地或考试道路电子地图、在机动车3上安装车载检测设备4和测量机动车轮廓关键点的相对坐标;
a、建立RTK GPS基准站:以RTK GPS基准站2为原点确立整个考试场地或考试道路的三维空间坐标系,以东西向、南北向和高度分别作为三维坐标系的X轴、Y轴、Z轴;
b、建立无线数据通信链路:在RTK GPS基准站2和RTK GPS移动站之间建立无线数据通信链路;无线数据通信链路即在RTK GPS基准站2上连接无线数据发射电台5,在RTK GPS移动站连接与无线数据发射电台5配合的无线数据接受电台,通过两者的发射-接受实现无线信息传输;
c、绘制考试场地或考试道路电子地图:将手持式RTK GPS移动站放置于考试场地或考试道路上的各种标志、标线和静态物体所处的位置处,并通过载波相位信息实时动态差分技术进行测绘,得到各种标志、标线和静态物体在考试场地或考试道路的空间坐标系中的精确坐标值或坐标方程,最后将绘制好的考试场地或考试道路电子地图存储于检测计算机中;其中,载波相位信息实时动态差分技术包括以下步骤:首先RTK GPS基准站2把通过GPS卫星1自身观测得到的载波相位信息传送到RTK GPS移动站上,然后RTK GPS移动站接收RTK GPS基准站2发送的载波相位信息,同时RTK GPS移动站实时接收GPS卫星1发送的移动站自身载波相位信息,最后根据差分解算,得到RTK GPS移动站在考试场地或考试道路三维空间坐标系中的坐标值;
d、在机动车上安装车载检测设备:载检测设备4包括两个安装于机动车3的车顶且位于机动车3前后中心连线上的车载式RTK GPS移动站42、一个无线数据接受电台41和一个检测计算机43;
e、测量机动车轮廓关键点的相对坐标:将手持式RTK GPS移动站放置于机动车3轮廓的各关键点位置并通过载波相位信息实时动态差分技术进行测绘,得到机动车轮廓的各关键点(机动车轮廓的关键点包括有前、后保险杠的凸出点,机动车投影在大地平面的四个端点,机动车左、右面的凸出点,机动车左、右后视镜的凸出点,机动车四个车轮的内、外侧触地点)相对于两个车载式RTKGPS移动站42的三维坐标值;机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值的测量计算方法是:首先通过载波相位信息实时动态差分技术得到静止的机动车上的两个车载式RTK GPS移动站42的三维坐标值分别为S10(x10,y10,z10)、S20(x20,y20,z20),并通过载波相位信息实时动态差分技术得到某机动车3轮廓某一关键点Pi的三维坐标值为Pi0(Pix0,Piy0,Piz0),则Pi点分别与两个车载式RTK GPS移动站42相对的三维坐标值为PiS1(Pix0-x10,Piy0-y10,Piz0-z10)、PiS2(Pix0-x20,Piy0-y20,Piz0-z20);依次类推,可以得到机动车3轮廓的各关键点的相对三维坐标值
(2)、实时测量:测量计算机动车3在考试场地或考试道路电子地图上的精确三维位置坐标、姿态角以及与其它各种标志、标线和静态物体的位置关系,具体包括以下步骤:
a、首先利用两个车载式RTK GPS移动站42,在机动车3移动时可以得到机动车上两个车载式RTK GPS移动站42的经度、纬度和高度数据,并将此数据传送到检测计算机43中,检测计算机43经过坐标变换,得到两个车载式RTK GPS移动站42的三维位置坐标,并通过计算得到机动车的姿态角;
b、检测计算机43根据两个车载式RTK GPS移动站42的三维位置坐标和机动车轮廓的各关键点相对于两个车载式RTK GPS移动站42的三维坐标值数据,计算得到机动车3轮廓各关键点的三维位置坐标,即得到机动车3在考试场地或考试道路电子地图中的准确轮廓位置;
上述机动车3的姿态角的计算即采用“二点定位法”计算得到,具体包括以下步骤:机动车上两个车载式RTK GPS移动站的坐标值随机动车移动而发生变化,其坐标值通过载波相位信息实时动态差分技术实时测得为S1(x1,y1,z1)、S2(x2,y2,z2),且S1、S2点组成的向量与机动车运动方向一致;机动车与三个坐标面YOZ、XOZ、XOY的夹角等于向量与这三个坐标面的夹角θx、θy、θz,其中:
若x2>x1,θx为正;若x2<x1,θx为负;
若y2>y1,θy为正;若y2<y1,θy为负;
若z2>z1,θz为正;若z2<z1,θz为负;
所述的机动车轮廓关键点的三维位置坐标定义为Pi(Pix,Piy,Piz),其三维实时坐标值为:
最后通过得到的Pi(Pix,Piy,Piz)与考试场地或考试道路电子地图比较后,得到机动车车身在该考试场地或考试道路上的准确轮廓位置;
c、检测计算机根据机动车轮廓各关键点的三维位置坐标和各种标志、标线和静态物体在考试场地或考试道路的空间坐标系中的精确坐标值或坐标方程计算得到机动车相对各种标志、标线和静态物体的距离;
机动车相对各种标志、标线和静态物体的距离具体采用以下步骤计算得到:
①、机动车与标线间的位置关系:
标线的空间直线方程采用下式来表示:{A1x+B1y+C1z+D1=0,A2x+B2y+C2z+D2=0},其中,Al、Bl、Cl、D1、A2、B2、C2、D2均为直线方程系数,空间直线方程的起始点和结束点分别为(x1,y1,z1),(x2,y2,z2)];则机动车车身轮廓的关键点Pi(Pix,Piy,Piz)到该标线的距离d为:
其中:δ1=A1Pix+B1Piy+C1Piz+D1,δ2=A2Pix+B2Piy+C2Piz+D2,
②、机动车与“点状”静态物体间的位置关系:
机动车前、后、左、右四个侧面分别用以下四个空间平面方程来描述:{Aix+Biy+Ciz+Di=0,i=1,2,3,4},其中,i代表不同侧面的定义,Ai、Bi、Ci、Di均为方程系数,“点状”静态物体的三维坐标为S(Sx,Sy,Sz),则机动车四个侧面分别到“点状”静态物体的距离di为:
③、机动车与静态物体间的位置关系:
静态物体在考试场地或考试道路的电子地图中用一个区域π{(Xw1,Xw2),(Yw1,Yw2),(Zw1,Zw2)}来表示,机动车四个车轮的位置通常用其内、外侧着地点Wi{Wix,Wiy,Wiz},i=1,2来确定,其中,i代表车轮内外侧的定义,然后找车车轮的实时位置坐标Wi是否位于静态物体区域π内来判断是否压轧静态物体。
Claims (8)
1.一种机动车移动位置和姿态的精确测量方法,其特征在于:具体包括以下步骤:
(1)、测量前的准备:包括有建立RTK GPS基准站、建立无线数据通信链路、绘制考试场地或考试道路电子地图、在机动车上安装车载检测设备和测量机动车轮廓关键点的相对坐标;
a、建立RTK GPS基准站:以RTK GPS基准站为原点确立整个考试场地或考试道路的三维空间坐标系,以东西向、南北向和高度分别作为三维坐标系的X轴、Y轴、Z轴;
b、建立无线数据通信链路:在RTK GPS基准站和RTK GPS移动站之间建立无线数据通信链路;
c、绘制考试场地或考试道路电子地图:将手持式RTK GPS移动站放置于考试场地或考试道路上的各种标志、标线和静态物体所处的位置处,并通过载波相位信息实时动态差分技术进行测绘,得到各种标志、标线和静态物体在考试场地或考试道路的空间坐标系中的精确坐标值或坐标方程,最后将绘制好的考试场地或考试道路电子地图存储于检测计算机中;
d、在机动车上安装车载检测设备:车载检测设备包括两个安装于机动车车体外部的车载式RTK GPS移动站、一个无线数据接受电台和一个检测计算机;
e、测量机动车轮廓关键点的相对坐标:将手持式RTK GPS移动站放置于机动车轮廓的各关键点位置并通过载波相位信息实时动态差分技术进行测绘,得到机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值;
(2)、实时测量:测量计算机动车在考试场地或考试道路电子地图上的精确三维位置坐标、姿态角以及与其它各种标志、标线和静态物体的位置关系,具体包括以下步骤:
a、首先利用两个车载式RTK GPS移动站,在机动车移动时可以得到机动车 上两个车载式RTK GPS移动站的经度、纬度和高度数据,并将此数据传送到检测计算机中,检测计算机经过坐标变换,得到两个车载式RTK GPS移动站的三维位置坐标,并通过计算得到机动车的姿态角;
b、检测计算机根据两个车载式RTK GPS移动站的三维位置坐标和机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值数据,计算得到机动车轮廓各关键点的三维位置坐标,即得到机动车在考试场地或考试道路电子地图中的准确轮廓位置;
c、检测计算机根据机动车轮廓各关键点的三维位置坐标和各种标志、标线和静态物体在考试场地或考试道路的空间坐标系中的精确坐标值或坐标方程计算得到机动车相对各种标志、标线和静态物体的距离。
2.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征在于:所述的载波相位信息实时动态差分技术包括以下步骤:首先RTK GPS基准站把通过GPS卫星自身观测得到的载波相位信息传送到RTK GPS移动站上,然后RTK GPS移动站接收RTK GPS基准站发送的载波相位信息,同时RTK GPS移动站实时接收GPS卫星发送的移动站自身载波相位信息,最后根据差分解算,得到RTK GPS移动站在考试场地或考试道路三维空间坐标系中的坐标值。
3.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征在于:所述的机动车轮廓的关键点包括有前、后保险杠的凸出点,机动车投影在大地平面的四个端点,机动车左、右面的凸出点,机动车左、右后视镜的凸出点,机动车四个车轮的内、外侧触地点。
4.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征在于:所述的无线数据通信链路即在RTK GPS基准站上连接无线数据发射电台,在RTK GPS移动站连接与无线数据发射电台配合的无线数据接受电台,通过两者的发射-接受实现无线信息传输。
5.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征 在于:所述的两个车载式RTK GPS移动站安装于机动车的车顶,且位于机动车前后中心连线上。
6.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征在于:所述的机动车轮廓的各关键点相对于两个车载式RTK GPS移动站的三维坐标值的测量计算方法是:首先通过载波相位信息实时动态差分技术得到静止的机动车上的两个车载式RTK GPS移动站的三维坐标值分别为S10(x10,y10,z10)、S20(x20,y20,z20),并通过载波相位信息实时动态差分技术得到某机动车轮廓某一关键点Pi的三维坐标值为Pi0(Pix0,Piy0,Piz0),则Pi点分别与两个车载式RTK GPS移动站相对的三维坐标值为PiS1(Pix0-x10,Piy0-y10,Piz0-z10)、PiS2(Pix0-x20,Piy0-y20,Piz0-z20);依次类推,可以得到机动车轮廓的各关键点的相对三维坐标值。
7.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征在于:所述的机动车的姿态角的计算即采用“二点定位法”计算得到,具体包括以下步骤:机动车上两个车载式RTK GPS移动站的坐标值随机动车移动而发生变化,其坐标值通过载波相位信息实时动态差分技术实时测得为S1(x1,y1,z1)、S2(x2,y2,z2),且S1、S2点组成的向量与机动车运动方向一致;机动车与三个坐标面YOZ、XOZ、XOY的夹角等于向量与这三个坐标面的夹角θx、θy、θz,其中:
若x2>x1,θx为正;若x2<x1,θx为负;
若y2>y1,θy为正;若y2<y1,θy为负;
若z2>z1,θz为正;若z2<z1,θz为负;
所述的机动车轮廓关键点的三维位置坐标定义为Pi(Pix,Piy,Piz),其三维实时坐标值为:
最后通过得到的Pi(Pix,Piy,Piz)与考试场地或考试道路电子地图比较后,得到机动车车身在该考试场地或考试道路上的准确轮廓位置。
8.根据权利要求1所述的机动车移动位置和姿态的精确测量方法,其特征在于:所述的机动车相对各种标志、标线和静态物体的距离具体采用以下步骤计算得到:
①、机动车与标线间的位置关系:
标线的空间直线方程采用下式来表示:{A1x+B1y+C1z+D1=0,A2x+B2y+C2z+D2=0},其中,Al、Bl、Cl、D1、A2、B2、C2、D2均为直线方程系数,空间直线方程的起始点和结束点分别为(x1,y1,z1),(x2,y2,z2)];则机动车车身轮廓的关键点Pi(Pix,Piy,Piz)到该标线的距离d为:
其中:δ1=A1Pix+B1Piy+C1Piz+D1,δ2=A2Pix+B2Piy+C2Piz+D2,
②、机动车与“点状”静态物体间的位置关系:
机动车前、后、左、右四个侧面分别用以下四个空间平面方程来描述:{Aix+Biy+Ciz+Di=0,i=1,2,3,4},其中,i代表不同侧面的定义,Ai、Bi、Ci、Di均为方程系数,“点状”静态物体的三维坐标为S(Sx,Sy,Sz),则机动车四个侧面分别到“点状”静态物体的距离di为:
③、机动车与静态物体间的位置关系:
静态物体在考试场地或考试道路的电子地图中用一个区域π{(Xw1,Xw2),(Yw1,Yw2),(Zw1,Zw2)}来表示,机动车四个车轮的位置通常用其内、外侧着地点Wi{Wix,Wiy,Wiz},i=1,2来确定,其中,i代表车轮内外侧的定义,然后找车车轮的实时位置坐标Wi是否位于静态物体区域π内来判断是否压轧静态物体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310179787.8A CN103247199B (zh) | 2013-05-15 | 2013-05-15 | 一种机动车移动位置和姿态的精确测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310179787.8A CN103247199B (zh) | 2013-05-15 | 2013-05-15 | 一种机动车移动位置和姿态的精确测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103247199A CN103247199A (zh) | 2013-08-14 |
CN103247199B true CN103247199B (zh) | 2015-03-11 |
Family
ID=48926696
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310179787.8A Active CN103247199B (zh) | 2013-05-15 | 2013-05-15 | 一种机动车移动位置和姿态的精确测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103247199B (zh) |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103077638A (zh) * | 2012-12-12 | 2013-05-01 | 石家庄华燕交通科技有限公司 | 一种应用gps设备检验考核驾驶人场地考试的方法 |
CN103594008A (zh) * | 2013-10-29 | 2014-02-19 | 南京多伦科技股份有限公司 | 基于北斗定位和数字建模相结合技术的路考评判方法 |
CN103985282B (zh) * | 2014-05-29 | 2016-07-06 | 石家庄华燕交通科技有限公司 | 驾驶人考试及培训三维虚拟监视方法用的监视*** |
US9558424B2 (en) * | 2015-06-30 | 2017-01-31 | Mitsubishi Electric Research Laboratories, Inc. | On-road stereo visual odometry without explicit pose determinations |
CN105654808A (zh) * | 2016-02-03 | 2016-06-08 | 北京易驾佳信息科技有限公司 | 一种基于实际机动车的机动车驾驶人智能化训练*** |
DE102016225140B3 (de) * | 2016-12-15 | 2017-12-07 | Audi Ag | Verfahren zum Bestimmen einer relativen Position eines Kraftfahrzeugs, Positionsbestimmungssystem für ein Kraftfahrzeug und Kraftfahrzeug |
CN108230420B (zh) * | 2016-12-15 | 2021-07-23 | 千寻位置网络有限公司 | 待绘制场地的绘图方法 |
CN106981236A (zh) * | 2017-05-15 | 2017-07-25 | 西安华众电子科技股份有限公司 | 一种曲线行驶考试检测装置及方法 |
CN106991870A (zh) * | 2017-05-15 | 2017-07-28 | 西安华众电子科技股份有限公司 | 一种倒车入库考试检测装置及方法 |
CN107195228A (zh) * | 2017-05-15 | 2017-09-22 | 西安华众电子科技股份有限公司 | 一种机动车驾驶人考试用考车模型踩点方法 |
CN106952537A (zh) * | 2017-05-15 | 2017-07-14 | 西安华众电子科技股份有限公司 | 一种侧方停车考试检测装置及方法 |
CN106997704A (zh) * | 2017-05-15 | 2017-08-01 | 西安华众电子科技股份有限公司 | 一种坡道定点停车和起步考试检测装置及方法 |
CN107589434A (zh) * | 2017-08-23 | 2018-01-16 | 西安中阔卫星技术应用有限责任公司 | 一种自动获取并记录实际道路标线gps坐标的装置和方法 |
CN107608348A (zh) * | 2017-09-04 | 2018-01-19 | 上海圭目机器人有限公司 | 一种自主式标线机器人***及标线方法 |
CN108762165B (zh) * | 2018-06-28 | 2020-10-30 | 辽宁工业大学 | 一种汽车状态测控方法 |
CN109087558A (zh) * | 2018-07-27 | 2018-12-25 | 重庆韦娜软件有限公司 | 基于笛卡尔坐标体系的叉车场地考试边界检测装置及其方法 |
CN109813229A (zh) * | 2018-12-30 | 2019-05-28 | 广州展讯信息科技有限公司 | 车身到边线距离的检测方法及装置 |
CN110715670A (zh) * | 2019-10-22 | 2020-01-21 | 山西省信息产业技术研究院有限公司 | 一种基于gnss差分定位构建驾考全景三维地图的方法 |
CN111368639B (zh) * | 2020-02-10 | 2022-01-11 | 浙江大华技术股份有限公司 | 车辆越线判定方法、装置、计算机设备和存储介质 |
CN111422191A (zh) * | 2020-04-14 | 2020-07-17 | 中国科学院计算技术研究所 | 一种自动驾驶控制***、方法和电子设备 |
CN112580147B (zh) * | 2020-12-14 | 2024-05-28 | 重庆安运科技股份有限公司 | 一种基于rtk的驾驶考试车辆构建和考试路线创建方法 |
CN113115353B (zh) * | 2021-04-12 | 2022-11-08 | 合肥越明交通电子科技有限公司 | 一种应用于驾考***的数据采集方法及装置 |
CN115294830A (zh) * | 2022-08-09 | 2022-11-04 | 武汉未来幻影科技有限公司 | 驾驶模拟器的视野调整方法、视野调整装置及电子设备 |
CN117492032B (zh) * | 2023-10-30 | 2024-05-03 | 河北三佳电子有限公司 | 车辆撞杆判断方法、装置、终端及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008216500A (ja) * | 2007-03-01 | 2008-09-18 | Fuji Heavy Ind Ltd | 車両の運転特性診断システム |
CN101923772A (zh) * | 2010-08-10 | 2010-12-22 | 安徽三联交通应用技术股份有限公司 | 道路驾驶考试考车行驶状态检测装置及其检测方法 |
CN202331963U (zh) * | 2011-11-25 | 2012-07-11 | 王恩惠 | 基于gps的驾驶考试*** |
CN202904922U (zh) * | 2012-09-26 | 2013-04-24 | 中国人民解放军军事交通学院 | 基于全球卫星定位***的驾驶考试自动化装置 |
CN103077638A (zh) * | 2012-12-12 | 2013-05-01 | 石家庄华燕交通科技有限公司 | 一种应用gps设备检验考核驾驶人场地考试的方法 |
-
2013
- 2013-05-15 CN CN201310179787.8A patent/CN103247199B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008216500A (ja) * | 2007-03-01 | 2008-09-18 | Fuji Heavy Ind Ltd | 車両の運転特性診断システム |
CN101923772A (zh) * | 2010-08-10 | 2010-12-22 | 安徽三联交通应用技术股份有限公司 | 道路驾驶考试考车行驶状态检测装置及其检测方法 |
CN202331963U (zh) * | 2011-11-25 | 2012-07-11 | 王恩惠 | 基于gps的驾驶考试*** |
CN202904922U (zh) * | 2012-09-26 | 2013-04-24 | 中国人民解放军军事交通学院 | 基于全球卫星定位***的驾驶考试自动化装置 |
CN103077638A (zh) * | 2012-12-12 | 2013-05-01 | 石家庄华燕交通科技有限公司 | 一种应用gps设备检验考核驾驶人场地考试的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103247199A (zh) | 2013-08-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103247199B (zh) | 一种机动车移动位置和姿态的精确测量方法 | |
CN107063275B (zh) | 基于路侧设备的智能车辆地图融合***及方法 | |
CN102928816B (zh) | 一种面向隧道环境的车辆高可靠组合定位方法 | |
CN112729316B (zh) | 自动驾驶车辆的定位方法、装置、车载设备、***及车辆 | |
US11945499B2 (en) | Method and apparatus for trailer angle measurement and vehicle | |
CN108226924A (zh) | 基于毫米波雷达的汽车行驶环境探测方法、装置及其应用 | |
CN110906939A (zh) | 自动驾驶定位方法、装置、电子设备、存储介质及汽车 | |
CN104428686A (zh) | 用于获得车辆位置的方法和车辆 | |
CN106710281A (zh) | 车辆定位数据获取方法及装置 | |
CN101334285A (zh) | 车辆导航装置及导航方法 | |
US20220157168A1 (en) | V2X with 5G/6G Image Exchange and AI-Based Viewpoint Fusion | |
CN104316059A (zh) | 由里程计获得车辆经纬度的航位推算导航定位方法及*** | |
KR102331312B1 (ko) | 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템 | |
US20220035036A1 (en) | Method and apparatus for positioning movable device, and movable device | |
CN109307877A (zh) | 高精度车辆定位***和高精度车辆定位方法 | |
CN104990554A (zh) | Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 | |
US10493912B2 (en) | Vehicle warning system and method | |
CN111708010B (zh) | 一种可移动设备的定位方法、装置、***及可移动设备 | |
US11287281B2 (en) | Analysis of localization errors in a mobile object | |
CN105222801A (zh) | 导航提示方法及导航提示*** | |
CN111141252B (zh) | 一种单目标定测距的方法及*** | |
CN104554083A (zh) | 一种智能行车辅助*** | |
CN204249962U (zh) | 一种车辆碰撞预警*** | |
CN103057543A (zh) | 一种基于车载gps的汽车侧偏角估计方法及硬件 | |
CN103163539A (zh) | 车载测距*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |