System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind() 一种隧道定位方法技术_技高网

一种隧道定位方法技术

技术编号:40124561 阅读:13 留言:0更新日期:2024-01-23 21:11
本发明专利技术为一种隧道定位方法,基于路径规划导航,其中定位装置包括自动激光瞄准模块、自动调平机构、处理控制模块、RFID读写模块、电源模块、固定底座以及位置标签模块;其中电源模块设置于处理控制模块以及固定底座之间;处理控制模块上侧还设置有自动调平结构,自动调平机构上设置有自动激光瞄准模块;RFID读写模块设置于处理控制模块的左右两侧;位置标签模块设置于隧道内侧;处理模块分别与自动激光瞄准模块、自动调平机构、RFID读写模块以及电源模块连接;通过设置自动激光瞄准模块,完成对隧道中的位置标签模块的角度和距离检测,并根据位置标签模块的RFID读写过程,记录和获取相对位置。

【技术实现步骤摘要】

本专利技术涉及隧道定位领域,特别是涉及一种隧道定位方法


技术介绍

1、随着城市交通建设的推行,对于交通便利性的要求也越来越高。对于道路交通而言,由于道路宽度等因素的限制,道路交通的可发展程度有限,因此地下交通和高架逐渐盛行,包括地铁、轻轨等。

2、地铁的列车通常在全封闭的线路上运行,尤其是位于中心城区的线路,基本建设在地下隧道内,因此也存在极大的建设难度。对于道路交通而言,获取准确的道路里程数据是极其重要的,里程数据能够便于标志物的安装,比如路灯、里程牌等等。但是在地下隧道建设的过程中,由于环境封闭、信号差,难以借助外部的通信设施,因此难以在隧道中完成定位和测距,这对隧道建设产生了极大的阻碍;另一方面,由于频繁的刹车和启动等因素的影响,也会导致里程计的计数不准,难以确保采集的里程数据可靠。因此需要一种基于路径规划导航的隧道定位装置及方法。


技术实现思路

1、本专利技术的目的是解决现有技术的不足,提供一种隧道定位方法。

2、为了解决上述问题,本专利技术采用如下技术方案:

3、一种基于路径规划导航的隧道定位装置,包括自动激光瞄准模块、自动调平机构、处理控制模块、rfid读写模块、电源模块、固定底座以及位置标签模块;其中电源模块设置于处理控制模块以及固定底座之间;处理控制模块上侧还设置有自动调平结构,自动调平机构上设置有自动激光瞄准模块;rfid读写模块设置于处理控制模块的左右两侧;位置标签模块设置于隧道内侧;处理模块分别与自动激光瞄准模块、自动调平机构、rfid读写模块以及电源模块连接。

4、进一步的,所述固定底座架设于铁路轨道上或者安装于外部的铁轨大型平板车的设定位置;

5、所述位置标签模块设置于隧道内,位置标签模块为透明的正方体结构;在位置标签模块的相对的两个面上设置有反光标签;位置标签模块朝向轨道的一面还设置有rfid;

6、所述处理控制模块包括微型电脑以及fpga模块,其中微型电脑用于处理自动激光瞄准模块采集的信息,并完成距离计算;fpga模块分别与微型电脑以及自动调平机构连接,用于控制自动调平机构实现调平;

7、所述自动激光瞄准模块包括左右旋转电机、上下旋转电机、望远视觉标准模块以及安装架;望远视觉标准模块通过左右旋转电机以及上下旋转电机设置于安装架上,望远视觉标准模块通过左右旋转电机以及上下旋转电机分别实现左右和上下的转动;其中左右旋转电机和上下旋转电机还能够获取各自的旋转角度;安装架设置于自动调平结构上;望远视觉标准模块包括激光测距模块以及机器视觉模块,其中激光测距模块用于检测距离,机器视觉模块用于获取图像;

8、所述自动调平机构包括二轴角度旋转平台、倾斜传感器、二轴旋转电机以及fpga控制卡;其中fpga控制卡分别与二轴角度旋转平台、倾斜传感器以及二轴旋转电机连接,fpga控制卡还与处理控制模块中的fpga模块连接;

9、所述rfid读写模块包括rfid读写装置以及伸缩臂,其中rfid读写装置通过伸缩臂安装设置于处理控制模块的左右两侧。

10、一种隧道定位方法,包括如下步骤:

11、步骤1:定位装置获取第一组cp3基准点c0和c1的经纬度坐标,建立正向坐标系;

12、步骤2:定位装置进入隧道,并沿着隧道前行,每前行设定里程,则设置位置标签模块;

13、步骤3:将设置的位置标签模块作为待测点,根据基准点坐标结合自动激光瞄准模块,通过粗定位流程依次检测获得两组基准点之间的待测点的检测坐标;

14、步骤4:定位装置获得第二组cp3基准点c2和c3的经纬度坐标,并将其带入正向坐标系;将基准点c2和c3的实际经纬度坐标的转换坐标与其检测坐标进行比较,获得第一误差;其中检测坐标表示定位装置通过粗定位流程获得的测量值;

15、步骤5:定位装置继续前行,直至驶出隧道,采集隧道出口的基准点组的经纬度坐标;并根据步骤1~步骤4,获得任意两个基准点组之间的正向坐标系;

16、步骤6:定位装置从隧道出口的基准点组返回第一组基准点,通过自动激光瞄准模块依次检测两组基准点之间的待测点,结合粗定位流程获得检测坐标,并根据每两个相邻基准点之间的第一误差对检测坐标进行修订,获得修订坐标,并获得任意两个基准点组之间的反向坐标系;

