CN113740859A - 一种适用于矿区装载设备的位置计算方法 - Google Patents
一种适用于矿区装载设备的位置计算方法 Download PDFInfo
- Publication number
- CN113740859A CN113740859A CN202110953099.7A CN202110953099A CN113740859A CN 113740859 A CN113740859 A CN 113740859A CN 202110953099 A CN202110953099 A CN 202110953099A CN 113740859 A CN113740859 A CN 113740859A
- Authority
- CN
- China
- Prior art keywords
- angle
- movable arm
- loading equipment
- bucket rod
- alpha
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/50—Systems of measurement, based on relative movement of the target
- G01S15/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
- G01S15/60—Velocity or trajectory determination systems; Sense-of-movement determination systems wherein the transmitter and receiver are mounted on the moving object, e.g. for determining ground speed, drift angle, ground track
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Component Parts Of Construction Machinery (AREA)
Abstract
本发明公开了一种适用于矿区装载设备的位置计算方法，包括获取装载设备本身的参数，由装载设备的说明书或实际测量得出主控制器与动臂的距离L1，动臂的长度L2以及斗杆的长度L3；在动臂和斗杆上安装角度传感器，角度传感器获取实时角度数据；根据步骤S2得到的数据计算得出测量点在参考点的坐标系的位置。通过本发明的技术方案，实时测量多个点的姿态信息，通过算法得出，被测点与参考点的相对位置，得到装载设备的位置信息。本发明为矿区装载设备的位置定位提供技术支撑，实现了矿区无人驾驶和智能装载的联合应用的落地。
Description
技术领域
本发明属于无人机驾驶技术领域，尤其涉及一种适用于矿区装在设备的位置计算方法。
背景技术
随着自动驾驶技术的不断发展，矿区无人驾驶车辆的普及，但是目前在自动驾驶领域，对于矿用配套车辆与矿用车辆协同作业，没有大量的研究和应用，例如电铲、挖机等。升级和改造矿用装载设备，是提升矿区无人驾驶和矿区协同作业的重要方向。目前，矿用设备定位信息不高，是导致效率底下，甚至人员伤亡的重要原因。因此，装载设备的位置计算的研究，将极大地减少复杂作业环境导致的人员伤亡，也提高了矿用车运行效率和综合效益。
装载设备的位置计算是根据当前设备的姿态信息，通过角度传感的数据和设备的本身参数，通过算法计算出被测点与参考点的相对位置，进而得出装载设备的位置参数。目前，主要定位方法有多种一般使用测距法，红外传感器和超声传感器，缺点：第一不能适应复杂的工作环境，例如高温环境，灰尘浓度等，干扰红外传感器的精确度；大角度时红外传感器和超声传感器失灵。第二，上述方法只能解决被测点与参考点的距离信息，无法得到其矢量信息。
发明内容
本发明为了解决矿区决装载设备的位置信息，解决装载设备和运载车辆的协同问题，提出一种适用于矿区装在设备的位置计算方法，实时测量多个点的姿态信息，通过算法得出，被测点与参考点的相对位置，得到装载设备的位置信息。
本发明的具体技术方案如下：
一种适用于矿区装载设备的位置计算方法，包括以下步骤：
S1：获取装载设备本身的参数，由装载设备的说明书或实际测量得出主控制器与动臂的距离L1，动臂的长度L2以及斗杆的长度L3；
S2：在动臂和斗杆上安装角度传感器，角度传感器获取实时角度数据；
S3：根据步骤S2得到的数据计算得出测量点在参考点的坐标系的位置。
进一步地，所述步骤S3的具体过程为：
S3-1：主控制器初始化，复位动臂和斗杆的位置，初始化角度传感器，记录初始状态；
S3-2：动臂和斗杆的状态发生变化，随之化角度传感器测得的角度数据发生变化；
动臂和斗杆之间的夹角为α，动臂上的角度传感器的角度数据与垂直方向夹角为α1；斗杆上的角度传感器的角度数据与是垂直方向夹角为α2，与水平方向夹角为β1；其中，α＝α1+α2；测量点到动臂转转点的距离为L4；动臂和L4的夹角为β；
S3-3：根据L2、L3和α计算L4：
S3-4：得出L4，计算出角度β：
S3-5：计算得出β2＝β-β1；即可得出：
L4在水平方向的分量L4X＝L4 cosβ2；
L4在竖直方向的分量L4Y＝L4 sinβ2；
S3-6：得出以参考点为原点，测量点的相对坐标系为(L4X，L4y，L1)。
进一步地，所述装载设备为2个自由度的铲车或者挖机。
本发明的有益效果在于：
1.本发明提高了装载设备的智能化程度，降低的人身事故风险，降低了用人成本；
2.本发明对于车辆的控制更合理精确，降低了车辆的维护成本，提上了车辆的使用寿命；
3.本发明的无人驾驶可连续作业的时间更长，提高了生产效率，为多种设备的协同作业提供支持。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，通过参考附图会更加清楚的理解本发明的特征和优点，附图是示意性的而不应理解为对本发明进行任何限制，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，可以根据这些附图获得其他的附图。其中：
图1是本发明的流程图；
图2是初始化之后测量点与参考点的位置关系；
图3是测量点位置发生偏移之后各个参数的变化，主要是角度值的变化。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点，下面结合附图和具体实施方式对本发明进行进一步的详细描述。需要说明的是，在不冲突的情况下，本发明的实施例及实施例中的特征可以相互组合。
在下面的描述中阐述了很多具体细节以便于充分理解本发明，但是，本发明还可以采用其他不同于在此描述的其他方式来实施，因此，本发明的保护范围并不受下面公开的具体实施例的限制。
如图1所示，一种适用于矿区装载设备的位置计算方法，包括以下步骤：
S1：获取装载设备本身的参数，由装载设备的说明书或实际测量得出主控制器与动臂的距离L1，动臂的长度L2以及斗杆的长度L3；
S2：在动臂和斗杆上安装角度传感器，角度传感器获取实时角度数据；整个斗杆上都可以安装传感器，一般根据实际情况会放在斗杆中心；
S3：根据步骤S2得到的数据计算得出测量点在参考点的坐标系的位置。
在一些实施方式中，步骤S3的具体过程为：
S3-1：主控制器初始化，复位动臂和斗杆的位置，初始化角度传感器，记录初始状态；
S3-2：动臂和斗杆的状态发生变化，随之化角度传感器测得的角度数据发生变化；
动臂和斗杆之间的夹角为α，动臂上的角度传感器的角度数据与垂直方向夹角为α1；斗杆上的角度传感器的角度数据与是垂直方向夹角为α2，与水平方向夹角为β1；其中，α＝α1+α2；测量点到动臂转转点的距离为L4；动臂和L4的夹角为β；
S3-3：根据L2、L3和α计算L4：
S3-4：得出L4，计算出角度β：
S3-5：计算得出β2＝β-β1；即可得出：
L4在水平方向的分量L4X＝L4 cosβ2；
L4在竖直方向的分量L4Y＝L4 sinβ2；
S3-6：得出以参考点为原点，测量点的相对坐标系为(L4X，L4y，L1)。
在一些实施方式中，装载设备为2个自由度的铲车或者挖机。
以上所述仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (3)
1.一种适用于矿区装载设备的位置计算方法，其特征在于，包括以下步骤：
S1：获取装载设备本身的参数，由装载设备的说明书或实际测量得出主控制器与动臂的距离L1，动臂的长度L2以及斗杆的长度L3；
S2：在动臂和斗杆上安装角度传感器，角度传感器获取实时角度数据；
S3：根据步骤S2得到的数据计算得出测量点在参考点的坐标系的位置。
2.根据权利要求1所述的一种适用于矿区装载设备的位置计算方法，其特征在于，所述步骤S3的具体过程为：
S3-1：主控制器初始化，复位动臂和斗杆的位置，初始化角度传感器，记录初始状态；
S3-2：动臂和斗杆的状态发生变化，随之化角度传感器测得的角度数据发生变化；
动臂和斗杆之间的夹角为α，动臂上的角度传感器的角度数据与垂直方向夹角为α1；斗杆上的角度传感器的角度数据与是垂直方向夹角为α2，与水平方向夹角为β1；其中，α＝α1+α2；测量点到动臂转转点的距离为L4；动臂和L4的夹角为β；
S3-3：根据L2、L3和α计算L4：
S3-4：得出L4，计算出角度β：
S3-5：计算得出β2＝β-β1；即可得出：
L4在水平方向的分量L4X＝L4 cosβ2；
L4在竖直方向的分量L4Y＝L4 sinβ2；
S3-6：得出以参考点为原点，测量点的相对坐标系为(L4X，L4y，L1)。
3.根据权利要求1所述的一种适用于矿区装载设备的位置计算方法，其特征在于，所述装载设备为2个自由度的铲车或者挖机。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110953099.7A CN113740859A (zh) | 2021-08-19 | 2021-08-19 | 一种适用于矿区装载设备的位置计算方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110953099.7A CN113740859A (zh) | 2021-08-19 | 2021-08-19 | 一种适用于矿区装载设备的位置计算方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN113740859A true CN113740859A (zh) | 2021-12-03 |
Family
ID=78731787
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110953099.7A Pending CN113740859A (zh) | 2021-08-19 | 2021-08-19 | 一种适用于矿区装载设备的位置计算方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113740859A (zh) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000336690A (ja) * | 1999-06-01 | 2000-12-05 | Hitachi Constr Mach Co Ltd | 建設機械の領域制限掘削制御装置 |
| CN102607511A (zh) * | 2012-02-28 | 2012-07-25 | 天津二十冶建设有限公司 | 采用余弦定理解三角形法进行工程测量的方法 |
| KR101787897B1 (ko) * | 2016-05-31 | 2017-10-19 | 인하대학교 산학협력단 | Ａｖｍ 기반의 굴삭기 작업 정보 모니터링 장치 및 그 방법 |
| US20180171597A1 (en) * | 2016-12-21 | 2018-06-21 | Caterpillar Trimble Control Technologies Llc | Excavator Linkage Angle Determination Using A Laser Distance Meter |
| CN109444936A (zh) * | 2018-10-18 | 2019-03-08 | 南京天辰礼达电子科技有限公司 | 一种利用gnss和倾角传感器确定斗尖坐标的方法 |
| CN109496245A (zh) * | 2017-07-13 | 2019-03-19 | 株式会社小松制作所 | 液压挖掘机以及液压挖掘机的校正方法 |
| CN112095710A (zh) * | 2020-09-16 | 2020-12-18 | 上海三一重机股份有限公司 | 挖掘机位姿显示方法、装置及其所应用的挖掘机 |
-
2021
- 2021-08-19 CN CN202110953099.7A patent/CN113740859A/zh active Pending
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000336690A (ja) * | 1999-06-01 | 2000-12-05 | Hitachi Constr Mach Co Ltd | 建設機械の領域制限掘削制御装置 |
| CN102607511A (zh) * | 2012-02-28 | 2012-07-25 | 天津二十冶建设有限公司 | 采用余弦定理解三角形法进行工程测量的方法 |
| KR101787897B1 (ko) * | 2016-05-31 | 2017-10-19 | 인하대학교 산학협력단 | Ａｖｍ 기반의 굴삭기 작업 정보 모니터링 장치 및 그 방법 |
| US20180171597A1 (en) * | 2016-12-21 | 2018-06-21 | Caterpillar Trimble Control Technologies Llc | Excavator Linkage Angle Determination Using A Laser Distance Meter |
| CN109496245A (zh) * | 2017-07-13 | 2019-03-19 | 株式会社小松制作所 | 液压挖掘机以及液压挖掘机的校正方法 |
| CN109444936A (zh) * | 2018-10-18 | 2019-03-08 | 南京天辰礼达电子科技有限公司 | 一种利用gnss和倾角传感器确定斗尖坐标的方法 |
| CN112095710A (zh) * | 2020-09-16 | 2020-12-18 | 上海三一重机股份有限公司 | 挖掘机位姿显示方法、装置及其所应用的挖掘机 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107002384B (zh) | 作业机械的控制系统及作业机械的控制方法 | |
| CN109160419B (zh) | 一种建筑施工塔吊机群防碰撞中央处理装置 | |
| WO2013006625A2 (en) | Crane maneuvering assistance | |
| CN109115173A (zh) | 基于直线定位模型的掘进机机身位姿单目视觉测量方法 | |
| CN112537661B (zh) | 一种堆取料机防碰撞控制方法及系统 | |
| CN111485879B (zh) | 一种掘进机车体及其截割滚筒的定位方法及定位系统 | |
| CN106327044A (zh) | 车载钢卷及车辆鞍座自动识别和定位装置及其方法 | |
| US20220245856A1 (en) | Position identification system for construction machinery | |
| CN111781113A (zh) | 一种粉尘网格化定位方法及粉尘网格化监测方法 | |
| CN102995673B (zh) | 一种拉绳定位控制方法、装置及系统 | |
| CN114045893A (zh) | 挖掘机铲斗齿尖定位方法、装置和挖掘机 | |
| CN113340305A (zh) | 一种基于mems的液压支架姿态监测方法 | |
| CN116734757A (zh) | 基于无人机机载激光扫描仪的隧道围岩变形监测预警方法 | |
| CN207263131U (zh) | 一种悬臂式掘进机截割臂姿态非接触测量装置 | |
| CN113740859A (zh) | 一种适用于矿区装载设备的位置计算方法 | |
| CN113601505A (zh) | 一种多功能安装台车智能控制方法及系统 | |
| EP3896390A1 (en) | Ground surface estimation method, measurement region display system, and crane | |
| CN116704019A (zh) | 一种基于锚杆网络的钻锚机器人单目视觉定位方法 | |
| CN111372044A (zh) | 一种采空区输电线路巡视系统、方法和装置 | |
| CN115239879A (zh) | 盾构隧道监测方法及监测系统 | |
| CN114179851B (zh) | 一种铁路设备限界检测装置及方法 | |
| JP7188196B2 (ja) | 作業車両及び作業車両の位置検出方法 | |
| CN115492612B (zh) | 一种非运营隧道加固方法及设备 | |
| CN117780346B (zh) | 基于3d可视化模型的远程煤机控制方法 | |
| CN116335726B (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 |