一种隧道无轨自行式变质量平台车的重心位置动态计算方法技术

本发明专利技术公开了一种隧道无轨自行式变质量平台车的重心位置动态计算方法，主要包括：建立坐标系I、获取平台车重心G在坐标系I下的偏移量，建立力矩平衡方程、获取平台车重心G在坐标系I下的初始位置坐标、建立坐标系Ⅱ，获取平台车重心G在坐标系Ⅱ下的位置坐标(x”，y”，z”)和获取平台车重心G在姿态变化后的重心坐标，完成对平台车重心G的实时监测等几个步骤，采用力矩平衡方程得到平台车重心相对其中轴线的偏移量，由三维软件建模仿真并计算获得重心高度，即得到平台车重心相对于隧道中心的坐标；最后使用空间三维坐标转换矩阵，获得平台车在姿态变化之后的重心坐标，实现对平台车重心的实时监测，精确到高，成本低。

A dynamic calculation method of the center of gravity position of the trackless self-propelled variable mass platform car in tunnel

【技术实现步骤摘要】
一种隧道无轨自行式变质量平台车的重心位置动态计算方法
本专利技术涉及隧道施工
，具体涉及一种隧道无轨自行式变质量平台车的重心位置动态计算方法。
技术介绍
目前，国内外测定车辆重心位置的方法主要有5种：摇摆法、悬挂法、零位法、平台支撑反力法和质量反应法。其中：摇摆法所需设备复杂，局限性很大；悬挂法通常难于实现，尤其大型车辆，因难以选择适合悬挂整车质量的悬挂点，而且悬挂后变形很大，测量精度不能保证；零位法和平台支撑反力法需用专用设备，投资较大，普及率较低；质量反应法所需测试设备少，虽易于实现，但受零部件变形、配合间隙变化等影响，测量精度不高。上述方法都属于静态测定方法，要求车辆静止于测量平台上，监测车辆静止状态下的重心位置，而隧道施工领域的无轨自行式平台车，运行在圆形隧道的管片上，操作工人携带检测、维修工具和施工材料等在平台车上作业，由于工人数量、位置以及施工材料的重量在改变，整车的质量和重心也随之变化。平台车在圆形隧道管片上，重心偏移会导致平台车在行驶过程中姿态发生变化，影响施工安全，因此急需一种重心计算方法实现对圆形隧道内无轨自行式变质量平台车重心位置的动态监测，为地铁隧道平台车重心调节提供依据。
技术实现思路
本专利技术的目的在于提供一种隧道无轨自行式变质量平台车的重心位置动态计算方法，能实现对圆形隧道变质量平台车动态重心位置的实时监测，以解决现有缺乏对圆形隧道变质量平台车动态重心位置实时监控的问题。本专利技术的目的是通过以下技术方案来实现的：一种隧道无轨自行式变质量平台车的重心位置动态计算方法，包括以下几个步骤：S1、建立坐标系I，以平台车底面中心O’为原点，宽度方向为X’轴，长度方向为Y’轴，高度方向为Z’轴建立坐标系I；S2、获取平台车重心G在坐标系I下的偏移量，建立力矩平衡方程，得到平台车重心G相对平台车中轴线的偏移量；S3、获取平台车重心G在坐标系I下的初始位置坐标，根据所述偏移量建模得到初始位置坐标(x’，y’，z’)；S4、建立坐标系Ⅱ，以隧道圆心O为原点，隧道水平方向为X轴，隧道轴线方向为Y轴，隧道竖直方向为Z轴建立坐标系Ⅱ，获取平台车重心G在坐标系Ⅱ下的位置坐标(x”，y”，z”)；S5、获取平台车重心G在姿态变化后的重心坐标，测量平台车姿态变化时的俯仰角β，横滚角α和航向角γ，建立空间三维坐标转换矩阵，获取平台车重心G在坐标系Ⅱ下的重心坐标(x，y，z)，完成对平台车重心G的实时监测。进一步地，所述步骤S2中，获取平台车重心G的偏移量的分步骤包括：S210、测量平台车重心G距离平台车的支腿A、支腿B、支腿C和支腿D的垂直距离分别为L1，L2，W1和W2，重心G离平台车底面高度为ΔH；S220、在四条支腿上安装压力传感器，所述压力传感器获得各支腿的实时支反力Fa0、Fb0、Fc0和Fd0，建立力矩平衡方程：其中，L为平台车的长，W为平台车的宽，求解方程组可得：其中，L1，L2，W1和W2即为平台车重心G在坐标系I下X’轴和Y’轴方向的偏移量。进一步地，所述步骤S3中，获取平台车重心G的初始位置坐标(x’，y’，z’)，具体包括：通过在Solidworks中建模，测算获得平台车重心高度ΔH，在坐标系Ⅰ下，G点初始位置(x’，y’，z’)为：进一步地，所述步骤S4中，获取所述平台车重心G在坐标系Ⅱ下的位置坐标(x”，y”，z”)，具体为：进一步地，所述步骤S5中，所述俯仰角β和横滚角α由安装于平台车车身顶端的倾角传感器测得，所述航向角γ由安装在平台车前后两端面的一维激光雷达测得。进一步地，获取平台车中心G在坐标系Ⅱ下姿态变化后重心坐标(x，y，z)的步骤为：S510、平台车相对于隧道圆心O，沿X轴方向旋转β角，沿Y轴旋转α角，绕Z轴旋转γ角，旋转顺序为X-Y-Z；S520、建立坐标变换矩阵：转换得到最终坐标变换矩阵：S530、获得旋转后平台车重心G在坐标系Ⅱ下的最终坐标(x，y，z)：其中，矩阵上标T表示转置；S540、实时监测平台车重心G的位置变化，比较平台车姿态变化后按照步骤S1～S4得到的平台车重心G坐标系Ⅱ下的位置坐标和最终坐标(x，y，z)实现监测。本专利技术的有益效果是：1)本专利技术的隧道无轨自行式变质量平台车的重心位置动态计算方法，通过建立合理的力矩平衡方程和坐标变换矩阵来实现数据的逻辑计算，最后得到计算结构精度高的平台中心位置坐标，不受主观性因素影响，具有低成本、高精度及实时性好的特点。2)本专利技术的重心位置动态计算方法的只需压力传感器、一维激光雷达、倾角传感器结合建模的数据逻辑计算即可实现动态计算，具有成本低的优点，便于大规模推广。3)本专利技术结合由倾角传感器测得的隧道内车辆姿态角，将实时测量计算得到的车辆坐标系下的重心坐标转换成隧道坐标系下的重心坐标，解决了车辆在圆形隧道内行走且重心不确定时车辆重心位置实时测量的问题，本专利技术方法能对在圆形隧道内行走的车辆的重心位置实现有效地监控，以防止车辆倾翻，应用本专利技术的方法能提高车辆行走的安全性，彻底解决了车辆在圆形隧道内行走且重心不确定条件下的车辆重心位置实时测量的问题。附图说明图1为本专利技术的平台车的整体结构示意图；图2为本专利技术平台车重心分析简化模型示意图；图3为本专利技术在坐标系I下，平台车重心G在平面X’-Y’的位置示意图；图4为本专利技术在坐标系I下，平台车重心G在平面Y’-Z’的位置示意图；图5为本专利技术在坐标系I下，平台车重心G在平面X’-Z’的位置示意图；图6为本专利技术的重心位置动态计算方法的流图框图；图中，1-压力传感器，2-一维激光雷达，3-倾角传感器，4-行走机构，5-平台车主结构。具体实施方式下面将结合实施例，对本专利技术的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域技术人员在没有付出创造性劳动的前提下所获得的所有其他实施例，都属于本专利技术保护的范围。实施例1本专利技术提供一种技术方案：请参照图1-6，一种隧道无轨自行式变质量平台车的重心位置动态计算方法，包括以下几个步骤：S1、建立坐标系I，以平台车底面中心O’为原点，宽度方向为X’轴，长度方向为Y’轴，高度方向为Z’轴建立坐标系I；S2、获取平台车重心G在坐标系I下的偏移量，建立力矩平衡方程，得到平台车重心G相对平台车中轴线的偏移量；S3、获取平台车重心G在坐标系I下的初始位置坐标，根据所述偏移量建模得到初始位置坐标(x’，y’，z’)；S4、建立坐标系Ⅱ，以隧道圆心O为原点，隧道水平方向为X轴，隧道轴线方向为Y轴，隧道竖直方向为Z轴建立坐标系Ⅱ，获取平台车重心G在坐标本文档来自技高网...

