本发明专利技术涉及一种竖井掘进位姿测量装置和方法，其中，装置包括：绳状物，所述绳状物的一端固定于井口处的井口固定点，另一端分为第一支段、第二支段和第三支段，其中，所述第一支段与掘进机上的第一固定点连接，所述第二支段与掘进机上的第二固定点连接，所述第三支段与掘进机上的第三固定点连接；测力计，设置在所述第一支段、第二支段和第三支段上；角度传感器，设置在所述掘进机上；计算模块，用于根据所述测力计的检测值计算出所述参考点在掘进机坐标系中的坐标值，再结合所述角度传感器的检测值以及所述参考点在大地坐标系中的坐标值得到所述掘进机的位置和姿态。本发明专利技术能够对竖井掘进机的姿态进行测量。掘进机的姿态进行测量。掘进机的姿态进行测量。
【技术实现步骤摘要】
一种竖井掘进位姿测量装置及方法
[0001]本专利技术涉及掘进机姿态检测
，特别是涉及一种竖井掘进位姿测量装置及方法。
技术介绍
[0002]竖井掘进机的成井质量很大程度上取决于掘进过程中的姿态监测以及偏斜控制，传统的竖井定向依靠传统的吊线和激光方式，吊线时垂直度和标高控制方法存在着工作过程繁琐、效率低、精度不高等问题。激光方式则受环境影响很大，成像板长时间使用后会附着灰尘或水滴，影响相机的拍摄，从而影响系统的准确性。
技术实现思路
[0003]本专利技术所要解决的技术问题是提供一种竖井掘进位姿测量装置及方法，能够对竖井掘进机的姿态进行测量。
[0004]本专利技术解决其技术问题所采用的技术方案是：提供一种竖井掘进位姿测量装置，包括：
[0005]绳状物，所述绳状物的一端固定于井口处的井口固定点，另一端分为第一支段、第二支段和第三支段，其中，所述第一支段与掘进机上的第一固定点连接，所述第二支段与掘进机上的第二固定点连接，所述第三支段与掘进机上的第三固定点连接；所述第二固定点和第三固定点与参考点均位于所述掘进机的水平面上，所述参考点为所述井口固定点向所述掘进机的水平面垂直投影的投影点，所述第一固定点位于所述掘进机的水平面下方，并在所述绳状物受力平衡时能够使得所述第一支段与所述掘进机的水平面垂直；
[0006]测力计，设置在所述第一支段、第二支段和第三支段上；
[0007]角度传感器，设置在所述掘进机上；
[0008]计算模块，用于根据所述测力计的检测值计算出所述参考点在掘进机坐标系中的坐标值，再结合所述角度传感器的检测值以及所述参考点在大地坐标系中的坐标值得到所述掘进机的位置和姿态。
[0009]所述计算模块包括：第一角度计算单元，用于根据所述第二支段和第三支段上的测力计的测量值以及第二支段与第三支段之间的夹角计算出所述绳状物水平方向分力与所述第二支段之间的夹角；第二角度计算单元，用于根据所述第一支段、第二支段和第三支段上的测力计的测量值以及第二支段与第三支段之间的夹角计算出所述绳状物与所述第一支段之间的夹角；掘进机坐标计算单元，用于根据所述绳状物水平方向分力与所述第二支段之间的夹角、所述绳状物与所述第一支段之间的夹角以及所述绳状物的长度计算所述参考点在掘进机坐标系上的坐标值；位姿计算单元，用于根据所述参考点在掘进机坐标系上的坐标值、所述参考点在大地坐标系上的坐标值以及所述角度传感器的检测值计算掘进机的位置和姿态。
[0010]所述第一角度计算单元通过计算出所述绳状物水平方向分力与所述第二支段之间的夹角，其中，F2为所述第二支段上的测力计的测量值，F3为所述第三支段上的测力计的测量值，β为所述第二支段与第三支段之间的夹角，θ为所述绳状物水平方向分力与所述第二支段之间的夹角。
[0011]所述第二角度计算单元通过计算出所述绳状物与所述第一支段之间的夹角，其中，F1为所述第一支段上的测力计的测量值，F2为所述第二支段上的测力计的测量值，F3为所述第三支段上的测力计的测量值，β为所述第二支段与第三支段之间的夹角，θ为所述绳状物水平方向分力与所述第二支段之间的夹角，α为所述绳状物与所述第一支段之间的夹角；F4为所述绳状物水平方向分力，F5为所述绳状物所受的力。
[0012]本专利技术解决其技术问题所采用的技术方案是：还提供一种竖井掘进位姿测量方法，使用上述的竖井掘进位姿测量装置，包括以下步骤：
[0013](1)将所述绳状物的一端固定于井口处的井口固定点，将所述第一支段、第二支段和第三支段分别与所述第一固定点、第二固定点和第三固定点连接，调整所述绳状物拉力使得所述绳状物受力平衡，且所述绳状物的另一端与所述第二固定点和第三固定点位于同一水平面；
[0014](2)获取所述第一支段、第二支段、第三支段上测力计以及所述角度传感器的检测值；
[0015](3)根据所述测力计的检测值计算出所述参考点在掘进机坐标系中的坐标值，再结合所述角度传感器的检测值以及所述参考点在大地坐标系中的坐标值得到所述掘进机的位置和姿态。
[0016]所述步骤(3)包括以下子步骤：
[0017](31)根据所述第二支段和第三支段上的测力计的测量值以及第二支段与第三支段之间的夹角计算出所述绳状物水平方向分力与所述第二支段之间的夹角；
[0018](32)根据所述第一支段、第二支段和第三支段上的测力计的测量值以及第二支段与第三支段之间的夹角计算出所述绳状物与所述第一支段之间的夹角；
[0019](33)根据所述绳状物水平方向分力与所述第二支段之间的夹角、所述绳状物与所述第一支段之间的夹角以及所述绳状物的长度计算所述参考点在掘进机坐标系上的坐标值；
[0020](34)根据所述参考点在掘进机坐标系上的坐标值、所述参考点在大地坐标系上的坐标值以及所述角度传感器的检测值计算掘进机的位置和姿态。
[0021]所述步骤(31)中通过计算出所述绳状物水平方向分力与所述第二支段之间的夹角，其中，F2为所述第二支段上的测力计的测量值，F3为所述第三支段上的测力计的测量值，β为所述第二支段与第三支段之间的夹角，θ为所述绳
状物水平方向分力与所述第二支段之间的夹角。
[0022]所述步骤(32)中通过计算出所述绳状物与所述第一支段之间的夹角，其中，F1为所述第一支段上的测力计的测量值，F2为所述第二支段上的测力计的测量值，F3为所述第三支段上的测力计的测量值，β为所述第二支段与第三支段之间的夹角，θ为所述绳状物水平方向分力与所述第二支段之间的夹角，α为所述绳状物与所述第一支段之间的夹角；F4为所述绳状物水平方向分力，F5为所述绳状物所受的力。
[0023]有益效果
[0024]由于采用了上述的技术方案，本专利技术与现有技术相比，具有以下的优点和积极效果：本专利技术在实施过程中，将绳状物一端与井口固定点相连，绳状物另一端分为三个支段，分别与掘进机上的三个固定点相连，并在三个支段上设置测力计，根据绳状物的受力平衡得到掘进机挖掘面上的点在掘进机坐标系上的坐标值，再根据掘进机挖掘面上的点的大地坐标上的坐标值和掘进机上的角度传感器即可得到掘进机的位置和姿态。由此可见，该方式操作简单，且不受环境限制，使用十分方便。
附图说明
[0025]图1是本专利技术的原理示意图。
具体实施方式
[0026]下面结合具体实施例，进一步阐述本专利技术。应理解，这些实施例仅用于说明本专利技术而不用于限制本专利技术的范围。此外应理解，在阅读了本专利技术讲授的内容之后，本领域技术人员可以对本专利技术作各种改动或修改，这些等价形式同样落于本申请所附权利要求书所限定的范围。
[0027]本专利技术的实施方式涉及一种竖井掘进位姿测量装置，如图1所示，包括：
[0028]绳状物1，所述绳状物1的一端固定于井口处的井口固定点A0，另一端分为第一支段11、第二支段12和第三支段13，其中，所述第一支段11与掘进机上的第一固定点C连接，所述第二支段12与掘进机上的第二固定本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种竖井掘进位姿测量装置，其特征在于，包括：绳状物，所述绳状物的一端固定于井口处的井口固定点，另一端分为第一支段、第二支段和第三支段，其中，所述第一支段与掘进机上的第一固定点连接，所述第二支段与掘进机上的第二固定点连接，所述第三支段与掘进机上的第三固定点连接；所述第二固定点和第三固定点与参考点均位于所述掘进机的水平面上，所述参考点为所述井口固定点向所述掘进机的水平面垂直投影的投影点，所述第一固定点位于所述掘进机的水平面下方，并在所述绳状物受力平衡时能够使得所述第一支段与所述掘进机的水平面垂直；测力计，设置在所述第一支段、第二支段和第三支段上；角度传感器，设置在所述掘进机上；计算模块，用于根据所述测力计的检测值计算出所述参考点在掘进机坐标系中的坐标值，再结合所述角度传感器的检测值以及所述参考点在大地坐标系中的坐标值得到所述掘进机的位置和姿态。2.根据权利要求1所述的竖井掘进位姿测量装置，其特征在于，所述计算模块包括：第一角度计算单元，用于根据所述第二支段和第三支段上的测力计的测量值以及第二支段与第三支段之间的夹角计算出所述绳状物水平方向分力与所述第二支段之间的夹角；第二角度计算单元，用于根据所述第一支段、第二支段和第三支段上的测力计的测量值以及第二支段与第三支段之间的夹角计算出所述绳状物与所述第一支段之间的夹角；掘进机坐标计算单元，用于根据所述绳状物水平方向分力与所述第二支段之间的夹角、所述绳状物与所述第一支段之间的夹角以及所述绳状物的长度计算所述参考点在掘进机坐标系上的坐标值；位姿计算单元，用于根据所述参考点在掘进机坐标系上的坐标值、所述参考点在大地坐标系上的坐标值以及所述角度传感器的检测值计算掘进机的位置和姿态。3.根据权利要求2所述的竖井掘进位姿测量装置，其特征在于，所述第一角度计算单元通过计算出所述绳状物水平方向分力与所述第二支段之间的夹角，其中，F2为所述第二支段上的测力计的测量值，F3为所述第三支段上的测力计的测量值，β为所述第二支段与第三支段之间的夹角，θ为所述绳状物水平方向分力与所述第二支段之间的夹角。4.根据权利要求2所述的竖井掘进位姿测量装置，其特征在于，所述第二角度计算单元通过计算出所述绳状物与所述第一支段之间的夹角，其中，F1为所述第一支段上的测力计的测量值，F2为所述第二支段上的测力计的测量值，F3为所述第三支段上的测力计的测量值，β为所述第二支段与第三支段之间的夹角，θ为所述绳状物水平方向分力与所述第二支段之间的夹角，...
【专利技术属性】
技术研发人员：林海荣，吴小燕，汪慧琴，刘超，朱涛，覃旭，胡倩，
申请(专利权)人：上海米度测量技术有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。