EP3607165A1 - Apparatus and method for controlling boom of mine vehicle - Google Patents
Apparatus and method for controlling boom of mine vehicleInfo
- Publication number
- EP3607165A1 EP3607165A1 EP18712913.5A EP18712913A EP3607165A1 EP 3607165 A1 EP3607165 A1 EP 3607165A1 EP 18712913 A EP18712913 A EP 18712913A EP 3607165 A1 EP3607165 A1 EP 3607165A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- boom
- collision
- data
- server
- pose
- 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
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000004590 computer program Methods 0.000 claims abstract description 6
- 238000005553 drilling Methods 0.000 claims description 53
- 239000011435 rock Substances 0.000 claims description 24
- 230000004044 response Effects 0.000 claims description 7
- 238000001514 detection method Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000011960 computer-aided design Methods 0.000 claims description 2
- BULVZWIRKLYCBC-UHFFFAOYSA-N phorate Chemical compound CCOP(=S)(OCC)SCSCC BULVZWIRKLYCBC-UHFFFAOYSA-N 0.000 claims 1
- 239000003981 vehicle Substances 0.000 description 45
- 230000008569 process Effects 0.000 description 13
- 241000282414 Homo sapiens Species 0.000 description 8
- 238000013461 design Methods 0.000 description 8
- 238000005065 mining Methods 0.000 description 6
- 229920000136 polysorbate Polymers 0.000 description 5
- 238000004088 simulation Methods 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000003014 reinforcing effect Effects 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 241000282412 Homo Species 0.000 description 2
- 238000005576 amination reaction Methods 0.000 description 2
- 230000003449 preventive effect Effects 0.000 description 2
- 238000009423 ventilation Methods 0.000 description 2
- WWYNJERNGUHSAO-XUDSTZEESA-N (+)-Norgestrel Chemical compound O=C1CC[C@@H]2[C@H]3CC[C@](CC)([C@](CC4)(O)C#C)[C@@H]4[C@@H]3CCC2=C1 WWYNJERNGUHSAO-XUDSTZEESA-N 0.000 description 1
- 101150034533 ATIC gene Proteins 0.000 description 1
- 241000256844 Apis mellifera Species 0.000 description 1
- XUKUURHRXDUEBC-KAYWLYCHSA-N Atorvastatin Chemical compound C=1C=CC=CC=1C1=C(C=2C=CC(F)=CC=2)N(CC[C@@H](O)C[C@@H](O)CC(O)=O)C(C(C)C)=C1C(=O)NC1=CC=CC=C1 XUKUURHRXDUEBC-KAYWLYCHSA-N 0.000 description 1
- 241001282736 Oriens Species 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000009412 basement excavation Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 239000013256 coordination polymer Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- SDIXRDNYIMOKSG-UHFFFAOYSA-L disodium methyl arsenate Chemical compound [Na+].[Na+].C[As]([O-])([O-])=O SDIXRDNYIMOKSG-UHFFFAOYSA-L 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000001141 propulsive effect Effects 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 230000005641 tunneling Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B15/00—Supports for the drilling machine, e.g. derricks or masts
- E21B15/04—Supports for the drilling machine, e.g. derricks or masts specially adapted for directional drilling, e.g. slant hole rigs
- E21B15/045—Hydraulic, pneumatic or electric circuits for their positioning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B7/00—Special methods or apparatus for drilling
- E21B7/02—Drilling rigs characterised by means for land transport with their own drive, e.g. skid mounting or wheel mounting
- E21B7/022—Control of the drilling operation; Hydraulic or pneumatic means for activation or operation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39082—Collision, real time collision avoidance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39087—Artificial field potential algorithm, force repulsion from obstacle
Definitions
- the invention relates to an apparatus for control ⁇ ling booms of a mine vehicle.
- the invention further relates to a mine vehicle, a method of controlling booms of a mine vehicle and a computer program product .
- the field of the invention is defined more specif ⁇ ically in the preambles of the independent claims.
- the mine vehicles are provided with one or more booms and mine working tools at distal ends of the booms.
- the mine vehicle may be a rock drilling rig, a bolting or reinforcing vehicle, a measuring vehicle or any other mine vehicle, which is designed to execute a mine work task at the work site by means of the boom and the mine working tool.
- the mine work tool needs to be positioned to exact positions, which may be determined in a mine or drilling plan, for example.
- the boom comprises one or more boom parts and joints between them. Controlling of the boom in confined mine spaces is demanding and col ⁇ lisions between the boom and obstacles may exist. Therefore, collision avoidance systems are needed for the mine vehi ⁇ cles.
- the present systems have shown to contain some disadvantages.
- An object of the invention is to provide a novel and improved apparatus and method for controlling one or more booms of a mine vehicle.
- the invention further relates to a mine vehicle and a computer program product.
- the apparatus according to the invention is charac ⁇ terized by the characterizing features of a first independ ⁇ ent apparatus claim.
- the method according to the invention is character ⁇ ized by the charactering features and steps of an independ ⁇ ent method claim.
- An idea of the disclosed solution is that movements of one or more booms of a mine vehicle are controlled by means of one or more control units.
- the control unit is provided with one or more boom controllers for generating control signals for controlling boom actuators to move joints of the boom.
- the control unit is also configured to execute collision avoidance process for preventing the boom to collide. Measures of the collision avoidance are executed simultaneously during the control process, whereby no pre ⁇ planned movement paths are utilized. Instead, joint values of the boom may be defined continuously as the controlling of the boom proceeds.
- the collision avoidance measures are executed in one or more collision server of the at least one control unit.
- the collision server is configured to receive 3D ge ⁇ ometry data on at least two monitored physical objects, namely a first object and a second object. At least the first object is a boom part of the controlled boom and the second object may be another boom part of any other moni ⁇ tored physical object.
- the collision server is provided with data on current poses of the objects in the 3D coordinate system, whereby the collision server may calculate current poses of the respective 3D geometry data. Thereby, the col- lision server may calculate relative poses of the 3D geom ⁇ etry data of the monitored objects and is also able to determine the shortest distance between them.
- the calculated data on the shortest distance is utilized in the boom con ⁇ troller for calculating therein joint values by means of which a tool at the distal end of the boom can be moved towards a target pose without the selected first object of the boom colliding with the second physical object.
- the boom On the basis of the collision examination the boom may be kept away from the obstacles, and still, it may be moved effectively towards the target pose.
- the disclosed solution is designed for mine vehicle use and especially for rock drilling.
- mines circumstances and environment are challenging.
- Surroundings of the mine machines and their booms change continuously as excavation of the mine proceeds.
- mine work tasks performed by mining work devices of the booms are complicated operations in harsh conditions, whereby sudden and unexpected situa ⁇ tions occur.
- two or more simultaneously operating booms may be connected to a common movable carrier of the mine vehicle, whereby the booms need to operate close to each other and they often execute the same work plan too.
- the collision server may execute the on-line collision exami ⁇ nation during the controlling of the boom, whereby no pre- calculated routes or movement paths are needed.
- the collision server may monitor the movement of the boom continuously and may execute collision examination im ⁇ mediately when a need occurs.
- the collision server may compute collision data and create a collision free path to move around the detected object.
- the disclosed solution is applicable also for com ⁇ plicated structures and geometric shapes because in the disclosed solution the 3D geometric data of the physical objects are applied. Then exact points of collision of com ⁇ plex physical objects may be determined. The collision ex ⁇ amination is also accurate because 3D data of real shapes of the objects are used. The use of 3D geometry data makes the disclosed system to be suitable for harsh and dirty mine work sites.
- a further additional advantage of the use of accurate 3D geometric models is that the apparatus may control the boom to pass the detected physical object at a relatively close distance whereby the positioning movement may remain as straight and effective as possible. Thanks to these fea- tures, productivity and operational reliability of the boom may be increased.
- the 3D geometry data of the monitored two or more physical objects comprise point cloud data.
- each of the monitored physical objects comprise a plurality of points provided with position data.
- Electrical 3D design data, such as 3D CAD data, as well as 3D scanning data may be easily transformed to point clouds. Means and programs for processing and computing of the point clouds are available.
- the 3D geometry data of the monitored two or more physical objects may comprise a polygon mesh, for example.
- the shape of the physical object may be defined as a triangle mesh composed several triangles, and typically these polygons share edges to form a three-dimen- sional patchwork.
- the polygon mesh may alternatively com ⁇ prise quadrilaterals.
- the polygon mesh may be transformed from a 3D design or modelling data, or may comprise scanned forms of a real 3D object.
- any other available 3D geometry data element may be utilized in the collision examination process dis ⁇ closed in this patent application.
- the apparatus may com ⁇ prise one single control unit provided with one or more boom controllers and one or more collision servers.
- the one or more boom controllers may be located separately to one or more control units comprising the one or more collision servers.
- the boom con ⁇ troller and the collision server may both be located in the same control unit, or alternatively in different control units. This way the actual boom control process and the collision process may be integrated or decentralized.
- Be ⁇ tween the separate units are data transmission means.
- the collision server is configured to examine the 3D geometry data as static ele ⁇ ments. Thereby shape of the physical object and correspond ⁇ ingly the shape of the 3D geometry data do not change during the collision examination.
- the collision exam ⁇ ination expects the tool at the distal end of the boom to be in an inoperative state. This simplification facilitates and quickens the examination process.
- the collision server is configured to examine and prevent possible self-collisions between two or more boom parts of one single boom. Then, 3D geometry data, such as point cloud data, and pose data on critical, or all boom parts are input to the collision server, which may examine the input data in real-time and may generate collision avoidance data for the boom control ⁇ ler.
- the boom controller takes care that the joints of the boom are controlled so that the monitored boom parts do not collide.
- the collision server is configured to examine and prevent possible collisions be- tween two or more separate booms.
- this embodiment only relates to mine vehicles comprising several booms.
- a rock drilling rig used for tunneling may comprise 2 - 3 drilling booms and one or more booms with a man cage or bolting device, for example.
- the booms may operate effectively and safely even in narrow tunnels.
- the col ⁇ lision server is provided with 3D geometry data, such as point cloud data, and pose data on one or more boom parts of two or more separate booms.
- the collision server is configured to execute collision avoidance measures be ⁇ tween at least two separate booms. The controlled boom may then move around the other boom and give way for it and to thereby avoid the collision.
- the collision server is configured to examine and prevent possible collisions be ⁇ tween a boom and a carrier of the mine vehicle.
- the boom may collide with a front portion of the carrier or with components protruding from the carrier if no collision pre ⁇ vention is used. Therefore, the collision server is provided with 3D geometry data, such as point cloud data, and pose data on the carrier, specific part of the carrier or one or more component mounted on the carrier.
- the specific part may be a support leg of the carrier, for example.
- the collision server may execute collision avoidance pro- cess and provide the boom controller with collision data so that the joints of boom will be controlled so that the boom will move around the obstacle.
- the collision server is configured to examine and prevent possible collisions be- tween a boom and one or more environment elements or ob ⁇ jects.
- the environment object may be a wall or surface limiting the working site where the mine vehicle is oper ⁇ ating.
- the environment object may be a wall, ceiling, floor or face of a tunnel.
- the environment object may be a fixed structure arranged at the work site.
- at a reach of the boom may be movable objects such as other mine vehicles or workers, which may also be taken care as environment objects in the collision avoidance pro ⁇ cess.
- the collision server is provided with 3D geometry data, such point cloud data, and pose data on one or more environment objects.
- the collision server is con ⁇ figured to execute collision avoidance measures between the environment object and the at least one boom part.
- the control unit may determine distances between the boom and the physical objects surrounding the mine vehicle and de- termine where they are in order to be classified as envi ⁇ ronment objects locating at the reach of the boom, or as objects of no importance.
- the collision server may be according to the previous embodiment and it is ad ⁇ ditionally configured to determine physical obstacles at a reach of the one or more booms by receiving position or identifying signals from the objects. Then, it is possible to provide the movable or fixed objects at the working site with tacks or transmitters, position of which may be deter ⁇ mined by means of a positioning device of a mine vehicle or the control unit may receive position data from the object. It is further possible to determine a safety space or zone around the object carrying the tag or transmitter. There may also be two or more safety spaces inside each other, whereby an outermost safety space may have a lower security ranking compared to one or more inner safety spaces .
- Vio ⁇ lating the lowermost security ranking may activate the col ⁇ lision system to lower movement speed, and violating the innermost security space may stop the boom movement imme ⁇ diately, for example.
- Size of the safety space or zone may be dimensioned in relation to safety risks of the object.
- Around a human may be a relatively large safety space and control policy of the collision measures may be stricter when human security is concerned.
- the collision server may generate a cylindrical safety space having vertical orien ⁇ tation around a human carrying the tag or positioning trans ⁇ mitter.
- other mobile machines and critical fixed structures at the mine work site may be provided with the tags or position transmitters, and fur- ther, imaginary safety spaces or zones may be generated around them.
- the shape of the safety space may then be determined based on the actual shape and operational range of the object in question and may thereby be spherical, cubical or may have any other shape.
- the collision server may implement simultaneously several of the previously dis ⁇ cussed collision examinations. Thereby it may examine sim ⁇ ultaneously two or more of the following: the self-colli- sion, collision with other booms, collision with carrier and fixed components on board, and collision with surround ⁇ ing fixed structures or moving physical obstacles.
- the apparatus may prioritize and change the utilized exam ⁇ ination principle during the boom control in order to save calculating capacity. The solution is advantageous when there are several possible risks of collision with the phys ⁇ ical objects and when the boom operates in a limited space.
- the collision server is provided with measuring data on position and orientation of the controlled boom.
- Measuring devices may be arranged on the boom, or alternatively, the boom and its parts may be measured by measuring devices arranged on the carrier. Fur ⁇ ther, the measuring may be executed by means of external measuring devices.
- the external measuring devices and the on-board measuring devices arranged on the carrier may be scanning devices, such as laser scanners, for example.
- the generated measuring data is input to the collision server together with data on configuration of the monitored boom. Based on the input data the collision server may calculate the current pose of the boom and its boom parts.
- the con ⁇ figuration of the monitored boom may comprise at least data on dimensions of the boom parts, number of the boom parts, number of joints and their movement directions. In other words, the collision server is provided with kinematic data on the boom.
- the 3D geometry data, such as the point cloud data, of the physical object is based on scanning data.
- the scanning data is produced by means of one or more scanning devices, which may be arranged on-board or may be external to the mine vehicle.
- the scan ⁇ ning device may be a laser scanner or may be based on time- of-flight measuring principles, for example.
- the produced scanning data is input to the collision server which uti ⁇ lizes the input data as the 3D geometry data representing the physical object.
- the collision server may transform the scanning data into point cloud data.
- An advantage of this embodiment is that the scanned data represents the actual configuration and shapes of the physical object.
- the scanned 3D geometry data of the physical object is accurate which is very important for achieving accurate collision exami ⁇ nation.
- a further advantage is that the 3D geometry data can be made for any existing physical object and that the scanning process is fast and may be executed easily. Fur ⁇ thermore, the 3D geometry data of the physical object may be easily updated by means of the scanning
- the 3D geometry data such as the point cloud data
- the 3D geometry data is based on an electrical design data.
- the 3D geometry data may be generated from a computer aided design model of the respective physical object.
- the design model may be a 3D CAD -model, for example.
- the collision avoidance measures of the collision server are divided into two stages in order to facilitate the above disclosed real-time col ⁇ lision examination and to ensure that reasonable computing capacity of the collision server is enough.
- the collision avoidance may be divided into a harsh first stage and a more accurate second stage.
- the collision server gen ⁇ erates virtual 3D bounding boxes around the 3D geometry data of the monitored objects.
- the bounding boxes surround the 3D geometry data with a predetermined tolerance relative to the outermost points of the point cloud or other 3D geometry data.
- the bounding box forms a slightly oversized space inside which the point cloud or other 3d geometry data is located.
- the collision server moni ⁇ tors only collisions of the simple bounding boxes.
- the ac- curate and more complicated second stage is executed only when collision between the bounding boxes is detected. Be ⁇ cause of the tolerances of the bounding boxes, no actual collision of the objects occurs.
- the collision server selects for a further col- lision examination a limited amount of points or elements of the colliding 3D geometry data. The points to be observed are selected at the position or nearby where the collision of the bounding boxes is detected. Thereafter, the collision server may calculate the shortest distance between the se- lected points.
- the boom controller is provided with the data on the detected shortest distance and controls the boom to avoid the selected points or elements to collide during the boom control process.
- the control unit comprises several boom controllers.
- one sin- gle collision server may serve all the dedicated boom con ⁇ trollers .
- the mine vehicle is a rock drilling rig or bolting rig.
- the target poses of the mine work tools are defined in advance in drilling plans such as in drilling patterns and reinforcing plans.
- the pre ⁇ designed plans may be input to the control unit and may be taken into consideration when controlling the boom to po ⁇ sition a rock drilling tool or a reinforcing bolt at the determined positions of drill holes.
- the drilling pattern comprises a start point and an end point or direction of the drill hole.
- the solution decides joint trajectories for a redundant boom of a mine vehicle.
- the boom has more than six degrees of freedom (DOF) which means that is has at least one extra DOF. Thanks to the extra DOF, the boom has additional joint parameters and freedom in kinematics for obstacle avoidance.
- the collision server may determine possible collision when a specific joint of the boom is to be moved during the positioning of the boom and then the boom controller con ⁇ trols one or more other joints instead of the joint being in risk to cause collision, and still, the boom will be controlled in accordance with the operational need.
- the boom structure provides the boom control with flexibility to give in the conventional linear control prin ⁇ ciple temporarily and to utilize the additional degrees of freedom when passing the obstacles safely.
- the boom of the mine vehicle is redundant whereby the boom has more than six degrees of freedom (DOF) .
- DOF degrees of freedom
- boom parts of the boom may be moved while a tool at a distal end of the boom may be hold in a fixed position and orientation.
- trajectory of the tool changes when the boom is moved towards an end pose.
- An initial orienta ⁇ tion of the tool is detected and the boom controller is configured to control joints of the boom so that the initial tool orientation is not changed during the movement of the boom. Then trajectory of the tool is maintained during the movement towards the target pose. This way, direction of the tool is not continuously changed during the positioning movement but instead the tool may be directed to a desired direction.
- An advantage of this embodiment is that the po ⁇ sitioning of the tool inside the confined spaces is easier and supervising of the positioning is facilitated.
- control unit is configured to control the boom automatically towards the input target position.
- control unit execute fully automatic the positioning movements and the collision avoid ⁇ ance measures.
- the control unit exe- cutes the collision examination automatically but the ac ⁇ tual boom control is manual or semi-manual. Then the oper ⁇ ator is informed of the possible collision and is provided with control guidance generated by the control unit in order to avoid the collision.
- the control unit may display the guidance on a display device. It may also be possible to switch the manual control temporarily into automatic con ⁇ trol and to allow the control unit to solve the situation.
- the disclosed apparatus may be also be utilized in manual and computer assisted controlling of the boom.
- the collision preven ⁇ tion system may utilize artificial potential fields when planning a collision free path towards the target pose. Then detected physical obstacles in the reach of the controlled boom are considered as positively charged elements, as well as the controlled boom and the current pose.
- the target pose is considered as a negatively charged element.
- the posi ⁇ tively charged obstacles repel each other and generate re ⁇ pulsive force.
- the negatively charged target pose attracts the positively charged boom because of their opposite charges.
- the boom controller controls the boom towards the target pose and avoids the other positively charged ele ⁇ ments. Thereby a collision free path is generated.
- the apparatus utilizes the above disclosed artificial potential fields and when the control unit detects that the target pose cannot be reached because of the detected obstacles, then substitu ⁇ tive positioning is implemented.
- the control unit may position the tool as close as possible to the target pose by taking into account the traction force of the target pose and repulsive forces of the obstacles. Then, the final end pose may deviate from the planned pose but is as close to the planned pose as possible. At the final pose there exists equilibrium between the traction force and the repulsive forces.
- control unit is configured to estimate ability to reach the target pose by the boom prior to initiate the positioning, and is config ⁇ ured to indicate result of the estimation.
- the control unit may be configured to automatically detect if the target pose is reachable and may indicate to the operator if not. Fur ⁇ ther, the control unit may suggest corrective measures for the operator or may implement them automatically.
- corrective measures may be executed beforehand to avoid the problems in the actual operation.
- control unit When the control unit is configured to control mov ⁇ ing of several booms, the control unit may be configured to substitute an initially controlled boom with another boom in response to indication that the initial boom is unable to reach the target pose.
- control unit when the control unit is configured to control moving of several booms, then the control unit may be configured to move one or more booms out of the way of an initially controlled boom in response to detection of possible collision between the initial boom and the other booms when moving the initial boom towards the target pose.
- the corrective measure may also include re-dividing the work tasks between several booms.
- the control unit may also be configured to generate prioritizing boom rules or may implement input pre-defined prioritizing rules for prioritizing one boom over the other booms.
- the prioritizing rule may also determine prioritiz ⁇ ing order between all booms of the mining vehicle.
- the prioritizing order of the booms may be based on types of the booms, working tasks of the booms, operational condi ⁇ tions of the booms and the mining work devices at the end portions of the booms.
- the control unit may note that the tool connected to the mining work device, such as a drill bit, has become dull, whereby the control unit may set a lower prioritizing order for the boom in question.
- the control unit may order a boom with a lower pro- duction capacity and ability to give way to other booms with better efficiency. This way, when possible collision between the booms is detected by the collision server, the lower priority boom gives way for a higher ranked boom and oper ⁇ ational efficiency is thereby ensured. Further, the control unit may downgrade priority of a boom when a monitoring feature of the control unit detects that accuracy or other ability of the boom, or the mine work device, to perform high quality tasks is reduced from the original level. Then the control unit makes the low quality boom to give way for booms operating at their designed level of quality.
- the prioritizing feature may also mean that the system reserves best operational positions for a boom with highest ranking. Then, it is possible that the most effective or accurate drilling boom is utilized to drill essential bore holes at certain areas and the other drilling booms may drill other areas around the specific areas thus completing the drilling of a drilling plan.
- the control unit may also utilize the prioritizing rules between the booms when it detects that two or more booms operating close to each other are not executing all the planned tasks, because they all avoid collisions by moving out of the way.
- the prioritizing feature may be used when all the booms politely avoid po ⁇ sitioning measures to a target location between the neigh ⁇ boring booms. Then, it is possible that some drill holes of a drilling pattern remain undrilled or their drilling is hampered and delayed, for example. An advantage of the pri ⁇ oritizing rules is that such situations may be avoided and more streamlined operation without unnecessary movements is accomplished.
- the control unit may also generate transient prioritizing commands for the boom controllers on a case- by-case bases when recognizing the undesired avoidance and politeness behavior.
- the control unit may also be provided with one or more give way rules for defining mutual behavior of the booms of the mining vehicle.
- the give way rules between the booms may take into account for example movement accuracy of the booms and operational state and capability. Further, the rules may also detect combined joint positions of each of the booms and may avoid moving the booms into joint positions where performance or movement accuracy is de ⁇ creased. If a boom is about to reach a useless position, then the system orders neighboring booms to give way so that the better joint position can be reached.
- the above mentioned prioritizing rules between the booms may be changed during a work task, as well as prin ⁇ ciples of the give way rules may also be amended during the progress of the work task.
- the rules are not static but can instead change one or several times during a drill ⁇ ing process of one cut of a tunnel, for example.
- the control unit may be provided with a drilling pattern defining start and end positions of the drill holes to be drilled.
- the control unit may use the end point of the drill hole as a target pose and may position a drilling tool of the drilling boom as close as possible to a rock surface. This way direction of the drill hole is not as designed but at least end of the drilled hole is in accordance with the drilling plan.
- An alternative solution is to amend the drilling pattern after being noted that the initial plan comprises drill holes which may not be reached.
- the control unit may automatically reposition the problem- atic drill holes of the drilling pattern in order to place them into reachable start points and directing them so that the original end points are met when being drilled.
- a further possible embodiment for rock drilling is to simulate drilling of the entire drilling pattern before the actual drilling phase and to examine how well the drill ⁇ ing pattern may be drilled, and to note the possible col ⁇ lisions.
- the simulation may also provide information for determining if the drill holes of the drilling pattern are divided correctly between several drilling booms. Thus, the simulation may indicate possible defects in the drilling pattern.
- the drilling pattern may be corrected on the basis of the simulation and may be executed automatically without interruptions.
- the control unit may be provided with a sim ⁇ ulation program or algorithm for providing the disclosed simulation feature.
- the disclosed collision avoidance measures are operable not only in automatic con ⁇ trol mode but also when the booms are controlled manually by the operator in a manual operating mode.
- the control unit may comprise an analyzing and reporting system onboard the min ⁇ ing vehicle, or alternatively, the control unit may send data packages concerning collision situations to a corre ⁇ sponding system external to the mining vehicle.
- the system may store data on situations when the collision server has recognized possible collision situation and has activated collision avoidance measures.
- the analyzing fea ⁇ ture may generate suitable data for determining need for training operators to control the mine vehicles and their booms better in manual control modes.
- the analyzing and reporting feature can also provide feedback to the operator of the performance. The reporting feature is useful when there is a need to submit safety reports of the mine and a certain project.
- the gathered data and the analyzing prop- erties may also be utilized when positioning needed infra ⁇ structure to tunnels and rock cavities.
- Physical objects such as air ventilation means and electric cables, may be mounted to positions where probability to collisions is low based on the analyses.
- the added objects are placed as planned, their positions are well known by the collision avoidance system and thereby colli ⁇ sions may be avoided effectively.
- Figure 1 is a schematic side view of a rock drilling rig provided with several drilling booms and means for de ⁇ termining poses of the booms and the surroundings,
- Figure 2 is a schematic diagram showing possible collision examination situations and physical objects to collide with
- Figure 3 is a schematic diagram showing 3D geometry data
- Figure 4 is a schematic diagram showing a possible collision avoidance architecture
- Figure 5 is a schematic view showing conventional linear positioning movement from a start pose to a target pose and Figure 6 shows that the positioning is stopped in the conventional system when an obstacle is detected on the movement path,
- Figure 7 is a schematic view showing that the boom may turn around a detected obstacle and continue position ⁇ ing
- Figure 8 is a schematic view showing a principle of an artificial potential field method
- Figure 9 is a schematic view showing that when the boom cannot be positioned to the target pose, then a sub ⁇ stitute pose may be determined.
- Figure 10 is schematic view showing two boom parts and Figure 11 shows the boom parts as point clouds being surrounded by virtual bounding boxes,
- Figure 12 is a schematic view showing that the boom parts of Figures 10 and 11 are tilted so that the virtual bounding boxes collide,
- Figure 13 is a schematic view showing the closest distance between two point clouds
- Figure 14 is a schematic view showing detection of a human carrying a tag and being surrounded by vertical imaginary safety cylinders.
- Figure 1 shows a rock drilling rig 1 as an example of a mine vehicle. Also rock bolting rigs, charging rigs, measuring vehicles are mine vehicles comprising one or more booms. The disclosed method and solution may be applied in all type mine vehicles comprising booms.
- the rock drilling rig 1 may comprise a movable car- rier 2 and one or more booms 3 connected to the carrier 2. At a distal end portion of the boom 3 may be a drilling unit 4.
- the drilling unit 4 may comprise a feed beam 5 and a rock drilling machine 6 supported on it.
- the rock drilling ma ⁇ chine 6 may comprise a shank at a front end of the rock drilling machine 6 for connecting a tool 7.
- the rock drilling rig 1 is operating in an underground mine space 8, which may be a tunnel, storage hall or corridor, for example.
- the mine space 8 may comprise a face surface 9, wall surfaces 10 and a roof surface 11.
- the rock drilling rig 1 may be provided with one or more scanning devices S for measuring current positions and directions of the booms 3.
- the scanning device S may also determine 3D shapes of the booms 3.
- the scanning device S may detect the surrounding surfaces and other obstacles around the rock drilling rig 1 and produce scanning data for the collision examination.
- the scanning device S may comprise a laser scanner.
- the booms may be provided with measuring devices or sensors 12 for measuring positions and directions of the booms.
- the sensing data of the scanner S and the sensors 12 are trans ⁇ mitted to a control unit CU, which may determine current poses of the booms and may execute collision examination procedures.
- the poses may be defined in a 3D machine coor ⁇ dinate system 13 of the rock drilling rig 1 and may be transformed into a 3D mine coordinate system 14.
- Figure 1 further discloses that the mine vehicle 1 may communicate with one or more external control units CU ' , which may be part of a mine control system or they may be individual computers, servers or terminal devices. This way it may be possible to execute the collision execution or other disclosed processes or computations external to the mine vehicle.
- CU ' external control units
- Figure 2 discloses different type of collision ex ⁇ aminations which may all be included during the control of the boom.
- Figure 3 discloses that the 3D geometry data used in the collision examination may be 3D point clouds or 3D polygon meshes.
- the 3D geometry data of the physical objects may be created by means of scanners or may be transformed from 3D design models.
- Figure 4 discloses a collision avoidance architec ⁇ ture, which may comprise a control unit CU.
- the control unit CU may be provided with a collision server CS and one or more boom controllers BCl to BCn depending on the number of booms 3 to be controlled.
- the collision server CS may serve all boom controllers BC and comprises a processor for exe ⁇ cuting a collision avoidance program.
- Target pose and cur ⁇ rent pose of the boom are input to the collision server CS as well as 3D geometry data on the boom and the other physical objects.
- the target pose may be input by means of a control panel or may be retrieved from a drilling pattern or corresponding pre-designed plan.
- the current pose data may be determined by means of a scanner S or sensors 12.
- the boom 3 may comprise several boom parts 3a - 3c and rotational joints RJ or linear joints LJ between them.
- the sensors 12 may be arranged in connection with the joints, for example.
- current poses of the boom parts 3a - 3c may be determined.
- the collision server CS provides the boom controllers BC with collision avoidance data and dedicate boom controllers BC generate control sig ⁇ nals for controlling boom actuators BA.
- Figure 4 further discloses that the collision server CS may be provided with a control policy CP comprising instructions and principles relating to mutual behaviour of two or more booms 3 of the mine vehicle.
- the control policy may comprise priority rules PR for determining priority between several booms 3. Operations of a boom with high ranking is favoured in respect to booms with lower priority.
- the control policy may also comprise give way rules GWR for determining which boom moves out of the way and how. By means of the priority rules PR and the give way rules GWR effective operation of several booms is ensured and unnec- essary avoidance behaviour is avoided.
- Figure 4 also discloses that the collision server may produce collision data package CDP, which may be ana ⁇ lysed by means of an analysis and reporting tool ART, which may be located external to the collision server, or alter ⁇ natively on-board the mine vehicle.
- the analysis and re ⁇ porting tool ART may generate feedback data on operator ' s ability to manually control the booms without colliding them.
- the system may also provide data packages and reports on situations wherein booms have been too close to collide and also data on realized collides.
- preventive measures may be planned for future. The analysed data may be taken into consideration when plan ⁇ ning new positions for the fixed infrastructure at the mine work site.
- the positions of the infrastructure may be se ⁇ lected so that probability to collide is as low as possible.
- Figure 5 shows conventional linear positioning movement from a start pose SP to a target pose TP.
- the positioning of the boom 3 is stopped at point 13 when an object 14 is detected on the movement path.
- the boom is arranged to turn around 15 the detected obstacle 14 and the positioning is carried out continuously without any stoppage.
- Figure 8 shows a basic principle of an artificial potential field method, wherein the boom 3, the start pose SP and the objects 14 are positively charged items and the target pose TP is a negatively charged item. Then the pos ⁇ itively charged boom 3 avoids the positively charged objects 14 and approaches the negatively charged target pose TP.
- the target pose TP is close to an additional object 14a preventing the positioning at the target pose TP. Then the disclosed system may generate a substitute pose TP ' wherein propulsive forces and attractive forces are in bal ⁇ ance .
- Figure 10 discloses two boom parts 3a, 3b and Figure
- FIG. 11 shows the boom parts as point clouds 16a, 16b comprising several points.
- the point clouds 16a, 16b are virtual bounding boxes 17a, 17b, which form imaginary boundary sur ⁇ faces at a distance from outermost points of the point clouds.
- the boom part 3b is moved so that the bounding boxes 17a, 17b collide. Then the disclosed colli ⁇ sion avoidance system may select a limited amount of points 18 to be examined more closely. When the bounding boxes do not collide, then there is no need for accurate collision avoidance.
- Figure 13 discloses two point clouds 16a, 16b and points 19 being closest to each other. Then the closest distance between the point clouds 16a, 16b representing boom parts 3a, 3b is indicated by an arrow 20.
- Figure 14 discloses that a human H entering a work site of a mine vehicle may be detected and positioned by means of a position or identifying signal received by a position detector or receiver PDR of the mine vehicle.
- the human may carry a tag T and the position detector may de ⁇ termine position of the tag.
- the collision server may de ⁇ termine a safety space or zone Szl around the human H. Any of the booms of the mine vehicle may not enter the safety space Szl and if that occurs, the boom is immediately stopped.
- the safety space Szl may have cylindrical config ⁇ uration.
- Safety space Szl may be a second safety space Sz2 and when the boom enter inside the space, a col ⁇ lision warning, reduced boom speed and other preventive safety measures may occur.
- any other object may be provided with the tag T and may also be enveloped by the one or more safety spaces Szl, Sz2.
Landscapes
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mining & Mineral Resources (AREA)
- Geology (AREA)
- Fluid Mechanics (AREA)
- Environmental & Geological Engineering (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geochemistry & Mineralogy (AREA)
- Robotics (AREA)
- Operation Control Of Excavators (AREA)
- Earth Drilling (AREA)
Abstract
Description
Claims
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP17164922.1A EP3385494A1 (en) | 2017-04-05 | 2017-04-05 | Apparatus and method for controlling boom of mine vehicle |
PCT/EP2018/057779 WO2018184916A1 (en) | 2017-04-05 | 2018-03-27 | Apparatus and method for controlling boom of mine vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
EP3607165A1 true EP3607165A1 (en) | 2020-02-12 |
Family
ID=58489586
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP17164922.1A Withdrawn EP3385494A1 (en) | 2017-04-05 | 2017-04-05 | Apparatus and method for controlling boom of mine vehicle |
EP18712913.5A Pending EP3607165A1 (en) | 2017-04-05 | 2018-03-27 | Apparatus and method for controlling boom of mine vehicle |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP17164922.1A Withdrawn EP3385494A1 (en) | 2017-04-05 | 2017-04-05 | Apparatus and method for controlling boom of mine vehicle |
Country Status (3)
Country | Link |
---|---|
EP (2) | EP3385494A1 (en) |
AU (1) | AU2018248806B2 (en) |
WO (1) | WO2018184916A1 (en) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020187947A1 (en) | 2019-03-19 | 2020-09-24 | Sandvik Mining And Construction Oy | Mine vehicle boom positioning control |
CN110262478B (en) * | 2019-05-27 | 2022-04-19 | 浙江工业大学 | Man-machine safety obstacle avoidance path planning method based on improved artificial potential field method |
CN112338900B (en) * | 2020-11-05 | 2022-01-04 | 海宁哈工现代机器人有限公司 | High-end equipment manufacturing mechanical arm bracket |
CN112861361B (en) * | 2021-02-20 | 2023-04-11 | 中国铁建重工集团股份有限公司 | Working space simulation method based on drill jumbo |
US11939748B2 (en) | 2021-03-29 | 2024-03-26 | Joy Global Surface Mining Inc | Virtual track model for a mining machine |
US11987961B2 (en) | 2021-03-29 | 2024-05-21 | Joy Global Surface Mining Inc | Virtual field-based track protection for a mining machine |
CN113832968B (en) * | 2021-09-16 | 2023-02-10 | 湖南五新隧道智能装备股份有限公司 | Anchor rod construction positioning method and system |
US20230272671A1 (en) * | 2022-02-25 | 2023-08-31 | J.H. Fletcher & Co. | Automated system for face drill machines |
EP4343106A1 (en) * | 2022-09-20 | 2024-03-27 | Sandvik Mining and Construction Oy | Determination of a route in an underground worksite for a mining vehicle |
EP4343105A1 (en) * | 2022-09-20 | 2024-03-27 | Sandvik Mining and Construction Oy | Determination of an updated drilling plan |
EP4343479A1 (en) * | 2022-09-20 | 2024-03-27 | Sandvik Mining and Construction Oy | Environment related data management for a mobile mining vehicle |
WO2024077337A1 (en) * | 2022-10-10 | 2024-04-18 | BCI Mining Technology Pty Ltd | Underground development drill boom tracking system |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE3902127A1 (en) * | 1989-01-25 | 1990-07-26 | E & Pk Ingbuero | Wagon drill with laser-orientated control |
US5347459A (en) * | 1993-03-17 | 1994-09-13 | National Research Council Of Canada | Real time collision detection |
DE10106023A1 (en) * | 2001-02-09 | 2002-08-29 | Fraunhofer Ges Forschung | Method and device for collision detection of objects |
US6678582B2 (en) * | 2002-05-30 | 2004-01-13 | Kuka Roboter Gmbh | Method and control device for avoiding collisions between cooperating robots |
US9500079B2 (en) * | 2013-05-27 | 2016-11-22 | Sandvik Mining & Construction Oy | Method and control system for a mining vehicle and a mining vehicle |
-
2017
- 2017-04-05 EP EP17164922.1A patent/EP3385494A1/en not_active Withdrawn
-
2018
- 2018-03-27 EP EP18712913.5A patent/EP3607165A1/en active Pending
- 2018-03-27 WO PCT/EP2018/057779 patent/WO2018184916A1/en unknown
- 2018-03-27 AU AU2018248806A patent/AU2018248806B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
AU2018248806B2 (en) | 2024-01-25 |
WO2018184916A1 (en) | 2018-10-11 |
AU2018248806A1 (en) | 2019-10-31 |
EP3385494A1 (en) | 2018-10-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
AU2018248806B2 (en) | Apparatus and method for controlling boom of mine vehicle | |
CN108286949B (en) | Movable three-dimensional detection robot system | |
CA2936686C (en) | Mine control system | |
EP2446332B1 (en) | Determination of route for arranging automatic control of mobile mining machine | |
US20160170411A1 (en) | Real-time Route Terrain Validity Checker | |
Lytle et al. | Adapting a teleoperated device for autonomous control using three-dimensional positioning sensors: experiences with the NIST RoboCrane | |
US20230059996A1 (en) | Mine vehicle safety control | |
Hassan et al. | An approach to base placement for effective collaboration of multiple autonomous industrial robots | |
Bonchis et al. | Robotic explosive charging in mining and construction applications | |
EP3094806A1 (en) | Mine vehicle and method of initiating mine work task | |
US20220244741A1 (en) | Semantic Models for Robot Autonomy on Dynamic Sites | |
CN115256414A (en) | Mining drilling robot and coupling operation method of mining drilling robot and geological and roadway models | |
Ahmad et al. | Generation of safe tool-path for 2.5 D milling/drilling machine-tool using 3D ToF sensor | |
CN112873206A (en) | Multi-task automatic distribution mechanical arm control system and operation trolley | |
EP3660266B1 (en) | Model generation for route planning or positioning of mobile object in underground worksite | |
CN114391060A (en) | Positioning of mobile equipment in an underground worksite | |
Aalerud et al. | Industrial Environment Mapping Using Distributed Static 3D Sensor Nodes | |
Lytle et al. | NIST research in autonomous construction | |
EP4246270A1 (en) | Coordinate transformation for mining vehicle positioning | |
Lin et al. | A Advanced Telerobotic Control System for a Mobile Robot with Multisensor Feedback | |
Honegger et al. | Vision supported operation of a concrete spraying robot for tunneling work | |
Schnakenberg | Computer-assisted continuous coal mining system-research program overview | |
Nevludov et al. | Production Workspace Obstacle Avoidance Mobile Robot Trajectory Modeling | |
JP7217212B2 (en) | Field monitoring device, field monitoring method and field monitoring program | |
WO2022107758A1 (en) | Unmanned aircraft control device, and storage medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: UNKNOWN |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20191105 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
AX | Request for extension of the european patent |
Extension state: BA ME |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) | ||
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: EXAMINATION IS IN PROGRESS |
|
17Q | First examination report despatched |
Effective date: 20211004 |
|
P01 | Opt-out of the competence of the unified patent court (upc) registered |
Effective date: 20230603 |