17、步骤7:定位装置获得基准点的经纬度坐标,并将其带入反向坐标系;将每个反向坐标系中的基准点的实际经纬度坐标的转换坐标与其检测坐标进行比较,获得每段反向坐标系的第二误差;

18、步骤8:获得每段反向坐标系的第二误差与对应的基准点组之间的里程的比值,将比值与设定的阈值进行比较;若比值超出设定阈值,则认为修订坐标的误差较大,需要根据第二误差再次修订,获得二次修订坐标,进入步骤9;否则,认为修订坐标符合误差预期,结束步骤;

19、步骤9:定位装置从隧道入口的第一组基准点返回隧道出口,将修正后的二次修订坐标写入待测点的rfid中,结束步骤。

20、进一步的,所述步骤1中,将c0设定为坐标原点,设定基准点c0在正向坐标系中的转换坐标为(0,0,0);将基准点c1的经纬度坐标带入坐标系一中获得转换坐标(x1,y1,z1),如下所示:

21、

22、

23、z1=h0-h1

24、其中,获得基准点c0和c1的经纬度坐标分别为(n0,e0,h0)以及(n1,e1,h1);l为地球周长信息,l=6381372*math.pi*2,通过将周长l与360/60/60的比值,转换成角秒,表示每角秒对应长度,单位为米。

25、进一步的,所述步骤2中设置位置标签模块的过程包括:

26、首先设定隧道直径为d1米,设置自动激光瞄准模块的投射距离为l米,根据投射距离和隧道直径获得转向角θ,表示为:

27、

28、定位装置控制自动激光瞄准模块的左右旋转电机分别向左和右转动θ角度,向隧道内投射激光点,并在激光点位置设置位置标签模块;在完成一处位置标签模块的设置后,会向前行进设定里程l’,并重复上述过程,完成所有位置标签模块的设置。

29、进一步的,所述步骤3中的粗定位流程需要通过相邻的两组基准点对其间的待测点进行检测,其中每次通过基准点组,都会根据基准点组的经纬度坐标,并根据该基准点组在正向坐标系中的转换坐标,作为后一段隧道中的待测点的检测基准;其中安装粗定位流程包括如下步骤:

30、步骤31:定位装置从隧道入口沿轨道正向行驶,读取经过的基准点组的经纬度坐标,并建立正向坐标系;

31、步骤32:通过编码器获得行驶里程数据,通过未知点求取流程,根据基准点求得相邻的未知待测点的检测坐标;

32、步骤33:根据已知待测点的检测坐标,不断循环求取相邻的未知待测点的检测坐标,直至到达隧道出口,结束步骤。

33、进一步的,所述步骤32中未知点求取流程包括:

34、本文档来自技高网...

【技术保护点】

1.一种隧道定位方法,其特征在于,基于路径规划导航,包括如下步骤:

2.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤1中,将C0设定为坐标原点,设定基准点C0在正向坐标系一中的转换坐标为(0,0,0);将基准点C1的经纬度坐标带入正向坐标系一中获得转换坐标(X1,Y1,Z1),如下所示:

3.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤2中设置位置标签模块的过程包括:

4.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤3中的粗定位流程需要通过相邻的两组基准点对其间的待测点进行检测,其中每次通过基准点组,都会根据基准点组的经纬度坐标,并根据该基准点组在正向坐标系中的转换坐标,作为后一段隧道中的待测点的检测基准;其中安装粗定位流程包括如下步骤:

5.根据权利要求4所述的一种隧道定位方法,其特征在于,所述步骤32中未知点求取流程包括:

6.根据权利要求5所述的一种隧道定位方法,其特征在于,所述步骤324中的加权坐标carP,首先需要建立空间坐标系,以定位装置坐标为原点,根据获得的和在空间坐标系中获得P1和P2的位置,并在空间坐标系中将点P1和P2连线,获得线段P1-P2;获得定位装置坐标,即原点,与线段P1-P2的垂线和垂点坐标;根据空间坐标系中的垂点坐标到点P1和P2坐标的距离比值,分配权值w1和w2,其中权值w1和w2的和为1。

7.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤3设置位置标签模块并完成粗定位后,还需要对位置标签模块的RFID中写入粗定位的坐标,具体包括如下过程:

...

【技术特征摘要】

1.一种隧道定位方法,其特征在于,基于路径规划导航,包括如下步骤:

2.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤1中,将c0设定为坐标原点,设定基准点c0在正向坐标系一中的转换坐标为(0,0,0);将基准点c1的经纬度坐标带入正向坐标系一中获得转换坐标(x1,y1,z1),如下所示:

3.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤2中设置位置标签模块的过程包括:

4.根据权利要求1所述的一种隧道定位方法,其特征在于,所述步骤3中的粗定位流程需要通过相邻的两组基准点对其间的待测点进行检测,其中每次通过基准点组,都会根据基准点组的经纬度坐标,并根据该基准点组在正向坐标系中的转换坐标,作为后一段隧道中的待测点的检测基准;其中安装粗定位流程包...

【专利技术属性】
技术研发人员:余建安叶雪旺陈浙泊毕江海胡泽新王继军王维锐王振文熊秋龙刘玖林郭柱李广平王维镝薛晓荣简浩徐亮安
申请(专利权)人:浙江大学台州研究院
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1