【技术保护点】
1.一种隧道无轨自行式变质量平台车的重心位置动态计算方法，其特征在于，包括以下几个步骤：/nS1、建立坐标系I，以平台车底面中心O’为原点，宽度方向为X’轴，长度方向为Y’轴，高度方向为Z’轴建立坐标系I；/nS2、获取平台车重心G在坐标系I下的偏移量，建立力矩平衡方程，得到平台车重心G相对平台车中轴线的偏移量；/nS3、获取平台车重心G在坐标系I下的初始位置坐标，根据所述偏移量建模得到初始位置坐标(x’，y’，z’)；/nS4、建立坐标系Ⅱ，以隧道圆心O为原点，隧道水平方向为X轴，隧道轴线方向为Y轴，隧道竖直方向为Z轴建立坐标系Ⅱ，获取平台车重心G在坐标系Ⅱ下的位置坐标(x”，y”，z”)；/nS5、获取平台车重心G在姿态变化后的重心坐标，测量平台车姿态变化时的俯仰角β，横滚角α和航向角γ，建立空间三维坐标转换矩阵，获取平台车重心G在坐标系Ⅱ下的重心坐标(x，y，z)，完成对平台车重心G的实时监测。/n

【技术特征摘要】
1.一种隧道无轨自行式变质量平台车的重心位置动态计算方法，其特征在于，包括以下几个步骤：
S1、建立坐标系I，以平台车底面中心O’为原点，宽度方向为X’轴，长度方向为Y’轴，高度方向为Z’轴建立坐标系I；
S2、获取平台车重心G在坐标系I下的偏移量，建立力矩平衡方程，得到平台车重心G相对平台车中轴线的偏移量；
S3、获取平台车重心G在坐标系I下的初始位置坐标，根据所述偏移量建模得到初始位置坐标(x’，y’，z’)；
S4、建立坐标系Ⅱ，以隧道圆心O为原点，隧道水平方向为X轴，隧道轴线方向为Y轴，隧道竖直方向为Z轴建立坐标系Ⅱ，获取平台车重心G在坐标系Ⅱ下的位置坐标(x”，y”，z”)；
S5、获取平台车重心G在姿态变化后的重心坐标，测量平台车姿态变化时的俯仰角β，横滚角α和航向角γ，建立空间三维坐标转换矩阵，获取平台车重心G在坐标系Ⅱ下的重心坐标(x，y，z)，完成对平台车重心G的实时监测。


2.根据权利要求1所述的隧道无轨自行式变质量平台车的重心位置动态计算方法，其特征在于：所述步骤S2中，获取平台车重心G的偏移量的分步骤包括：
S210、测量平台车重心G距离平台车的支腿A、支腿B、支腿C和支腿D的垂直距离分别为L1，L2，W1和W2，重心G离平台车底面高度为ΔH；
S220、在四条支腿上安装压力传感器(1)，所述压力传感器(1)获得各支腿的实时支反力Fa0、Fb0、Fc0和Fd0，建立力矩平衡方程：



其中，L为平台车的长，W为平台车的宽，求解方程组可得：












其中，L1，L2，W1和W2即为平台车重心G在坐标系I下X’轴和...

【专利技术属性】
技术研发人员：陈旭，彭卫平，饶平，郭伟，张建辉，贾丁，芮庚豪，张文，陈勇，
申请(专利权)人：中国水利水电第七工程局有限公司，武汉大学，
类型：发明
国别省市：四川;51