CN114169040A - 基于惯性及里程计信息的既有线路设计线型拟合方法 - Google Patents
基于惯性及里程计信息的既有线路设计线型拟合方法 Download PDFInfo
- Publication number
- CN114169040A CN114169040A CN202111262934.9A CN202111262934A CN114169040A CN 114169040 A CN114169040 A CN 114169040A CN 202111262934 A CN202111262934 A CN 202111262934A CN 114169040 A CN114169040 A CN 114169040A
- Authority
- CN
- China
- Prior art keywords
- original
- segment
- straight line
- line segment
- circular curve
- 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.)
- Granted
Links
- 238000013461 design Methods 0.000 title claims abstract description 34
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000000605 extraction Methods 0.000 claims abstract description 23
- 238000005457 optimization Methods 0.000 claims description 47
- 230000000116 mitigating effect Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000011218 segmentation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/13—Architectural design, e.g. computer-aided architectural design [CAAD] related to design of buildings, bridges, landscapes, production plants or roads
-
- E—FIXED CONSTRUCTIONS
- E01—CONSTRUCTION OF ROADS, RAILWAYS, OR BRIDGES
- E01B—PERMANENT WAY; PERMANENT-WAY TOOLS; MACHINES FOR MAKING RAILWAYS OF ALL KINDS
- E01B35/00—Applications of measuring apparatus or devices for track-building purposes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Geometry (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Civil Engineering (AREA)
- Architecture (AREA)
- Automation & Control Theory (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Complex Calculations (AREA)
Abstract
本发明提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,该方法包括:获取轨道的既有线型;计算轨道线路上多个轨道线路点的原始曲率;设定轨道最小曲率,确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点;对任一原始直线段的提取范围进行优化;获取既有线路中拟合后的任一直线段;确定至少一个原始圆曲线以及至少一个原始圆曲线所对应的起点和终点;对任一原始圆曲线的提取范围进行优化;获取既有线路中拟合后的任一圆曲线;根据任一圆曲线的半径和实际测量的缓和曲线长度计算获取任一缓和曲线参数。应用本发明的技术方案,以解决现有技术中按照原有设计线型对轨道进行调整缺乏经济性的技术问题。
Description
技术领域
本发明涉及惯性轨道测量技术领域,尤其涉及一种基于惯性及里程计信息的既有线路设计线型拟合方法。
背景技术
轨道交通系统经过长期运营后,由于车辆对轨道产生的冲击性作用,以及沉降等因素,会导致铁轨会出现偏移的现象。如果不及时加以修正,将严重影响行车安全。然而在某些情况下,特别是较早修建的铁路,已经无法获取准确的设计线型信息。或者轨道已发生较大规模的整体偏移,完全按照原有设计线型进行调整缺乏经济性。
发明内容
本发明提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,能够解决现有技术中按照原有设计线型对轨道进行调整缺乏经济性的技术问题。
本发明提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,既有线路设计线型拟合方法包括:获取轨道的既有线型;基于轨道的既有线型,计算轨道线路上多个轨道线路点的原始曲率;设定轨道最小曲率,根据轨道最小曲率对多个轨道线路点的原始曲率进行修正以获取多个轨道线路点的修正曲率,基于多个轨道线路点的修正曲率确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点;针对任一原始直线段,根据任一原始直线段所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化;基于范围优化后的任一直线段,采用正交最小二乘法对优化后任一直线段进行拟合以获取拟合直线段,根据范围优化后的任一直线段和拟合直线段计算获取既有线路中拟合后的任一直线段;根据至少一个原始直线段所对应的起点和终点确定至少一个原始圆曲线以及至少一个原始圆曲线所对应的起点和终点;针对任一原始圆曲线,根据任一原始圆曲线所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化;基于范围优化后的任一圆曲线,根据最小二成原理,对任一圆曲线的圆心和半径进行估计以获取既有线路中拟合后的任一圆曲线;根据任一圆曲线的半径和实际测量的缓和曲线长度计算获取任一缓和曲线参数,根据任一缓和曲线参数以获取既有线路中拟合后的任一缓和曲线;根据既有线路中拟合后的任一直线段、既有线路中拟合后的任一圆曲线以及既有线路中拟合后的任一缓和曲线完成对既有线路设计线型的拟合。
进一步地,多个轨道线路点的修正曲率Cmed(k)可根据来获取,其中,Cmin为设定轨道最小曲率;基于多个轨道线路点的修正曲率Cmed(k)确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点具体包括:将多个修正曲率Cmed(k)连续为0的轨道线路点组成的线段设定为任一原始直线段,提取任一原始直线段的首尾下标作为任一原始直线段对应的起点和终点。
进一步地,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化具体包括:根据任一原始直线段所对应的原始曲率数值段计算获取原始曲率数值段的中值mZi和标准差σZi;当任一原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为原始曲率数值段Csegi的曲率第一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LSi'=LSi+j-1,其中,LSi'为优化后的任一直线段的起点下标,LSi为任一原始直线段的起点下标;当任一原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为原始曲率数值段Csegi的曲率最后一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LEi'=LEi-(Lci-j),其中,LEi'为优化后的任一直线段的终点下标,LEi为任一原始直线段的终点下标,Lci为任一原始直线段所对应的原始曲率数值段中的数据个数。
进一步地,既有线路中拟合后的任一直线段可根据来获取,其中,为平行于拟合直线段的单位向量,rx为平行于拟合直线段的单位向量沿x方向的分量,ry为平行于拟合直线段的单位向量沿y方向的分量,p0=(x0,y0),p0为拟合直线段上的任一点。
进一步地,平行于拟合直线段的单位向量可根据第二主惯性轴来获取,其中,H=VWVT,W=diag(w1,w2),其中,w1为第一质心力矩,w2为第二质心力矩,为第一主惯性轴,为第二主惯性轴,(xi,yi)为范围优化后的任一直线段上的第i个测量点的坐标值,(X0,Y0)为范围优化后的任一直线段上各测量点的坐标平均值。
进一步地,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化具体包括:根据任一原始圆曲线所对应的原始曲率数值段计算获取原始曲率数值段的中值mCi和标准差σCi;当任一原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为原始曲率数值段Csegi'的曲率第一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CSi'=CSi+j-1,其中,CSi'为优化后的任一圆曲线的起点下标,CSi为任一原始圆曲线的起点下标;当任一原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为原始曲率数值段Csegi的曲率最后一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CEi'=CEi-(Lci-j),其中,CEi'为优化后的任一圆曲线的终点下标,CEi为任一原始圆曲线的终点下标,Lci'为任一原始圆曲线所对应的原始曲率数值段中的数据个数。
进一步地,任一圆曲线的圆心和半径可根据来获取,其中,(xc,yc)为任一圆曲线的圆心,R为任一圆曲线的半径,为圆心初值,R0为圆半径初值,(xi,yi)为圆曲线段上各个测量点的坐标值,i=1,2,…,n,k'为计数,代表第k'次迭代结果。
应用本发明的技术方案,提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,该方法利用惯性/里程计组合导航系统获取轨道既有线型,基于轨道的实际测量数据,利用曲率对线型进行分段,能够准确获取线型关键点,并在此基础上对线型数据进行调整,生成符合一般设计要求的轨道设计线型,此种方式通过反向推算与实际数据近似的符合设计规则的轨道线型,能够有效提高轨道平顺性调整效果。
附图说明
所包括的附图用来提供对本发明实施例的进一步的理解,其构成了说明书的一部分,用于例示本发明的实施例,并与文字描述一起来阐释本发明的原理。显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1示出了根据本发明的具体实施例提供的直线段提取范围优化的示意图;
图2示出了根据本发明的具体实施例提供的正交最小二乘拟合示意图;
图3示出了根据本发明的具体实施例提供的缓和曲线参数计算的示意图;
图4示出了根据本发明的具体实施例提供的基于既有线型的设计线型拟合结果的示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本发明及其应用或使用的任何限制。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本申请的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
除非另外具体说明,否则在这些实施例中阐述的部件和步骤的相对布置、数字表达式和数值不限制本发明的范围。同时,应当明白,为了便于描述,附图中所示出的各个部分的尺寸并不是按照实际的比例关系绘制的。对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论,但在适当情况下,所述技术、方法和设备应当被视为授权说明书的一部分。在这里示出和讨论的所有示例中,任何具体值应被解释为仅仅是示例性的,而不是作为限制。因此,示例性实施例的其它示例可以具有不同的值。应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步讨论。
根据本发明的具体实施例,提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,该既有线路设计线型拟合方法包括:获取轨道的既有线型;基于轨道的既有线型,计算轨道线路上多个轨道线路点的原始曲率;设定轨道最小曲率,根据轨道最小曲率对多个轨道线路点的原始曲率进行修正以获取多个轨道线路点的修正曲率,基于多个轨道线路点的修正曲率确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点;针对任一原始直线段,根据任一原始直线段所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化;基于范围优化后的任一直线段,采用正交最小二乘法对优化后任一直线段进行拟合以获取拟合直线段,根据范围优化后的任一直线段和拟合直线段计算获取既有线路中拟合后的任一直线段;根据至少一个原始直线段所对应的起点和终点确定至少一个原始圆曲线以及至少一个原始圆曲线所对应的起点和终点;针对任一原始圆曲线,根据任一原始圆曲线所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化;基于范围优化后的任一圆曲线,根据最小二成原理,对任一圆曲线的圆心和半径进行估计以获取既有线路中拟合后的任一圆曲线;根据任一圆曲线的半径和实际测量的缓和曲线长度计算获取任一缓和曲线参数,根据任一缓和曲线参数以获取既有线路中拟合后的任一缓和曲线;根据既有线路中拟合后的任一直线段、既有线路中拟合后的任一圆曲线以及既有线路中拟合后的任一缓和曲线完成对既有线路设计线型的拟合。
应用此种配置方式,提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,该方法利用惯性/里程计组合导航系统获取轨道既有线型,基于轨道的实际测量数据,利用曲率对线型进行分段,能够准确获取线型关键点,并在此基础上对线型数据进行调整,生成符合一般设计要求的轨道设计线型,此种方式通过反向推算与实际数据近似的符合设计规则的轨道线型,能够有效提高轨道平顺性调整效果。
具体地,在本发明中,为了实现既有线路设计线型拟合,首先需要获取轨道的既有线型。轨道的既有线型可采用现有的惯性/里程计组合的测量方法来获取。
进一步地,在获取了轨道的既有线型之后,即可基于轨道的既有线型,计算轨道线路上多个轨道线路点的原始曲率。轨道线路上多个轨道线路点的原始曲率可根据来获取,其中,Δψ为行走过的里程内航向转过的角度,ΔS为行走过的里程(即弧长)。具体地,设定曲率计算的里程间隔Lc,单位为m,在任一轨道线路点的前后各取Lc的长度,根据2Lc里程内航向转过的角度与2Lc里程相除即可获取该轨道线路点的曲率。在首尾两端点数不足处,分别使用开头和结尾Lc长度范围内的点计算曲率。例如,假设在首端某一轨道线路点,其前面的长度可取为0.1Lc,后面的长度可取Lc,则在计算该点时,根据0.1Lc+Lc=1.1Lc里程内航向转过的角度与1.1Lc里程相除即可获取该轨道线路点的曲率。
在获取了轨道线路上多个轨道线路点的原始曲率之后,即可设定轨道最小曲率,根据轨道最小曲率对多个轨道线路点的原始曲率进行修正以获取多个轨道线路点的修正曲率,基于多个轨道线路点的修正曲率确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点。具体地,设定一个轨道最小曲率为Cmin,多个轨道线路点的修正曲率Cmed(k)可根据来获取,其中,Cmin为设定轨道最小曲率;基于多个轨道线路点的修正曲率Cmed(k)确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点具体包括:将多个修正曲率Cmed(k)连续为0的轨道线路点组成的线段设定为任一原始直线段,提取任一原始直线段的首尾下标作为任一原始直线段对应的起点和终点。
作为本发明的一个具体实施例,如图1所示,从图中可以看出,从LS1至LE1的原始曲率均小于设定轨道最小曲率,因此,将该段的轨道曲率均设定为0;从LS2至LE2的原始曲率均小于设定轨道最小曲率,因此,将该段的轨道曲率均设定为0,以此类推。在Cmed(k)中连续为0的段为直线段,提取多个直线段的首尾下标组成集合,记为LS={LS1,LS2…LSk}为k个直线段起点下标,LE={LE1,LE2…LEk}为k个直线段终点下标。如图1所示,有三个直线段,三个直线段的起点坐标集合分别为LS={LS1,LS2,LS3},终点坐标集合为LE={LE1,LE2,LE3}。
进一步地,在确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点之后,即可针对任一原始直线段,根据任一原始直线段所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化。
在本发明中,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化具体包括:根据任一原始直线段所对应的原始曲率数值段计算获取原始曲率数值段的中值mZi和标准差σZi;当任一原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为原始曲率数值段Csegi的曲率第一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LSi'=LSi+j-1,其中,LSi'为优化后的任一直线段的起点下标,LSi为任一原始直线段的起点下标;当任一原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为原始曲率数值段Csegi的曲率最后一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LEi'=LEi-(Lci-j),其中,LEi'为优化后的任一直线段的终点下标,LEi为任一原始直线段的终点下标,Lci为任一原始直线段所对应的原始曲率数值段中的数据个数。
作为本发明的一个具体实施例,如图1所示,以第一个直线段为例,按起点-终点下标分段从C(k)中提取第一个直线段的曲率数值段Cseg1=C(LS1:LE1),段中数据个数为Lc1。计算Cseg1的中值mZ1和标准差σZ1;当第一个原始直线段所对应的原始曲率数值段Cseg1中的第j个点Csegi(j)为原始曲率数值段Cseg1的曲率第一次落入区间[mZ1-σZ1,mZ1+σZ1]中的点时,取LS1'=LS1+j-1,其中,LS1'为优化后的第一直线段的起点下标,LS1为第一原始直线段的起点下标;当第一原始直线段所对应的原始曲率数值段Cseg1中的第j个点Csegi(j)为原始曲率数值段Cseg1的曲率最后一次落入区间[mZ1-σZ1,mZ1+σZ1]中的点时,取LE1'=LE1-(Lc1-j),其中,LE1'为优化后的任一直线段的终点下标,LE1为任一原始直线段的终点下标,Lc1为任一原始直线段所对应的原始曲率数值段中的数据个数。
进一步地,在对任一所述原始直线段的提取范围进行优化之后,基于范围优化后的任一直线段,采用正交最小二乘法对优化后任一直线段进行拟合以获取拟合直线段,根据范围优化后的任一直线段和拟合直线段计算获取既有线路中拟合后的任一直线段。
如图2所示,采用正交最小二乘拟合,设优化后的任一直线段上点的集合为P,pi=(xi,yi)∈P。设p0=(x0,y0)为拟合直线上的一点,为平行于该直线的单位向量,则拟合直线可以表示为其中u∈(-∞,+∞),则优化后的任一直线段上的各个测量点到拟合直线段的正交距离平方和为:
其中,(xi,yi)为范围优化后的任一直线段上的任一点,m为范围优化后的任一直线段上的点的个数。
对惯性张量H进行奇异值分解H=VWVT,W=diag(w1,w2),其中,(xi,yi)为范围优化后的任一直线段上的任一点的坐标,(X0,Y0)为范围优化后的任一直线段上的点的坐标平均值,w1为第一质心力矩,w2为第二质心力矩,为第一主惯性轴,为第二主惯性轴,由m个观测点通过正交距离拟合而成的直线,经过这些点的中心,并且平行于其中一个有最小质心主力矩的主惯性轴。即如果w1>w2,则
表示为直线参数形式为:即既有线路中拟合后的任一直线段可根据来获取,其中,为平行于拟合直线段的单位向量,rx为平行于拟合直线段的单位向量沿x方向的分量,ry为平行于拟合直线段的单位向量沿y方向的分量,p0=(x0,y0),p0为拟合直线段上的任一点。
进一步地,在完成了既有线路中各个直线段的拟合之后,即可根据至少一个原始直线段所对应的起点和终点确定至少一个原始圆曲线以及至少一个所述原始圆曲线所对应的起点和终点。具体地,如图1所示,圆曲线的首尾需要根据线段是否从直线段开始进行处理:如果轨道线路是从直线开始的,则将直线的终点作为圆曲线段起点粗值,直线的起点作为圆曲线段终点的粗值,此时圆曲线段中包含两条缓和曲线,例如,在图1中,可将第一直线段的终点下标LE1作为第一圆曲线的起点下标粗值,将第二直线段的起点下标LS2作为第一圆曲线的终点下标粗值。如果轨道线路是从曲线开始的,则圆曲线的第一个起点下标设置为1。则原始圆曲线的起点下标集合为CS={CS1,CS2…CSk},原始圆曲线的终点下标集合为CE={CE1,CE2…CEk}。
在确定至少一个原始圆曲线以及至少一个所述原始圆曲线所对应的起点和终点之后,针对任一原始圆曲线,根据任一原始圆曲线所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化。在本发明中,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化具体包括:根据任一原始圆曲线所对应的原始曲率数值段计算获取原始曲率数值段的中值mCi和标准差σCi;当任一原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为原始曲率数值段Csegi'的曲率第一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CSi'=CSi+j-1,其中,CSi'为优化后的任一圆曲线的起点下标,CSi为任一原始圆曲线的起点下标;当任一原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为原始曲率数值段Csegi的曲率最后一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CEi'=CEi-(Lci-j),其中,CEi'为优化后的任一圆曲线的终点下标,CEi为任一原始圆曲线的终点下标,Lci'为任一原始圆曲线所对应的原始曲率数值段中的数据个数。
作为本发明的一个具体实施例,以第一个圆曲线为例,按起点-终点下标分段从C(k)中提取第一个圆曲线的曲率数值段Cseg1=C(CS1:CE1),段中数据个数为Lc1。计算Cseg1的中值mC1和标准差σC1;当第一个原始圆曲线所对应的原始曲率数值段Cseg1中的第j个点Csegi(j)为原始曲率数值段Cseg1的曲率第一次落入区间[mC1-σC1,mC1+σC1]中的点时,取CS1'=CS1+j-1,其中,CS1'为优化后的第一圆曲线的起点下标,CS1为第一原始圆曲线的起点下标;当第一原始圆曲线所对应的原始曲率数值段Cseg1中的第j个点Csegi(j)为原始曲率数值段Cseg1的曲率最后一次落入区间[mC1-σC1,mC1+σC1]中的点时,取CE1'=CE1-(Lc1-j),其中,CE1'为优化后的任一圆曲线的终点下标,CE1为任一原始圆曲线的终点下标,Lc1为任一原始圆曲线所对应的原始曲率数值段中的数据个数。
进一步地,在对任一原始圆曲线的提取范围进行优化之后,基于范围优化后的任一圆曲线,根据最小二成原理,对任一圆曲线的圆心和半径进行估计以获取所述既有线路中拟合后的任一圆曲线。具体地,根据最小二成原理,对圆曲线的圆心和半径进行估计,任一圆曲线的圆心和半径可根据来获取,其中, (xc,yc)为任一圆曲线的圆心,R为任一圆曲线的半径,为圆心初值,R0为圆半径初值,(xi,yi)为圆曲线段上各个测量点的坐标值,i=1,2,…,n,k'为计数,代表第k'次迭代结果。
进一步地,在获取了既有线路中拟合后的任一圆曲线之后,即可根据任一圆曲线的半径和实际测量的缓和曲线长度计算获取任一缓和曲线参数,根据任一缓和曲线参数以获取既有线路中拟合后的任一缓和曲线。任一缓和曲线参数可根据来获取,其中,β为任一缓和曲线的切线角,l为缓和曲线的长度,ls为实际测量的缓和曲线的长度,R为圆曲线半径。
在获取了既有线路中拟合后的任一缓和曲线之后,根据既有线路中拟合后的任一直线段、既有线路中拟合后的任一圆曲线以及既有线路中拟合后的任一缓和曲线完成对既有线路设计线型的拟合。
为了对本发明有进一步地了解,下面结合图1至图4对本发明所提供的基于惯性及里程计信息的既有线路设计线型拟合方法进行详细说明。
如图1至图4所示,根据本发明的具体实施例提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,该方法具体包括如下步骤。
采用基于惯性/里程计组合的测量方法,获取轨道的既有线型。
设定轨道最小曲率,根据轨道最小曲率对多个轨道线路点的原始曲率进行修正以获取多个轨道线路点的修正曲率,基于多个轨道线路点的修正曲率确定至少一个原始直线段以及至少一个原始直线段所对应的起点和终点。在本实施例中,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化具体包括:根据任一原始直线段所对应的原始曲率数值段计算获取原始曲率数值段的中值mZi和标准差σZi;当任一原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为原始曲率数值段Csegi的曲率第一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LSi'=LSi+j-1,其中,LSi'为优化后的任一直线段的起点下标,LSi为任一原始直线段的起点下标;当任一原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为原始曲率数值段Csegi的曲率最后一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LEi'=LEi-(Lci-j),其中,LEi'为优化后的任一直线段的终点下标,LEi为任一原始直线段的终点下标,Lci为任一原始直线段所对应的原始曲率数值段中的数据个数。
针对任一原始直线段,根据任一原始直线段所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数,根据任一原始直线段所对应的原始曲率数值段以及任一原始直线段所对应的原始曲率数值段中的数据个数对任一原始直线段的提取范围进行优化。在本实施例中,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化具体包括:根据任一原始圆曲线所对应的原始曲率数值段计算获取原始曲率数值段的中值mCi和标准差σCi;当任一原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为原始曲率数值段Csegi'的曲率第一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CSi'=CSi+j-1,其中,CSi'为优化后的任一圆曲线的起点下标,CSi为任一原始圆曲线的起点下标;当任一原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为原始曲率数值段Csegi的曲率最后一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CEi'=CEi-(Lci-j),其中,CEi'为优化后的任一圆曲线的终点下标,CEi为任一原始圆曲线的终点下标,Lci'为任一原始圆曲线所对应的原始曲率数值段中的数据个数。
基于范围优化后的任一直线段,采用正交最小二乘法对优化后任一直线段进行拟合以获取拟合直线段,根据范围优化后的任一直线段和拟合直线段计算获取既有线路中拟合后的任一直线段。
根据至少一个原始直线段所对应的起点和终点确定至少一个原始圆曲线以及至少一个原始圆曲线所对应的起点和终点。
针对任一原始圆曲线,根据任一原始圆曲线所对应的起点坐标和终点坐标从多个轨道线路点的原始曲率中获取任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数,根据任一原始圆曲线所对应的原始曲率数值段以及任一原始圆曲线所对应的原始曲率数值段中的数据个数对任一原始圆曲线的提取范围进行优化。
基于范围优化后的任一圆曲线,根据最小二成原理,对任一圆曲线的圆心和半径进行估计以获取既有线路中拟合后的任一圆曲线;根据任一圆曲线的半径和实际测量的缓和曲线长度计算获取任一缓和曲线参数,根据任一缓和曲线参数以获取既有线路中拟合后的任一缓和曲线。
根据既有线路中拟合后的任一直线段、既有线路中拟合后的任一圆曲线以及既有线路中拟合后的任一缓和曲线完成对既有线路设计线型的拟合。
综上所述,本发明提供了一种基于惯性及里程计信息的既有线路设计线型拟合方法,该方法利用惯性/里程计组合导航系统,获取轨道既有线型,基于轨道的实际测量数据,利用曲率对线型进行分段,能够准确获取线型关键点,并在此基础上对线型数据进行调整,生成符合一般设计要求的轨道设计线型,此种方式通过反向推算与实际数据近似的符合设计规则的轨道线型,能够有效提高轨道平顺性调整效果。
为了便于描述,在这里可以使用空间相对术语,如“在……之上”、“在……上方”、“在……上表面”、“上面的”等,用来描述如在图中所示的一个器件或特征与其他器件或特征的空间位置关系。应当理解的是,空间相对术语旨在包含除了器件在图中所描述的方位之外的在使用或操作中的不同方位。例如,如果附图中的器件被倒置,则描述为“在其他器件或构造上方”或“在其他器件或构造之上”的器件之后将被定位为“在其他器件或构造下方”或“在其他器件或构造之下”。因而,示例性术语“在……上方”可以包括“在……上方”和“在……下方”两种方位。该器件也可以其他不同方式定位(旋转90度或处于其他方位),并且对这里所使用的空间相对描述作出相应解释。
此外,需要说明的是,使用“第一”、“第二”等词语来限定零部件,仅仅是为了便于对相应零部件进行区别,如没有另行声明,上述词语并没有特殊含义,因此不能理解为对本发明保护范围的限制。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于惯性及里程计信息的既有线路设计线型拟合方法,其特征在于,所述既有线路设计线型拟合方法包括:
获取轨道的既有线型;
基于所述轨道的既有线型,计算轨道线路上多个轨道线路点的原始曲率;
设定轨道最小曲率,根据所述轨道最小曲率对多个所述轨道线路点的原始曲率进行修正以获取多个所述轨道线路点的修正曲率,基于多个所述轨道线路点的修正曲率确定至少一个原始直线段以及至少一个所述原始直线段所对应的起点和终点;
针对任一所述原始直线段,根据任一所述原始直线段所对应的起点坐标和终点坐标从多个所述轨道线路点的原始曲率中获取任一所述原始直线段所对应的原始曲率数值段以及任一所述原始直线段所对应的原始曲率数值段中的数据个数,根据任一所述原始直线段所对应的原始曲率数值段以及任一所述原始直线段所对应的原始曲率数值段中的数据个数对任一所述原始直线段的提取范围进行优化;
基于范围优化后的任一所述直线段,采用正交最小二乘法对优化后任一所述直线段进行拟合以获取拟合直线段,根据范围优化后的任一所述直线段和所述拟合直线段计算获取所述既有线路中拟合后的任一直线段;
根据至少一个原始直线段所对应的起点和终点确定至少一个原始圆曲线以及至少一个所述原始圆曲线所对应的起点和终点;
针对任一所述原始圆曲线,根据任一所述原始圆曲线所对应的起点坐标和终点坐标从多个所述轨道线路点的原始曲率中获取任一所述原始圆曲线所对应的原始曲率数值段以及任一所述原始圆曲线所对应的原始曲率数值段中的数据个数,根据任一所述原始圆曲线所对应的原始曲率数值段以及任一所述原始圆曲线所对应的原始曲率数值段中的数据个数对任一所述原始圆曲线的提取范围进行优化;
基于范围优化后的任一所述圆曲线,根据最小二成原理,对任一所述圆曲线的圆心和半径进行估计以获取所述既有线路中拟合后的任一圆曲线;
根据任一所述圆曲线的半径和实际测量的缓和曲线长度计算获取任一缓和曲线参数,根据任一所述缓和曲线参数以获取所述既有线路中拟合后的任一缓和曲线;
根据所述既有线路中拟合后的任一直线段、所述既有线路中拟合后的任一圆曲线以及所述既有线路中拟合后的任一缓和曲线完成对既有线路设计线型的拟合。
4.根据权利要求3所述的基于惯性及里程计信息的既有线路设计线型拟合方法,其特征在于,根据任一所述原始直线段所对应的原始曲率数值段以及任一所述原始直线段所对应的原始曲率数值段中的数据个数对任一所述原始直线段的提取范围进行优化具体包括:
根据任一所述原始直线段所对应的原始曲率数值段计算获取原始曲率数值段的中值mZi和标准差σZi;
当任一所述原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为所述原始曲率数值段Csegi的曲率第一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LSi'=LSi+j-1,其中,LSi'为优化后的任一直线段的起点下标,LSi为任一所述原始直线段的起点下标;当任一所述原始直线段所对应的原始曲率数值段Csegi中的第j个点Csegi(j)为所述原始曲率数值段Csegi的曲率最后一次落入区间[mZi-σZi,mZi+σZi]中的点时,取LEi'=LEi-(Lci-j),其中,LEi'为优化后的任一直线段的终点下标,LEi为任一所述原始直线段的终点下标,Lci为任一所述原始直线段所对应的原始曲率数值段中的数据个数。
8.根据权利要求1至5中任一项所述的基于惯性及里程计信息的既有线路设计线型拟合方法,其特征在于,根据任一所述原始圆曲线所对应的原始曲率数值段以及任一所述原始圆曲线所对应的原始曲率数值段中的数据个数对任一所述原始圆曲线的提取范围进行优化具体包括:
根据任一所述原始圆曲线所对应的原始曲率数值段计算获取原始曲率数值段的中值mCi和标准差σCi;
当任一所述原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为所述原始曲率数值段Csegi'的曲率第一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CSi'=CSi+j-1,其中,CSi'为优化后的任一圆曲线的起点下标,CSi为任一所述原始圆曲线的起点下标;当任一所述原始圆曲线所对应的原始曲率数值段Csegi'中的第j个点Csegi(j)'为所述原始曲率数值段Csegi的曲率最后一次落入区间[mCi-σCi,mCi+σCi]中的点时,取CEi'=CEi-(Lci-j),其中,CEi'为优化后的任一圆曲线的终点下标,CEi为任一所述原始圆曲线的终点下标,Lci'为任一所述原始圆曲线所对应的原始曲率数值段中的数据个数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111262934.9A CN114169040B (zh) | 2021-10-28 | 2021-10-28 | 基于惯性及里程计信息的既有线路设计线型拟合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111262934.9A CN114169040B (zh) | 2021-10-28 | 2021-10-28 | 基于惯性及里程计信息的既有线路设计线型拟合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114169040A true CN114169040A (zh) | 2022-03-11 |
CN114169040B CN114169040B (zh) | 2024-04-02 |
Family
ID=80477575
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111262934.9A Active CN114169040B (zh) | 2021-10-28 | 2021-10-28 | 基于惯性及里程计信息的既有线路设计线型拟合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114169040B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115081211A (zh) * | 2022-06-20 | 2022-09-20 | 中南大学 | 一种既有铁路线路平面的自适应整体恢复方法 |
CN116446227A (zh) * | 2023-06-19 | 2023-07-18 | 中国铁建高新装备股份有限公司 | 弦测设备、轨道线路还原方法、装置、设备及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0826109A (ja) * | 1994-07-14 | 1996-01-30 | Railway Technical Res Inst | 軌道形状データ処理方法 |
KR100474261B1 (ko) * | 2004-02-05 | 2005-03-14 | 주식회사삼안건설기술공사 | 컴퓨터를 이용한 지하철 및 철도 선형설계 시스템 및설계방법 |
CN106126834A (zh) * | 2016-06-28 | 2016-11-16 | 西安交通大学 | 一种基于惯导角度量测的轨道平面最佳线形确定算法 |
CN107609300A (zh) * | 2017-09-27 | 2018-01-19 | 中南大学 | 一种既有铁路平面线位整体重构设计方法 |
CN111811466A (zh) * | 2020-07-22 | 2020-10-23 | 四川拓绘科技有限公司 | 一种既有线有砟铁路线路参数及养护的测量方法 |
-
2021
- 2021-10-28 CN CN202111262934.9A patent/CN114169040B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0826109A (ja) * | 1994-07-14 | 1996-01-30 | Railway Technical Res Inst | 軌道形状データ処理方法 |
KR100474261B1 (ko) * | 2004-02-05 | 2005-03-14 | 주식회사삼안건설기술공사 | 컴퓨터를 이용한 지하철 및 철도 선형설계 시스템 및설계방법 |
CN106126834A (zh) * | 2016-06-28 | 2016-11-16 | 西安交通大学 | 一种基于惯导角度量测的轨道平面最佳线形确定算法 |
CN107609300A (zh) * | 2017-09-27 | 2018-01-19 | 中南大学 | 一种既有铁路平面线位整体重构设计方法 |
CN111811466A (zh) * | 2020-07-22 | 2020-10-23 | 四川拓绘科技有限公司 | 一种既有线有砟铁路线路参数及养护的测量方法 |
Non-Patent Citations (3)
Title |
---|
李晓雯;元向辉;周春翔;: "基于惯导角度量测的轨道平面最佳线形参数估计算法", 计算机应用, no. 12, 10 December 2016 (2016-12-10) * |
石培泽;: "基于正交最小二乘法既有线平面线形拟合", 四川建筑, no. 05, 28 October 2017 (2017-10-28) * |
陈勇;: "铁路既有曲线参数优化方法研究", 福建建材, no. 09, 20 September 2015 (2015-09-20) * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115081211A (zh) * | 2022-06-20 | 2022-09-20 | 中南大学 | 一种既有铁路线路平面的自适应整体恢复方法 |
CN115081211B (zh) * | 2022-06-20 | 2023-02-07 | 中南大学 | 一种既有铁路线路平面的自适应整体恢复方法 |
CN116446227A (zh) * | 2023-06-19 | 2023-07-18 | 中国铁建高新装备股份有限公司 | 弦测设备、轨道线路还原方法、装置、设备及系统 |
CN116446227B (zh) * | 2023-06-19 | 2023-08-25 | 中国铁建高新装备股份有限公司 | 弦测设备、轨道线路还原方法、装置、设备及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114169040B (zh) | 2024-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114201850A (zh) | 既有线型整正设计线型参数确定方法 | |
CN114169040A (zh) | 基于惯性及里程计信息的既有线路设计线型拟合方法 | |
CN107702716B (zh) | 一种无人驾驶路径规划方法、系统和装置 | |
CN106126834B (zh) | 一种基于惯导角度量测的轨道平面最佳线形确定方法 | |
CN112733270B (zh) | 车辆行驶轨迹预测和轨迹偏离危险度评估的系统与方法 | |
CN111098894B (zh) | 一种基于轨道曲线特征的列车定位方法及系统 | |
CN109270927B (zh) | 道路数据的生成方法及装置 | |
CN108791289B (zh) | 一种车辆控制方法和装置 | |
WO2021056341A1 (zh) | 车道线融合方法、车道线融合装置、车辆和存储介质 | |
CN103149937A (zh) | 一种基于曲率补偿的横侧向曲线航迹跟踪方法 | |
JP2008087726A (ja) | 車両の走行制御システム | |
CN107608344A (zh) | 基于轨迹规划的车辆运动控制方法、装置及相关设备 | |
CN112747755B (zh) | 道路线确定方法、装置、可读存储介质及地图更新系统 | |
CN108279016A (zh) | Had地图的平滑处理方法和装置、导航系统及自动驾驶系统 | |
CN107228674A (zh) | 一种针对星敏感器和陀螺联合滤波的改进方法 | |
CN110736999A (zh) | 基于激光雷达的铁路道岔检测方法 | |
JP5730068B2 (ja) | 鉄道車両の位置検出装置および位置検出方法 | |
CN114912159B (zh) | 一种轨道交通线路平面几何线形的拟合方法 | |
JP2917681B2 (ja) | 道路形状計測装置 | |
CN116118780A (zh) | 一种车辆避障轨迹规划方法、系统、车辆及存储介质 | |
CN109062235A (zh) | 飞行控制方法、装置及无人机 | |
CN103700107A (zh) | 一种基于图像尖锐度分布的特征点匹配方法 | |
CN109856622A (zh) | 一种约束条件下的单雷达直线航迹线目标状态估计方法 | |
CN109062213B (zh) | 一种基于修正比例导引的智能车自动驾驶的方法 | |
Žuraulis et al. | Vehicle speed prediction from yaw marks using photogrammetry of image of traffic accident scene |
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 |