CN111119919A - 一种柔臂掘进机推进系统控制计算方法 - Google Patents
一种柔臂掘进机推进系统控制计算方法 Download PDFInfo
- Publication number
- CN111119919A CN111119919A CN201911394896.5A CN201911394896A CN111119919A CN 111119919 A CN111119919 A CN 111119919A CN 201911394896 A CN201911394896 A CN 201911394896A CN 111119919 A CN111119919 A CN 111119919A
- Authority
- CN
- China
- Prior art keywords
- oil cylinder
- platform
- parallel
- static
- arm
- 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
- 238000004364 calculation method Methods 0.000 title claims abstract description 14
- 230000003068 static effect Effects 0.000 claims abstract description 65
- 230000005641 tunneling Effects 0.000 claims abstract description 12
- 238000000034 method Methods 0.000 claims abstract description 9
- 238000009412 basement excavation Methods 0.000 claims abstract description 7
- 238000006073 displacement reaction Methods 0.000 claims abstract description 5
- 239000013598 vector Substances 0.000 claims description 14
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000011426 transformation method Methods 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims description 3
- 230000009471 action Effects 0.000 abstract description 2
- 238000005070 sampling Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 239000011435 rock Substances 0.000 description 2
- 230000001680 brushing effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21D—SHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
- E21D9/00—Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
- E21D9/10—Making by using boring or cutting machines
- E21D9/108—Remote control specially adapted for machines for driving tunnels or galleries
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21D—SHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
- E21D9/00—Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
- E21D9/10—Making by using boring or cutting machines
- E21D9/1006—Making by using boring or cutting machines with rotary cutting tools
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21D—SHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
- E21D9/00—Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
- E21D9/10—Making by using boring or cutting machines
- E21D9/1093—Devices for supporting, advancing or orientating the machine or the tool-carrier
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Environmental & Geological Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geochemistry & Mineralogy (AREA)
- Geology (AREA)
- Excavating Of Shafts Or Tunnels (AREA)
Abstract
本发明公开了一种柔臂掘进机推进系统控制计算方法,包括如下步骤:S1:根据预先设计的隧道轮廓边界和刀盘直径,规划出刀盘掘进路径;S2:对步骤S1中规划出的刀盘掘进路径以高频采样和直线拟合法进行离散化处理,得到轨迹路径坐标数据及刀盘中心坐标;S3:对并联油缸臂的动平台和静平台分别建立坐标系,根据步骤S2中得到的轨迹路径坐标数据及刀盘中心坐标,计算出并联油缸臂油缸的理论伸缩量;S4:对并联油缸臂油缸的理论伸缩量与并联油缸臂油缸中的位移传感器实测的实际伸缩量进行对比,进行修正。本发明为控制并联油缸臂的动作,提供可靠保证,提高控制精度,对柔臂掘进机的高效、精确开挖提供保障,具有较高推广价值。
Description
技术领域
本发明涉及柔臂掘进机技术领域,特别是指一种柔臂掘进机推进系统控制计算方法。
背景技术
并联柔臂掘进机采用六自由度并联机器人实时控制刀盘位置,同时刀盘随着主轴承的回转进行破岩,实现以小直径刀盘开挖任意形状断面的目的,能够有效解决特殊硬岩隧道施工中的问题。但以小直径刀盘开挖大断面隧道可能出现超挖、欠挖、人工控制难度大以及如何最大程度增加系统工作效率等问题,同时施工方对隧道信息化需求明显增加,因此需要对柔臂掘进机的控制方式进行改进,以实现轨迹自动规划、自动刷帮、根据地质条件选择最优掘进工艺、提高隧道边界成型质量、为业主提供施工数据等一些列功能。但是现有柔臂掘进机在并联油缸臂控制方面的设计精度低、误差大,过程繁琐;使柔臂掘进机施工的自动化、少人化低。因此,研制简便的一种柔臂掘进机推进系统控制计算方法很有必要。
发明内容
针对上述背景技术中的不足,本发明提出一种柔臂掘进机推进系统控制计算方法,以解决上述技术问题。
本发明的技术方案是这样实现的:一种柔臂掘进机推进系统控制计算方法,包括如下步骤:
S1:根据预先设计的隧道轮廓边界和刀盘直径,规划出刀盘掘进路径;
S2:对步骤S1中规划出的刀盘掘进路径进行离散化处理,得到轨迹路径坐标数据及刀盘中心坐标;
S3:对并联油缸臂的动平台和静平台分别建立坐标系,根据步骤S2中得到的轨迹路径坐标数据及刀盘中心坐标,计算出并联油缸臂油缸的理论伸缩量Si;
S4:对并联油缸臂油缸的理论伸缩量Si与并联油缸臂油缸中的位移传感器实测的实际伸缩量进行对比,理论伸缩量Si与实际伸缩量的差值超出误差值时,要对并联油缸臂油缸实际伸缩量进行修正,使刀盘按照预定轨迹进行开挖。
在步骤S3中计算并联油缸臂油缸的理论伸缩量Si的步骤如下:
S3.3在静平台和动平台上分别建立静坐标系和动坐标系;
其中:变换矩阵T为:
式中:CΨx=cos(Ψx),SΨx=sin(Ψx);
S3.6根据并联油缸臂的静平台的半径R及
算出第i个油缸(i=1、2、3、4、5、6)在动平台上的铰接点Pi的坐标及在静平台上的铰接点Bi的坐标;
S3.7设第i个油缸(i=1、2、3、4、5、6)的驱动器杆长为li,则li在固定坐标系中的表示为:
在步骤S3.3中静坐标系XYZ的原点O位于静平台的中心,X-Y平面与并联油缸臂油缸在静平台上铰接点的分布圆共面;动坐标系X′Y′Z′的原点O'位于动平台的中心,当静平台位于初始位时,动坐标系的Z′与静坐标系的Z轴重合,且静坐标系Z轴穿过O'。
所述并联油缸臂包括静平台和动平台,静平台通过主轴承与主梁系统转动连接,动平台通过6个并联的油缸与静平台相连接,静平台上设有刀盘。
本发明通过简单有效的计算方法将并联油缸臂的6个并联油缸的理论伸缩量与位移传感器测得的实际伸缩量进行对比,根据误差量随时对6个并联油缸进行调整,完成刀盘开挖路径的修正,保证盾构刀盘按设计路线进行轮廓开挖。本发明为控制并联油缸臂的动作,提供可靠保证,提高控制精度,对柔臂掘进机的高效、精确开挖提供保障,具有较高推广价值。
附图说明
为了更清楚地说明本发明实施例,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明控制计算流程图。
图2为本发明并联油缸臂结构示意图。
图3为在动平台和静平台建立坐标系示意图。
图4为静平台xy平面坐标系中转角几何关系图。
图5为动坐标系、静坐标系矢量关系示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例1,如图2所示,一种柔臂掘进机推进系统控制计算方法,所述并联油缸臂包括静平台3和动平台4,处于初始位置时,静平台3和动平台4平行设置,静平台3的中心与动平台4的中心位于同一直线上,静平台3通过主轴承5与主梁系统转动连接,动平台4通过6个并联的油缸2与静平台3相连接,静平台3上设有刀盘1。刀盘1中心的位置表示刀盘的位置。
并联油缸臂伸缩量控制计算方法包括如下步骤:如图1所示,
S1:根据预先设计的隧道轮廓边界和刀盘直径,隧道轮廓边界为事前图纸设计好的隧道边界,刀盘直径也确定,规划出刀盘掘进路径,即根据确定的隧道边界和刀盘直径,计算机规划出刀盘掘进路径,该路径为曲线;
S2:对步骤S1中规划出的刀盘掘进路径以高频采样和直线拟合法进行离散化处理,将隧道轮廓边界线离散成相应的位置点群,即得到离散化处理后的轨迹路径坐标数据;得到轨迹路径坐标数据及刀盘中心坐标o(x,y,z,Ψx,Ψy,Ψz),x,y,z,表示刀盘中心在xyz坐标系中的坐标;Ψx,Ψy,Ψz表示刀盘中心在xyz坐标系中相应角度;
S3:对并联油缸臂的动平台和静平台分别建立坐标系,根据步骤S2中得到的轨迹路径坐标数据及刀盘中心坐标o(x,y,z,Ψx,Ψy,Ψz),根据几何关系计算出并联油缸臂油缸的理论伸缩量Si;
S4:对并联油缸臂油缸的理论伸缩量Si与并联油缸臂油缸中的位移传感器实测的实际伸缩量进行对比,理论伸缩量Si与实际伸缩量的差值超出误差值时,要对并联油缸臂油缸实际伸缩量进行修正,使刀盘按照预定轨迹进行开挖。即在后台计算机中输入误差范围值,当理论伸缩量Si与实际伸缩量的差值与误差值进行对比,超出误差范围时,后台控制器控制并联油缸臂油缸的伸缩量以缩小理论伸缩量Si与实际伸缩量的差值,使差值位于误差范围内,达到修正油缸的目的。
实施例2,一种柔臂掘进机推进系统控制计算方法,在步骤S3中计算并联油缸臂油缸的理论伸缩量Si的步骤如下:
S3.2如图4所示,设并联油缸臂的静平台随柔臂掘进机主轴承在某一时刻转角为θ,并联油缸臂油缸在静平台上的铰接点坐标Bθ(x0,y0,z0)与转角θ的对应关系为:x0,y0,z0分别静平台转角为θ时,并联油缸臂油缸在静平台上的铰接点的坐标;
S3.3如图3所示,在静平台和动平台上分别建立静坐标系和动坐标系;静坐标系XYZ的原点O位于静平台的中心,X-Y平面与并联油缸臂油缸在静平台上铰接点的分布圆共面;动坐标系X′Y′Z′的原点O'位于动平台的中心,当静平台位于初始位时,动坐标系的Z′与静坐标系的Z轴重合,且静坐标系Z轴穿过O'。
其中:变换矩阵T为:
式中:CΨx=cos(Ψx),SΨx=sin(Ψx);
S3.6根据并联油缸臂的静平台的半径R及
算出第i个油缸(i=1、2、3、4、5、6)在动平台上的铰接点Pi的坐标及在静平台上的铰接点Bi的坐标;
S3.7设第i个油缸(i=1、2、3、4、5、6)的驱动器杆长为li,则li在固定坐标系中的表示为:
其他结构和方法与实施例1相同。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种柔臂掘进机推进系统控制计算方法,其特征在于:包括如下步骤:
S1:根据预先设计的隧道轮廓边界和刀盘直径,规划出刀盘掘进路径;
S2:对步骤S1中规划出的刀盘掘进路径进行离散化处理,得到轨迹路径坐标数据及刀盘中心坐标;
S3:对并联油缸臂的动平台和静平台分别建立坐标系,根据步骤S2中得到的轨迹路径坐标数据及刀盘中心坐标,计算出并联油缸臂油缸的理论伸缩量Si;
S4:对并联油缸臂油缸的理论伸缩量Si与并联油缸臂油缸中的位移传感器实测的实际伸缩量进行对比,理论伸缩量Si与实际伸缩量的差值超出误差值时,要对并联油缸臂油缸实际伸缩量进行修正,使刀盘按照预定轨迹进行开挖。
2.根据权利要求1所述的柔臂掘进机推进系统控制计算方法,其特征在于:在步骤S3中计算并联油缸臂油缸的理论伸缩量Si的步骤如下:
S3.2设并联油缸臂的静平台随柔臂掘进机主轴承在某一时刻转角为θ,并联油缸臂油缸在静平台上的铰接点坐标Bθ(x0,y0,z0)与转角θ的对应关系为:
S3.3在静平台和动平台上分别建立静坐标系和动坐标系;
S3.4设并联油缸臂的第i个油缸i=1、2、3、4、5、6在动平台上的铰接点为Pi,在静平台上的铰接点为Bi;
其中:变换矩阵T为:
式中:CΨx=cos(Ψx),SΨx=sin(Ψx);
S3.6根据并联油缸臂的静平台的半径R及
算出第i个油缸在动平台上的铰接点Pi的坐标及在静平台上的铰接点Bi的坐标;
S3.7设第i个油缸的驱动器杆长为li,则li在固定坐标系中的表示为:
3.根据权利要求2所述的柔臂掘进机推进系统控制计算方法,其特征在于:在步骤S3.3中静坐标系XYZ的原点O位于静平台的中心,X-Y平面与并联油缸臂油缸在静平台上铰接点的分布圆共面;动坐标系X′Y′Z′的原点O'位于动平台的中心,当静平台位于初始状态时,动坐标系的Z′与静坐标系的Z轴重合,且静坐标系Z轴穿过O'。
4.根据权利要求1或3所述的柔臂掘进机推进系统控制计算方法,其特征在于:所述并联油缸臂包括静平台(3)和动平台(4),静平台(3)通过主轴承(5)与主梁系统转动连接,动平台(4)通过6个并联的油缸(2)与静平台(3)相连接,静平台(3)上设有刀盘(1)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911394896.5A CN111119919B (zh) | 2019-12-30 | 2019-12-30 | 一种柔臂掘进机推进系统控制计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911394896.5A CN111119919B (zh) | 2019-12-30 | 2019-12-30 | 一种柔臂掘进机推进系统控制计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111119919A true CN111119919A (zh) | 2020-05-08 |
CN111119919B CN111119919B (zh) | 2021-06-18 |
Family
ID=70505075
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911394896.5A Active CN111119919B (zh) | 2019-12-30 | 2019-12-30 | 一种柔臂掘进机推进系统控制计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111119919B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0126047A2 (en) * | 1983-05-10 | 1984-11-21 | Atlas Copco Aktiebolag | Machine for boring non-circular tunnels |
DE19605514C1 (de) * | 1996-02-15 | 1997-05-15 | Wayss & Freytag Ag | Haltevorrichtung für ein Abbauwerkzeug in einer Vortriebsmaschine |
CN101811301A (zh) * | 2009-10-28 | 2010-08-25 | 北京航空航天大学 | 串并联机器人联合加工系统及其控制方法 |
CN102854838A (zh) * | 2012-08-29 | 2013-01-02 | 内蒙古北方重工业集团有限公司 | 掘进机巷道自适应截割系统及自适应遥控方法 |
CN108952742A (zh) * | 2018-07-30 | 2018-12-07 | 广州鑫唐夏信息科技有限公司 | 一种基于机器视觉的盾构机导向方法及系统 |
CN109356608A (zh) * | 2018-11-22 | 2019-02-19 | 山东新矿信息技术有限公司 | 一种掘进机、系统及方法 |
CN110454182A (zh) * | 2019-08-31 | 2019-11-15 | 中铁工程装备集团有限公司 | 一种全断面隧道掘进机换刀机器人视觉定位结构及方法 |
-
2019
- 2019-12-30 CN CN201911394896.5A patent/CN111119919B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0126047A2 (en) * | 1983-05-10 | 1984-11-21 | Atlas Copco Aktiebolag | Machine for boring non-circular tunnels |
DE19605514C1 (de) * | 1996-02-15 | 1997-05-15 | Wayss & Freytag Ag | Haltevorrichtung für ein Abbauwerkzeug in einer Vortriebsmaschine |
CN101811301A (zh) * | 2009-10-28 | 2010-08-25 | 北京航空航天大学 | 串并联机器人联合加工系统及其控制方法 |
CN102854838A (zh) * | 2012-08-29 | 2013-01-02 | 内蒙古北方重工业集团有限公司 | 掘进机巷道自适应截割系统及自适应遥控方法 |
CN108952742A (zh) * | 2018-07-30 | 2018-12-07 | 广州鑫唐夏信息科技有限公司 | 一种基于机器视觉的盾构机导向方法及系统 |
CN109356608A (zh) * | 2018-11-22 | 2019-02-19 | 山东新矿信息技术有限公司 | 一种掘进机、系统及方法 |
CN110454182A (zh) * | 2019-08-31 | 2019-11-15 | 中铁工程装备集团有限公司 | 一种全断面隧道掘进机换刀机器人视觉定位结构及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111119919B (zh) | 2021-06-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2446332B1 (en) | Determination of route for arranging automatic control of mobile mining machine | |
CN111946340B (zh) | 基于视觉导航的煤矿悬臂式掘进机截割控制方法及系统 | |
AU2008240564A1 (en) | Method of directing drilling pattern in curved tunnels, rock drilling rig, and software product | |
CN110455290B (zh) | 一种智能液压挖掘机的最优轨迹规划方法 | |
JPS60199194A (ja) | さく孔方法 | |
Wang et al. | A control method for hydraulic manipulators in automatic emulsion filling | |
CN113420403A (zh) | 一种液压支架与刮板输送机的推移机构运动规划方法 | |
CN113282053A (zh) | 一种悬臂式掘进机自动截割控制系统 | |
CN114193449B (zh) | 一种锚杆支护机器人工作臂轨迹规划方法 | |
CN111119919B (zh) | 一种柔臂掘进机推进系统控制计算方法 | |
CN111274696A (zh) | 一种实时获取凿岩台车双三角钻臂空间位置姿态的方法 | |
CN110188947B (zh) | 盾构纠偏中当前环目标预测方法及系统 | |
CN111005735B (zh) | 一种并联式柔臂tbm刀盘掘进控制方法 | |
CN117449874A (zh) | 一种隧道混凝土智能喷射控制方法及系统 | |
CN116408800A (zh) | 一种基于孔位坐标的锚杆台车自动定位方法 | |
CN115544768A (zh) | 一种自主挖掘作业轨迹生成方法及系统 | |
CN111075468B (zh) | 一种柔臂掘进机推进系统控制计算方法 | |
CN116641648A (zh) | 一种凿岩台车及其钻臂挠度补偿方法 | |
CN114893130B (zh) | 机械臂钻孔定位系统、方法、台车、触摸屏及存储介质 | |
CN114482160B (zh) | 作业控制方法、装置和作业机械 | |
CN114215537B (zh) | 掘进机截割臂伸缩控制方法及装置 | |
RU2800704C1 (ru) | Машина для инженерно-геологических работ и способ компенсации отклонения манипулятора указанной машины | |
RU2800704C9 (ru) | Машина для инженерно-геологических работ и способ компенсации отклонения манипулятора указанной машины | |
CN118361236A (zh) | 一种悬臂掘进机截割超欠挖控制系统及方法 | |
CN117386882A (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 |