CN108253884B - 盾构机管片非接触式空间姿态的测量方法及系统 - Google Patents

盾构机管片非接触式空间姿态的测量方法及系统 Download PDF

Info

Publication number
CN108253884B
CN108253884B CN201711282421.8A CN201711282421A CN108253884B CN 108253884 B CN108253884 B CN 108253884B CN 201711282421 A CN201711282421 A CN 201711282421A CN 108253884 B CN108253884 B CN 108253884B
Authority
CN
China
Prior art keywords
position point
laser sensor
segment
plane
line laser
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
Application number
CN201711282421.8A
Other languages
English (en)
Other versions
CN108253884A (zh
Inventor
庄欠伟
黄圣
杨正
顾建江
吕建中
秦元
吴兆宇
陈柳锋
彭世宝
程瀛
孙骏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Tunnel Engineering Co Ltd
Original Assignee
Shanghai Tunnel Engineering Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Tunnel Engineering Co Ltd filed Critical Shanghai Tunnel Engineering Co Ltd
Priority to CN201711282421.8A priority Critical patent/CN108253884B/zh
Publication of CN108253884A publication Critical patent/CN108253884A/zh
Application granted granted Critical
Publication of CN108253884B publication Critical patent/CN108253884B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/002Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • G01C15/002Active optical surveying means

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Lining And Supports For Tunnels (AREA)
  • Excavating Of Shafts Or Tunnels (AREA)

Abstract

本发明涉及一种盾构机管片非接触式空间姿态的测量方法及系统,该测量方法包括如下步骤:将两个线激光传感器安装在管片拼装机的抓取板上;建立空间坐标系;通过线激光传感器获得管片上相交的两个边缘线上的第一位置点和第二位置点的坐标,获得另外两个边缘线上的第三位置点和第四位置点的坐标,所述第一位置点和所述第三位置点均位于同一边缘线上;以及通过所获得的第一位置点至第四位置点的坐标和所述的待安装的管片的几何形状计算得出所述的待安装的管片的空间姿态。本发明的测量方法能够准确得到待安装的管片的空间姿态,为自动拼装系统及盾构机内的空间计算提供必要的数据基础。且计算方法简便,测量成本低。

Description

盾构机管片非接触式空间姿态的测量方法及系统
技术领域
本发明涉及盾构机管片的姿态测量领域,特指一种盾构机管片非接触式空间姿态的测量方法及系统。
背景技术
拼装机是盾构机的重要机械系统,拼装施工在传统的隧道掘进中都是由人来完成的,随着传感器技术,自动技术的发展,使得自动化拼装的可行性大大提高,系统的设计成本大大减少,而且自动化拼装是盾构机发展的一个必然的趋势,故研究开发管片的自动化拼装系统,对其关键技术可进行研究显得非常重要及迫切。
对于自动化拼装,首先要解决的问题是如何辨识管片的状态,也就对管片在空间坐标系中的位置,姿态的识别目标识别,而作为操作目标的混凝土预制块重达5~10吨,体积在4立方米以上,而一般的机器人视觉系统的操作目标的体积都不会超过1立方米,所以需要新研究一种非接触式的,对于大型操作目标的空间位姿识别系统来给出其空间位姿。
从市场上来看,我国正在成为世界上掘进机需求量最大的国家,从技术上来看,盾构掘进机代表了隧道掘进装备的发展方向,巨大的市场需求与我国相对滞后的盾构掘进机测试技术之间的矛盾已经凸显。同时,由于盾构机施工是一个高风险的行业,必须保证产品质量稳定性、高可靠性,才能保证工程的顺利完成。而拼装机系统则在保证隧道质量中起着关键的作用。将智能型控制系统引入到拼装系统中后,可以大大提高拼装的工作效率及隧道拼装质量。而对于盾构机拼装系统的智能化,首先要找到一种确认操作物--管片的空间位姿的方法,在国内现有的技术文献中,这种方法并没有被提出过,所以亟需研究开发。
发明内容
本发明的目的在于克服现有技术的缺陷,提供一种盾构机管片非接触式空间姿态的测量方法及系统,解决现有的机器人视觉系统的操作目标体积较小不适用于盾构机管片的姿态测量的问题。
实现上述目的的技术方案是:
本发明提供了一种盾构机管片非接触式空间姿态的测量方法,包括如下步骤:
提供第一线激光传感器和第二线激光传感器,将所述的第一线激光传感器和第二线激光传感器安装在管片拼装机的抓取板上,且所述的第一线激光传感器和第二线激光传感器对应设于所述抓取板上的同一侧;
以水平方向为X轴,垂直方向为Y轴,盾构机的机尾向机头的方向为Z轴建立空间坐标系,并获得所述的第一线激光传感器和第二线激光传感器的安装位置的坐标;
将所述管片拼装机的抓取板移动至待安装的管片的位置处,通过所述第一线激光传感器获得所述的待安装的管片上相交的第一边缘线和第二边缘线上的第一位置点和第二位置点的坐标,通过所述第二线激光传感器获得所述的待安装的管片上相交的第一边缘线和第三边缘线上的第三位置点和第四位置点的坐标,所述第一位置点和所述第三位置点均位于所述第一边缘线上;以及
通过所获得的第一位置点至第四位置点的坐标和所述的待安装的管片的几何形状计算得出所述的待安装的管片的空间姿态。
本发明的测量方法能够准确得到待安装的管片的空间姿态,为自动拼装系统及盾构机内的空间计算提供必要的数据基础。且计算方法简便,测量成本低。
本发明盾构机管片非接触式空间姿态的测量方法的进一步改进在于,通过所获得的第一位置点至第四位置点的坐标和所述的待安装的管片的几何形状计算得出所述的待安装的管片的空间姿态,包括:
利用所述第一位置点和所述第三位置点的坐标计算得出所述第一边缘线的表达式;
基于所述的待安装的管片的几何形状,得到所述第一边缘线与所述第二边缘线和所述第三边缘线的夹角,进而利用所述第二位置点和所述第四位置点计算出所述第二边缘线和所述第三边缘线的表达式,从而得到了所述待安装的管片的空间姿态。
本发明盾构机管片非接触式空间姿态的测量方法的进一步改进在于,还包括:
提供第三线激光传感器,将所述第三线激光传感器安装在所述抓取板上与所述第一线激光传感器相对的一侧;
利用所述第三线激光传感器获得所述待安装的管片上相交的第三边缘线和第四边缘线上的第五位置点和第六位置点的坐标,所述第五位置点与所述第四位置点均位于所述第三边缘线上;
基于所述的待安装的管片的几何形状,利用所述第一位置点、所述第三位置点、所述第五位置点和所述第六位置点计算得出所述的待安装的管片的四个顶点的坐标;
利用所述的待安装的管片的四个顶点的坐标确定得出所述的待安装的管片在所述空间坐标系中的空间姿态。
本发明盾构机管片非接触式空间姿态的测量方法的进一步改进在于,通过所述第一线激光传感器获得所述第一边缘线上的第一位置点的坐标,包括:
通过所述第一线激光传感器测得其距所述第一位置点的距离,并利用所述第一线激光传感器的安装位置的坐标、安装位置与所述空间坐标系中基准面的夹角和所述第一线激光传感器发出的激光面与所述基准面的夹角计算得出所述第一位置点所在的三个相互垂直的第一平面、第二平面以及第三平面的表达式,所述第一平面与所述第一线激光传感器的安装位置所在的平面平行,所述第二平面和所述第三平面与所述第一线激光传感器的安装位置所在的平面垂直;
通过所述第一平面、所述第二平面以及所述第三平面的表达式计算得出所述第一位置点的坐标。
本发明盾构机管片非接触式空间姿态的测量方法的进一步改进在于,还包括:
利用待安装的管片的空间姿态计算得出所述的待安装的管片上的抓取点的坐标,并将所述抓取点的坐标发送给所述管片拼装机。
本发明还提供了一种盾构机管片非接触式空间姿态的测量系统,包括:
安装在管片拼装机的抓取板上的第一线激光传感器和第二线激光传感器,所述的第一线激光传感器和第二线激光传感器对应设于所述抓取板上的同一侧;
存储单元,用于存储设定的空间坐标系,所述空间坐标系以水平方向为X轴,垂直方向为Y轴,盾构机的机尾向机头的方向为Z轴,所述存储单元内还存储有所述空间坐标系内所述第一线激光传感器和所述第二线激光传感器的安装位置的坐标,及待安装管片的几何形状数据;以及
与所述第一线激光传感器、所述第二线激光传感器和所述存储单元连接的处理单元,
所述处理单元用于接收所述第一线激光传感器测得的待安装管片上相交的第一边缘线和第二边缘线上的第一位置点和第二位置点的感测信息并计算得出所述第一位置点和所述第二位置点的坐标;
所述处理单元还用于接收所述第二线激光传感器测得的待安装管片上相交的第一边缘线和第三边缘线上的第三位置点和第四位置点的感测信息并计算得出所述第三位置点和第四位置点的坐标,所述第一位置点和所述第三位置点均位于所述第一边缘线上;
所述处理单元还用于根据所述第一位置点至所述第四位置点的坐标和所述的待安装的管片的几何形状数据计算得出所述的待安装的管片的空间姿态。
本发明盾构机管片非接触式空间姿态的测量系统的进一步改进在于,所述处理单元包括与所述存储单元连接的第一计算模块,
所述第一计算模块用于根据所述第一位置点和所述第三位置点的坐标计算得出所述第一边缘线的表达式;
所述第一计算模块读取所述存储单元中的待安装管片的几何形状数据并获得所述第一边缘线与所述第二边缘线和所述第三边缘线的夹角,利用所述第二位置点和所述第四位置点计算得出所述第二边缘线和所述第三边缘线的表达式;
所述第一计算模块将所述第一边缘线的表达式、所述第二边缘线的表达式和所述第三边缘线的表达式传送给所述处理单元,使得所述处理单元得到所述待安装的管片的空间姿态。
本发明盾构机管片非接触式空间姿态的测量系统的进一步改进在于,还包括安装在所述抓取板上的第三线激光传感器,所述第三线激光传感器位于与所述第一线激光传感器相对的一侧;
所述第三线激光传感器与所述处理单元连接,所述处理单元用于接收所述第三线激光传感器测得的待安装管片上相交的第三边缘线和第四边缘线上的第五位置点和第六位置点的感测信息并计算得出所述第五位置点和第六位置点的坐标,其中的所述第五位置点和所述第四位置点均位于所述第三边缘线上;
所述处理单元还用于根据所述的待安装的管片的几何形状数据、所述第一位置点、所述第三位置点、所述第五位置点和所述第六位置点计算得出所述的待安装的管片的四个顶点的坐标,进而确定得出所述的待安装的管片在所述空间坐标系中的空间姿态。
本发明盾构机管片非接触式空间姿态的测量系统的进一步改进在于,所述处理单元包括与所述存储单元连接的点位坐标计算模块;
所述第一线激光传感器测得其距所述第一位置点的距离形成距离数据,并将所述距离数据发送给所述处理单元;
所述点位坐标计算模块从所述处理单元处接收所述距离数据,并结合所述存储单元中的所述第一线激光传感器的安装位置的坐标、所述第一线激光传感器的安装位置所在的平面与所述空间坐标系中基准面的夹角和所述第一线激光传感器发出的激光面与所述基准面的夹角计算得出所述第一位置点所在的三个相互垂直的第一平面、第二平面以及第三平面的表达式,进而通过所述第一平面、所述第二平面以及所述第三平面的表达式计算得出所述第一位置点的坐标;
其中的所述第一平面与所述第一线激光传感器的安装位置所在的平面平行,所述第二平面和所述第三平面与所述第一线激光传感器的安装位置所在的平面垂直。
本发明盾构机管片非接触式空间姿态的测量系统的进一步改进在于,所述处理单元还用于利用待安装的管片的空间姿态计算得出所述的待安装的管片上的抓取点的坐标,并将所述抓取点的坐标发送给所述管片拼装机。
附图说明
图1为本发明盾构机管片非接触式空间姿态的测量系统及方法中的第一线激光传感器至第三线激光传感器的安装结构示意图。
图2为本发明盾构机管片非接触式空间姿态的测量系统及方法中利用线激光传感器测量待安装的管片的结构示意图。
图3为本发明盾构机管片非接触式空间姿态的测量系统及方法中利用线激光传感器测量待安装的管上的位置点的示意图。
图4至图7为本发明利用第一线激光传感器计算第一位置点的坐标的原理图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。
参阅图1,本发明提供了一种盾构机管片非接触式空间姿态的测量系统及方法,能够对管片的空间位姿进行辨识,为管片拼装机的自动化提供可能。本发明的测量系统及方法能够检测出未拼装管片在盾构机内部的空间位置,检测出管片拼装完成后的姿态及空间位置,本发明的测量系统及方法能够准确的得到未拼装管片的空间姿态,为自动拼装系统及盾构机内部空间计算提供必要的数据。下面结合附图对本发明盾构机管片非接触式空间姿态的测量系统及方法进行说明。
参阅图1,显示了本发明盾构机管片非接触式空间姿态的测量系统及方法中的第一线激光传感器至第三线激光传感器的安装结构示意图。下面结合图1,对本发明提供的盾构机管片非接触式空间姿态的测量系统进行说明。
如图1所示,本发明提供的盾构机管片非接触式空间姿态的测量系统包括第一线激光传感器21、第二线激光传感器22、存储单元以及处理单元;其中的第一线激光传感器21和第二线激光传感器22安装在管片拼装机的抓取板10上,该抓取板10具有相对的第一侧101和第二侧102,第一线激光传感器21和第二线激光传感器22安装在抓取板10的同一侧,即安装在第一侧101处。结合图2所示,存储单元用于存储设定的空间坐标系,该空间坐标系以水平方向为X轴,垂直方向为Y轴,盾构机的机尾向机头的方向为Z轴,在存储单元内还存储有空间坐标系内第一线激光传感器21和第二线激光传感器22的安装位置的坐标,以及待安装管片11的几何形状数据。处理单元与第一线激光传感器21、第二线激光传感器22和存储单元连接,结合图3所示,处理单元用于接收第一线激光传感器21测得的待安装管片11上相交的第一边缘线111和第二边缘线112上的第一位置点a和第二位置点b的感测信息并计算得出第一位置点a和第二位置点b的坐标。处理单元还用于接收第二线激光传感器22测得的待安装管片11上相交的第一边缘线111和第三边缘线113上的第三位置点c和第四位置点d的感测信息并计算得出第三位置点c和第四位置点d的坐标,该第三位置点c和第一位置点a均位于第一边缘线111上。处理单元还用于根据第一位置点a至第四位置点d的坐标和待安装的管片11的几何形状数据计算得出待安装的管片11的空间姿态。
在盾构施工过程中,施工的管片的形状已经确定,如图2所示,管片11的顶面边缘具有四条边缘线,分别是第一边缘线111、第二边缘线112、第三边缘线113和第四边缘线114,本发明中所指的待安装的管片11的几何形状数据包括第一边缘线111与第二边缘线112和第三边缘线113的夹角,第一边缘线111与第四边缘线114的位置关系,第四边缘线114与第二边缘线112和第三边缘线113的位置关系,第二边缘线112和第三边缘线113的弧度,管片11的厚度,四条边缘线的长度。本发明设置的第一线激光传感器21和第二线激光传感器22靠近第一边缘线111,所以第一线激光传感器21可测得第一边缘线111和第二边缘线112上的位置点,分别是第一位置点a和第二位置点b,第二线激光传感器22可测得第一边缘线111和第三边缘线113上的位置点,分别是第三位置点c和第四位置点d。通过第一线激光传感器21和第二线激光传感器22测得的感测信息,处理单元能够计算出第一位置点a至第二位置点b在存储单元中的空间坐标系内的坐标值,进而根据四个位置点的坐标和管片11的几何形状数据计算得出管片11的空间姿态。
作为本发明的一较佳实施方式,处理单元包括与存储单元连接的第一计算模块,该第一计算模块用于根据第一位置点a和第三位置点c的坐标计算得出第一边缘线111的表达式,由于第一位置点a和第三位置点c均位于第一边缘线111上,从而在空间坐标系内可确定第一边缘线111的表达式;该第一计算模块读取存储单元中的待安装管片的几何形状数据并获得第一边缘线111与第二边缘线112和第三边缘线113的夹角,利用第二位置点b和第四位置点d计算得出第二边缘线112和第三边缘线113的表达式,因管片11的形状固定,第一边缘线111和第三边缘线113所在的面呈一定夹角,该夹角为已知且固定,可通过空间几何计算得出管片的顶点e1的坐标,第三边缘线113的形状是固定的,通过顶点e1和第四位置点d计算出第三边缘线113,同理计算出第二边缘线112,从而就可确定管片11的空间姿态了。第一计算模块将第一边缘线111的表达式、第二边缘线112的表达式和第三边缘线113的表达式传送给处理单元,使得处理单元得到待安装的管片11的空间姿态。在本实施方式中第一计算模块给出了一种计算管片11的空间姿态的方法。
作为本发明的另一较佳实施方式,给出了另一种计算管片11的空间姿态的方法。如图1至图3所示,该测量系统还包括安装在抓取板10上的第三线激光传感器23,该第三线激光传感器23位于与第一线激光传感器21的相对的一侧,即第二侧102,该第三线激光传感器23靠近第四边缘线114设置,能够测得第四边缘线114和第三边缘线113上的位置点,分别是第六位置点g和第五位置点f。该第三线激光传感器23与处理单元连接,该处理单元用于接收第三线激光传感器23测得的待安装管片11上相交的第三边缘线113和第四边缘线114上的第五位置点f和第六位置点g的感测信息并计算得出第五位置点f和第六位置点g的坐标,其中的第五位置点f和第四位置点d均位于第三边缘线113上。在本实施方式中,处理单元根据待安装的管片11的几何形状数据、第一位置点a、第三位置点c、第五位置点f和第六位置点g计算得出待安装的管片11的四个顶点e1至e4的坐标,进而确定得出待安装的管片11在空间坐标系中的空间姿态。首先因第一位置点a和第三位置点c在第一边缘线111上,从而可确定管片11的第一边缘线111,第一边缘线111和第四边缘线114的几何关系固定,可解算得到第四边缘线114的表达式,通过管片11的固定形状和第五位置点f,可得知管片11的顶点e1、顶点e2、顶点e3和顶点e4的坐标,通过四个顶点可确定管片11在空间的最终姿态,四个顶点所在的平面E和四个顶点与管片11上的抓取点呈唯一确定的关系,可由此计算得出抓取点在空间坐标系的坐标,进而提供给管片拼装机,确保管片拼装机对待安装的管片11的准确抓取。本实施方式中的计算方法相较于第一计算模块的计算方法实现更为简单。
作为本发明的又一较佳实施方式,处理单元还包括与存储单元连接的点位坐标计算模块,通过点位坐标计算模块可根据线激光传感器反馈的数据计算出所需要的位置点的坐标,下面以根据第一线激光传感器21的反馈数据计算第一位置点a的坐标为例进行说明,其余位置点的坐标计算与此相同。第一线激光传感器21测得距第一位置点a的距离形成距离数据,结合图4所示,第一线激光传感器21的安装位置h的坐标、安装位置h所在的平面H、该平面H与空间坐标系中基准面(ZOY,XOZ,XOY)的夹角、第一线激光传感器21的激光面与基准面的夹角均为已知参数,该些已知参数事先存储于存储单元内。第一线激光传感器21能够测得的距离数据包括平面H距第一位置点a所在的平面I间的距离L1和第一位置点a距安装位置h投射在平面I上的点的距离L2,其中的平面H和平面I相互平行。该第一线激光传感器21将测得的距离数据发送给处理单元。结合图7所示,点位坐标计算模块从处理单元处接收该距离数据,并结合存储单元中的第一线激光传感器21的安装位置h的坐标、第一线激光传感器21的安装位置与空间坐标系中基准面的夹角和第一线激光传感器21发出的激光面与基准面的夹角计算得出第一位置点a所在的三个相互垂直的第一平面I、第二平面J以及第三平面K的表达式,进而通过第一平面I、第二平面J以及第三平面K计算得出第一位置点a的坐标。其中的第一平面I与第一线激光传感器21的安装位置h所在的平面H平行,第二平面J和第三平面K与第一线激光传感器21的安装位置h所在的平面H垂直。
该点位坐标计算模块的计算过程具体为:如图4所示,第一线激光传感器21的安装位置h的坐标为(xh,yh,zh),平面H为第一线激光传感器21安装所在的平面,且以该第一激光传感器21的安装方向作为法向量,平面H与空间坐标系的三个基准面的夹角为α1,α2,α3,第一线激光传感器21的激光面与空间坐标系的三个基准面的夹角为θ1,θ2,θ3,第一线激光传感器21测得的平面H和第一平面I之间的距离L1和第一位置点a和安装位置h投射在第一平面I上的点间的距离L2。平面H的空间坐标方程可根据已知的法向量及安装位置h的坐标(xh,yh,zh)求得,该平面H的表达式为:
cosα1(x-xh)+cosα2(y-yh)+cosα3(z-zh)=0,
带入α1,α2,α3,及(xh,yh,zh)可得到平面H的空间方程为:
A1x+B1y+C1z+D1=0,
第一平面I与平面H平行,距离为L1,可得到该第一平面I的空间方程为:
A1x+B1y+C1z+D2=0,
其中D2=±|[L1/squar(A1*A1+B1*B1+C1*C1)-D1]|,经过对空间位置的筛选,可求出D2的正确值。
接着如图5所示,第二平面J为第一激光传感器21的激光面,该第二平面J的空间方程为:
sinθ1(x-xh)+sinθ2(y-yh)+sinθ3(z-zh)=0,
带入θ1,θ2,θ3,及(xh,yh,zh)可得到第二平面J的空间方程为:
A3x+B3y+C3z+D3=0,
如图6所示,作平面L同时垂直于平面H和第二平面J,该平面L的空间方程为:
[A1B1C1]×[A3B3C3]=[A4B4C4],
平面L的空间方程为:
A4x+B4y+C4z+D4=0,
第三平面K与平面L平行,且第一位置点a在第三平面K上,该第三平面K和平面L的距离为L2,故第三平面K的空间方程为:
A4x+B4y+C4z+D5=0,
其中D5=±|[L2/squar(A4*A4+B4*B4+C4*C4)-D4]|,经过对空间位置的筛选,可求出D5的正确值。
接着如图7所示,这样根据第一平面I、第二平面J、以及第三平面K的空间方程求出第一位置点a的坐标(xa,ya,za):
其中的均为A1、B1、C1、D2、A3、B3、C3、D3、A4、B4、C4、D5均为已知。
通过点位坐标计算模块可求得第一位置点a的坐标(xa,ya,za)、第二位置点b的坐标(xb,yb,zb)、第三位置点c的坐标(xc,yc,zc)、第四位置点d的坐标(xd,yd,zd)、第五位置点f的坐标(xf,yf,zf)、以及第六位置点g的坐标(xg,yg,zg)。处理单元在利用第一位置点a至第六位置点g计算管片11的空间姿态的过程为:
第一边缘线111的空间方程为:
(X-xa)/(xa-xc)=(Y-ya)/(ya-yc)=(Z-za)/(za-zc),
第四位置点d和第五位置点f所在的侧面与第一边缘线111相垂直,夹角为直角,故该侧面的空间方程为:
(xa-xc)(X-xb)+(ya-yc)(Y-yb)+(za-zc)(Z-zb)=0,
化简得到:
A7X+B7Y+C7Z+D7=0,
结合第一边缘线111的空间方程,可得到管片11的顶点e1的坐标(Xe1,Ye1,Ze1)。
同样,可求得顶点e2的坐标(Xe2,Ye2,Ze2)和顶点e4的坐标(Xe4,Ye4,Ze4),基于三个顶点确定顶点的平面E,管片11的抓取点Q和三个顶点的直线距离是固定的,可通过如下方程组求解抓取点Q的坐标(XQ,YQ,ZQ),
(XQ-Xe1)∧2+(YQ-Ye1)∧2+(ZQ-Ze1)∧2=0
(XQ-Xe2)∧2+(YQ-Ye2)∧2+(ZQ-Ze2)∧2=0,
(XQ-Xe4)∧2+(YQ-Ye4)∧2+(ZQ-Ze4)∧2=0
从而管片11的位姿通过平面E和抓取点Q来确定。
作为本发明的再一较佳实施方式,处理单元还用于利用待安装的管片11的空间姿态计算得出待安装的管片11上的抓取点Q的坐标,并将抓取点Q的坐标发送给管片拼装机。较佳地,将抓取点Q设置为管片11顶面的中心位置。
本发明的测量系统中的第一线激光传感器21至第三线激光传感器23安装在抓取板10上,处理单元和存储单元可设于单独的服务器上,也可以与管片拼装机的控制器集成在一起,处理单元所实现的计算功能由应用程序设定实现,存储单元中所存储的参数由事先输入得到,施工中的管片几何形状确定后,其几何形状数据可由作业人员输入给测量系统。为便于管片拼装机对待安装的管片的姿态识别,将管片拼装机设于空间坐标系的原点,从而待处理单元发送管片的抓取点坐标后,该管片拼装机可直接向空间坐标系中的抓取点坐标移动即可进行准确地抓取。
下面对本发明提供的盾构机管片非接触式空间姿态的测量方法进行说明。
本发明提供的一种盾构机管片非接触式空间姿态的测量方法,包括如下步骤:
如图1所示,提供第一线激光传感器21和第二线激光传感器22,将的第一线激光传感器21和第二线激光传感器22安装在管片拼装机的抓取板10上,且的第一线激光传感器21和第二线激光传感器22对应设于抓取板10上的同一侧,即第一侧101;
以水平方向为X轴,垂直方向为Y轴,盾构机的机尾向机头的方向为Z轴建立空间坐标系,并获得的第一线激光传感器21和第二线激光传感器22的安装位置的坐标;
如图2和图3所示,将管片拼装机的抓取板10移动至待安装的管片11的位置处,通过第一线激光传感器21获得的待安装的管片11上相交的第一边缘线111和第二边缘线112上的第一位置点a和第二位置点b的坐标,通过第二线激光传感器22获得的待安装的管片11上相交的第一边缘线111和第三边缘线113上的第三位置点c和第四位置点d的坐标,第一位置点a和第三位置点c均位于第一边缘线111上;以及
通过所获得的第一位置点a至第四位置点d的坐标和的待安装的管片11的几何形状计算得出的待安装的管片11的空间姿态。
在盾构施工过程中,施工的管片的形状已经确定,如图2所示,管片11的顶面边缘具有四条边缘线,分别是第一边缘线111、第二边缘线112、第三边缘线113和第四边缘线114,本发明中所指的待安装的管片11的几何形状数据包括第一边缘线111与第二边缘线112和第三边缘线113的夹角,第一边缘线111与第四边缘线114的位置关系,第四边缘线114与第二边缘线112和第三边缘线113的位置关系,第二边缘线112和第三边缘线113的弧度,管片11的厚度,四条边缘线的长度。本发明设置的第一线激光传感器21和第二线激光传感器22靠近第一边缘线111,所以第一线激光传感器21可测得第一边缘线111和第二边缘线112上的位置点,分别是第一位置点a和第二位置点b,第二线激光传感器22可测得第一边缘线111和第三边缘线113上的位置点,分别是第三位置点c和第四位置点d。通过第一线激光传感器21和第二线激光传感器22测得的感测信息,能够计算出第一位置点a至第二位置点b在存储单元中的空间坐标系内的坐标值,进而根据四个位置点的坐标和管片11的几何形状数据计算得出管片11的空间姿态。本发明的测量方法能够准确得到待安装的管片的空间姿态,为自动拼装系统及盾构机内的空间计算提供必要的数据基础。且计算方法简便,测量成本低。
作为本发明的一较佳实施方式,通过所获得的第一位置点a至第四位置点d的坐标和待安装的管片11的几何形状计算得出的待安装的管片11的空间姿态,包括:
利用第一位置点a和第三位置点c的坐标计算得出第一边缘线111的表达式;
基于的待安装的管片11的几何形状,得到第一边缘线111与第二边缘线112和第三边缘线113的夹角,进而利用第二位置点b和第四位置点d计算出第二边缘线112和第三边缘线113的表达式,从而得到了待安装的管片11的空间姿态。本实施方式中的计算方法的原理及过程同测量系统中的第一计算模块,具体可参见第一计算模块的计算原理及过程的描述,在此不再赘述。
作为本发明的另一较佳实施方式,还包括:
提供第三线激光传感器23,将第三线激光传感器23安装在抓取板10上与第一线激光传感器21相对的一侧,即第二侧102;
利用第三线激光传感器23获得待安装的管片11上相交的第三边缘线113和第四边缘线114上的第五位置点f和第六位置点g的坐标,第五位置点f与第四位置点d均位于第三边缘线113上;
基于的待安装的管片11的几何形状,利用第一位置点a、第三位置点c、第五位置点f和第六位置点g计算得出的待安装的管片11的四个顶点e1至e4的坐标;
利用的待安装的管片11的四个顶点的坐标确定得出的待安装的管片11在空间坐标系中的空间姿态。本实施方式中的计算方法的原理及过程同测量系统中处理单元的计算原理及过程,具体可参见处理单元的计算原理及过程的描述,在此不再赘述。
作为本发明的又一较佳实施方式,通过第一线激光传感器21获得第一边缘线111上的第一位置点a的坐标,包括:
如图4至图7所示,通过第一线激光传感器21测得其距第一位置点a的距离,并利用第一线激光传感器21的安装位置的坐标、安装位置所在的平面与空间坐标系中基准面的夹角和第一线激光传感器发出的激光面与基准面的夹角计算得出第一位置点a所在的三个相互垂直的第一平面I、第二平面J以及第三平面K的表达式,第一平面I与第一线激光传感器21的安装位置所在的平面H平行,第二平面J和第三平面K与第一线激光传感器的安装位置所在的平面H垂直;
通过第一平面I、第二平面J以及第三平面K的表达式计算得出第一位置点a的坐标。本实施方式中的计算位置点坐标的方法的原理及过程同测量系统中点位坐标计算模块的计算原理及过程,具体可参见点位坐标计算模块的计算原理及过程的描述,在此不再赘述。
作为本发明的再一较佳实施方式,还包括:
利用待安装的管片11的空间姿态计算得出的待安装的管片上的抓取点Q的坐标,并将抓取点Q的坐标发送给管片拼装机。本实施方式中的计算方法的原理及过程同测量系统中处理单元的计算原理及过程,具体可参见处理单元的计算原理及过程的描述,在此不再赘述。
以上结合附图实施例对本发明进行了详细说明,本领域中普通技术人员可根据上述说明对本发明做出种种变化例。因而,实施例中的某些细节不应构成对本发明的限定,本发明将以所附权利要求书界定的范围作为本发明的保护范围。

Claims (10)

1.一种盾构机管片非接触式空间姿态的测量方法,其特征在于,包括如下步骤:
提供第一线激光传感器和第二线激光传感器,将所述的第一线激光传感器和第二线激光传感器安装在管片拼装机的抓取板上,且所述的第一线激光传感器和第二线激光传感器对应设于所述抓取板上的同一侧;
以水平方向为X轴,垂直方向为Y轴,盾构机的机尾向机头的方向为Z轴建立空间坐标系,并获得所述的第一线激光传感器和第二线激光传感器的安装位置的坐标;
将所述管片拼装机的抓取板移动至待安装的管片的位置处,通过所述第一线激光传感器获得所述的待安装的管片上相交的第一边缘线和第二边缘线上的第一位置点和第二位置点的坐标,通过所述第二线激光传感器获得所述的待安装的管片上相交的第一边缘线和第三边缘线上的第三位置点和第四位置点的坐标,所述第一位置点和所述第三位置点均位于所述第一边缘线上;以及
通过所获得的第一位置点至第四位置点的坐标和所述的待安装的管片的几何形状计算得出所述的待安装的管片的空间姿态。
2.如权利要求1所述的盾构机管片非接触式空间姿态的测量方法,其特征在于,通过所获得的第一位置点至第四位置点的坐标和所述的待安装的管片的几何形状计算得出所述的待安装的管片的空间姿态,包括:
利用所述第一位置点和所述第三位置点的坐标计算得出所述第一边缘线的表达式;
基于所述的待安装的管片的几何形状,得到所述第一边缘线与所述第二边缘线和所述第三边缘线的夹角,进而利用所述第二位置点和所述第四位置点计算出所述第二边缘线和所述第三边缘线的表达式,从而得到了所述待安装的管片的空间姿态。
3.如权利要求1所述的盾构机管片非接触式空间姿态的测量方法,其特征在于,还包括:
提供第三线激光传感器,将所述第三线激光传感器安装在所述抓取板上与所述第一线激光传感器相对的一侧;
利用所述第三线激光传感器获得所述待安装的管片上相交的第三边缘线和第四边缘线上的第五位置点和第六位置点的坐标,所述第五位置点与所述第四位置点均位于所述第三边缘线上;
基于所述的待安装的管片的几何形状,利用所述第一位置点、所述第三位置点、所述第五位置点和所述第六位置点计算得出所述的待安装的管片的四个顶点的坐标;
利用所述的待安装的管片的四个顶点的坐标确定得出所述的待安装的管片在所述空间坐标系中的空间姿态。
4.如权利要求1所述的盾构机管片非接触式空间姿态的测量方法,其特征在于,通过所述第一线激光传感器获得所述第一边缘线上的第一位置点的坐标,包括:
通过所述第一线激光传感器测得其距所述第一位置点的距离,并利用所述第一线激光传感器的安装位置的坐标、安装位置与所述空间坐标系中基准面的夹角和所述第一线激光传感器发出的激光面与所述基准面的夹角计算得出所述第一位置点所在的三个相互垂直的第一平面、第二平面以及第三平面的表达式,所述第一平面与所述第一线激光传感器的安装位置所在的平面平行,所述第二平面和所述第三平面与所述第一线激光传感器的安装位置所在的平面垂直;
通过所述第一平面、所述第二平面以及所述第三平面的表达式计算得出所述第一位置点的坐标。
5.如权利要求1所述的盾构机管片非接触式空间姿态的测量方法,其特征在于,还包括:
利用待安装的管片的空间姿态计算得出所述的待安装的管片上的抓取点的坐标,并将所述抓取点的坐标发送给所述管片拼装机。
6.一种盾构机管片非接触式空间姿态的测量系统,其特征在于,包括:
安装在管片拼装机的抓取板上的第一线激光传感器和第二线激光传感器,所述的第一线激光传感器和第二线激光传感器对应设于所述抓取板上的同一侧;
存储单元,用于存储设定的空间坐标系,所述空间坐标系以水平方向为X轴,垂直方向为Y轴,盾构机的机尾向机头的方向为Z轴,所述存储单元内还存储有所述空间坐标系内所述第一线激光传感器和所述第二线激光传感器的安装位置的坐标,及待安装管片的几何形状数据;以及
与所述第一线激光传感器、所述第二线激光传感器和所述存储单元连接的处理单元,
所述处理单元用于接收所述第一线激光传感器测得的待安装管片上相交的第一边缘线和第二边缘线上的第一位置点和第二位置点的感测信息并计算得出所述第一位置点和所述第二位置点的坐标;
所述处理单元还用于接收所述第二线激光传感器测得的待安装管片上相交的第一边缘线和第三边缘线上的第三位置点和第四位置点的感测信息并计算得出所述第三位置点和第四位置点的坐标,所述第一位置点和所述第三位置点均位于所述第一边缘线上;
所述处理单元还用于根据所述第一位置点至所述第四位置点的坐标和所述的待安装的管片的几何形状数据计算得出所述的待安装的管片的空间姿态。
7.如权利要求6所述的盾构机管片非接触式空间姿态的测量系统,其特征在于,所述处理单元包括与所述存储单元连接的第一计算模块,
所述第一计算模块用于根据所述第一位置点和所述第三位置点的坐标计算得出所述第一边缘线的表达式;
所述第一计算模块读取所述存储单元中的待安装管片的几何形状数据并获得所述第一边缘线与所述第二边缘线和所述第三边缘线的夹角,利用所述第二位置点和所述第四位置点计算得出所述第二边缘线和所述第三边缘线的表达式;
所述第一计算模块将所述第一边缘线的表达式、所述第二边缘线的表达式和所述第三边缘线的表达式传送给所述处理单元,使得所述处理单元得到所述待安装的管片的空间姿态。
8.如权利要求6所述的盾构机管片非接触式空间姿态的测量系统,其特征在于,还包括安装在所述抓取板上的第三线激光传感器,所述第三线激光传感器位于与所述第一线激光传感器相对的一侧;
所述第三线激光传感器与所述处理单元连接,所述处理单元用于接收所述第三线激光传感器测得的待安装管片上相交的第三边缘线和第四边缘线上的第五位置点和第六位置点的感测信息并计算得出所述第五位置点和第六位置点的坐标,其中的所述第五位置点和所述第四位置点均位于所述第三边缘线上;
所述处理单元还用于根据所述的待安装的管片的几何形状数据、所述第一位置点、所述第三位置点、所述第五位置点和所述第六位置点计算得出所述的待安装的管片的四个顶点的坐标,进而确定得出所述的待安装的管片在所述空间坐标系中的空间姿态。
9.如权利要求6所述的盾构机管片非接触式空间姿态的测量系统,其特征在于,所述处理单元包括与所述存储单元连接的点位坐标计算模块;
所述第一线激光传感器测得其距所述第一位置点的距离形成距离数据,并将所述距离数据发送给所述处理单元;
所述点位坐标计算模块从所述处理单元处接收所述距离数据,并结合所述存储单元中的所述第一线激光传感器的安装位置的坐标、所述第一线激光传感器的安装位置所在的平面与所述空间坐标系中基准面的夹角和所述第一线激光传感器发出的激光面与所述基准面的夹角计算得出所述第一位置点所在的三个相互垂直的第一平面、第二平面以及第三平面的表达式,进而通过所述第一平面、所述第二平面以及所述第三平面的表达式计算得出所述第一位置点的坐标;
其中的所述第一平面与所述第一线激光传感器的安装位置所在的平面平行,所述第二平面和所述第三平面与所述第一线激光传感器的安装位置所在的平面垂直。
10.如权利要求6所述的盾构机管片非接触式空间姿态的测量系统,其特征在于,所述处理单元还用于利用待安装的管片的空间姿态计算得出所述的待安装的管片上的抓取点的坐标,并将所述抓取点的坐标发送给所述管片拼装机。
CN201711282421.8A 2017-12-07 2017-12-07 盾构机管片非接触式空间姿态的测量方法及系统 Active CN108253884B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711282421.8A CN108253884B (zh) 2017-12-07 2017-12-07 盾构机管片非接触式空间姿态的测量方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711282421.8A CN108253884B (zh) 2017-12-07 2017-12-07 盾构机管片非接触式空间姿态的测量方法及系统

Publications (2)

Publication Number Publication Date
CN108253884A CN108253884A (zh) 2018-07-06
CN108253884B true CN108253884B (zh) 2019-12-20

Family

ID=62721145

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711282421.8A Active CN108253884B (zh) 2017-12-07 2017-12-07 盾构机管片非接触式空间姿态的测量方法及系统

Country Status (1)

Country Link
CN (1) CN108253884B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109555543B (zh) * 2019-02-01 2024-03-29 中国铁建重工集团股份有限公司 一种管片自动输送及识别系统
CN110197032A (zh) * 2019-05-30 2019-09-03 上海隧道工程有限公司 管片拼装方案选取方法及系统
CN112253168B (zh) * 2020-10-28 2022-04-22 中交天和机械设备制造有限公司 一种盾构机管片自动化拼装方法及装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59214703A (ja) * 1983-05-21 1984-12-04 Mc Kk レ−ザ−光を利用した位置測定装置
JPH07166797A (ja) * 1993-12-15 1995-06-27 Ohbayashi Corp 既設セグメント形状の把握方法
CN104457719A (zh) * 2014-12-28 2015-03-25 上海隧道工程股份有限公司 矩形盾构施工的姿态测量装置及测量方法
CN106522984A (zh) * 2016-08-25 2017-03-22 广州地铁设计研究院有限公司 一种盾构隧道管片三维精细化拼装的建模方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59214703A (ja) * 1983-05-21 1984-12-04 Mc Kk レ−ザ−光を利用した位置測定装置
JPH07166797A (ja) * 1993-12-15 1995-06-27 Ohbayashi Corp 既設セグメント形状の把握方法
CN104457719A (zh) * 2014-12-28 2015-03-25 上海隧道工程股份有限公司 矩形盾构施工的姿态测量装置及测量方法
CN106522984A (zh) * 2016-08-25 2017-03-22 广州地铁设计研究院有限公司 一种盾构隧道管片三维精细化拼装的建模方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
盾构机管片拼装姿态微调机构设计与任务空间规划;邵成猛等;《制造业自动化》;20151031;第37卷(第10期);125-126、133页 *

Also Published As

Publication number Publication date
CN108253884A (zh) 2018-07-06

Similar Documents

Publication Publication Date Title
CN108253884B (zh) 盾构机管片非接触式空间姿态的测量方法及系统
CN102825602B (zh) 一种基于psd的工业机器人自标定方法及装置
CN103389081B (zh) 管桁架次杆相贯口空间的定位方法
CN102937426B (zh) 一种基于机器人视觉伺服的大型复杂零件测量方法
CN108827264B (zh) 作业台车及其机械臂光学标靶定位装置和定位方法
CN102661046B (zh) 小角度全弯管长相贯节点制作方法
CN102126162B (zh) 一种数控机床加工在线测量方法
CN106092009B (zh) 一种基于拉线编码器的站点可动式测量机构的初始位置校准方法
CN102393169B (zh) 一种用于合拢管测量的三拉绳测量方法
CN103512511A (zh) 一种基于激光跟踪仪的大型面自动化测量方法
WO2020125732A1 (zh) 一种机械臂关节传感器的零位校准方法和设备
CN109341532A (zh) 一种面向自动装配的基于结构特征的零件坐标标定方法
KR102634535B1 (ko) 포인트 집단 분석을 이용한 작업대상물의 터치교시점 인식방법
CN104102173A (zh) 数控装置
CN104101326A (zh) 一种基于空间几何分析的盾构姿态自动测量方法及装置
CN111421226B (zh) 一种基于激光切管设备的管材识别方法及装置
CN107992647A (zh) 一种受几何结构影响的局部并联尺寸链误差获取方法
CN112828878B (zh) 一种大型设备对接过程三维测量与跟踪方法
CN103471572A (zh) 全站仪组网测量大型结构件的方法
CN107218909B (zh) 一种在发动机叶片上贴应变片的方法
TWI492080B (zh) 三次元安全面建立系統及方法
CN102322798A (zh) 基于光学成像的工业测量系统
CN106646498A (zh) 一种掘进机横向偏移测量方法
CN110238848B (zh) 一种机器人坐标系下重力矢量的计算方法
CN105588512B (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