1. Field of the Invention
The present invention relates to an anti-collision protection system for machines that operate in a raw material stockpile yard, such as (by way of example) a coal stockpile.
An object of the present invention is to provide an anti-collision protection system that prevents machines/machine collisions with minimal disruptions to normal operations of the yard and allows maximum useable space for yard operations.
2. Description of Related Art
In the context of a raw material stockpile yard, the machine/machine collisions are collisions between machines, including stackers and stackers/reclaimers, that typically operate in such yards to deliver materials to and to recover materials from the yards.
Typically, these machines travel in defined paths on a network of rail tracks that are laid in the yard. Typically, the network comprises a series of parallel tracks. Typically, the machines include (i) a body and (ii) a boom that has a material delivery and/or recovery end and extends from the body. Typically, the boom includes a counterweight at the end of the boom that is opposite to the material delivery and/or recovery end. Typically, the boom is mounted to the body so that the boom can be rotated 360° about a vertical axis and can be raised/lowered to change the height of the material delivery and/or recovery end of the boom.
The location of a boom in space is described hereinafter in relation to the slew angle and the luff angle of the boom and the position of the machine on the defined path, such as the rail track.
The term “slew angle” of a boom of a machine is understood herein to mean the angle of the boom in relation to a nominated axis in the x-y plane. One suitable axis is the rail track axis in the direction of forward movement of the machine.
The term “luff angle” of a boom of a machine is understood to mean the angle of the boom with the horizontal.
According to the present invention there is provided an anti-collision protection system for machines that operate in a raw material stockpile yard, the machines being moveable in the yard in defined paths, each machine including a material delivery and/or material recovery boom that can be rotated about a vertical axis, which anti-collision protection system includes:
Preferably the envelope of each boom is defined in relation to a longitudinal axis of the boom. The longitudinal axis of the boom forms a reference line for producing the envelope.
Preferably the envelope is rectangular in shape.
Preferably the envelope is rectangular in shape when the envelope and the longitudinal axis of the boom are projected onto the x-y plane.
In other words, preferably the envelope is rectangular in shape when the envelope is drawn on the x-y plane in relation to the longitudinal axis of the boom as the axis appears in top plan view projected onto the x-y plane.
Preferably the long sides of the envelope are equi-spaced from the longitudinal axis of the boom.
Preferably the short sides of the envelope are equi-spaced from opposite ends of the boom.
Preferably the envelope of each boom is responsive to the speed of slew and/or the speed of long travel of the machine and expands as the machine speed increases and contracts as the speed decreases.
Preferably the envelope is defined by vector calculations that create the envelope as an envelope that moves with the boom.
Preferably the means for detecting an intersection of the boundaries of the exclusion zones for the booms includes a means for defining the locations of the envelopes in space and a means for determining whether the envelopes intersect.
Preferably the means for locating the envelopes in space includes, on each machine, a sensor for measuring the slew angle of the boom and a sensor for measuring the long travel of the machine along the defined path of the machine.
Typically, the slew angle sensor of each machine is mounted on a slew ring of the machine.
Typically, the defined path of each machine is a rail track in the yard.
Preferably the long travel sensor is a wheel-mounted sensor on the machine.
Preferably the anti-collision system includes a plurality of envelopes around each boom, the envelopes including an innermost envelope and successively outwardly spaced envelopes.
Preferably the means responsive to a detected boundary intersection responds differently for each of the plurality of envelopes.
Preferably there are three envelopes around each boom and the means responsive to a detected boundary intersection:
Preferably the means responsive to a detected boundary intersection initiates appropriate messages on the operator console when events (b) and (c) occur.
Preferably the means responsive to a detected boundary intersection includes a means for moving the machines involved in the intersection away from each other. In this context, the reference to “moving the machines” includes moving one or both booms of the machines.
Preferably the means for moving the machines involved in the boundary intersection away from each other includes a means for determining the minimum distance between the booms of the machines.
Preferably each boom includes a counterweight, whereby the boom includes a boom section and a counterweight section.
Preferably the anti-collision system includes a means for defining an envelope around the boom section and a means for defining another envelope around the counterweight section of each boom, the envelopes forming boundaries of exclusion zones for the boom section and the counterweight section of the boom.
Preferably the anti-collision system includes a plurality of envelopes around each counterweight section, the envelopes including an inner envelope and successively outwardly spaces envelopes.
The present invention is described further by way of example with reference to the accompanying drawings, of which:
Each of the machines SR1, SR0 and SK1 includes a body (not shown) that is constructed to engage the tracks 3 and to move the machines backwards and forwards along the tracks.
Each of the machines SR1, SR0, and SK1 also includes a boom 5 mounted to the body. Each boom 5 includes a coal delivery and/or recovery end 7 and a counterweight 9 at the other end of the boom.
More particularly, each boom 5 includes a boom section 21 and a counterweight section 23. Each boom 5 can be rotated about a vertical axis of the machine and can be raised/lowered relative to the horizontal.
It can be appreciated from
It will be evident from consideration of
As stated above, the object of the present invention is to provide an anti-collision protection system that makes it possible to avoid such collisions and at the same time to maximise the useable space for yard operations.
The latter point is concerned with minimising, if not eliminating entirely, “dead” zones in the yard.
A preferred system of the present invention is designed to avoid collisions between: (i) the booms 5 of machines SR1 and SK1; (ii) the boom 5 of machine SR1 and the counterweight 9 of machine SK1; (iii) the counterweight 9 of machine SR1 and the boom 5 of machine SK1; (iv) the booms 5 of machines SR0 and SK1; (v) the boom 5 of machine SR0 and the counterweight of machine SK1; and (vi) the counterweight of machine SR0 and the boom 5 of machine SK1.
In terms of equipment, the preferred system includes (i) a PLC on each machine, (ii) point to point communications between each of the machine PLCs and a “hub” PLC, and (iii) a system PLC that carries most of the inter-machine anti-collision logic by running a compiled executable program within the PLC processor.
As stated above, the preferred system is based on creating at least one rectangular envelope around the boom section 21 of each boom 5 and at least one rectangular envelope around the counterweight section 23 of each boom 5, whereby the envelopes form boundaries of exclusion zones for the boom sections 21 and the counterweight sections 23 of the booms 5.
Factors that are relevant to determine the sizes of the 3 envelopes for a machine include:
As is also stated above, the preferred system is based on (i) detecting the intersection of the boundaries of the exclusion zones of adjacent machines and (ii) responding to detected intersections to avoid collisions.
The preferred system uses the following coordinate system.
In order to detect the intersection of the boundaries of the exclusion zones of adjacent machines, the preferred system locates the envelopes in space and then continuously determines whether the envelopes intersect.
The means for locating the envelopes in space includes sensors (not shown) on each machine for measuring the slew angles of the booms 5 and the long travel of the machines.
Each rectangular envelope is defined by its corners, as follows:
Collision detection is accomplished by determining if any of the lines defining the envelopes of one of the machines intersect the lines defining the envelopes of an adjacent machine.
In order to determine whether a given envelope of one machine intersects another given envelope of another machine, the preferred system carries out the following steps.
In the preferred system with three envelopes for the boom section 21 of the boom 5 (which define Zones 1, 2, and 3 as shown in
In order to respond to a detected intersection, the preferred system determines the minimum distance between the adjacent machines and calculates angles between selected points on the machines.
The preferred system then uses the calculated angles to assess permissible slewing and travel movement of the machines to move the machines away from an intersecting situation and then moves the machines accordingly.
It will be apparent that the envelopes are sized so as to allow the system to avoid collisions and that the size of the envelopes may change dynamically in accordance with any changing requirements to avoid collision—eg changes to required braking distance.
Many modifications may be made to the present invention as described above by way of example without departing from the spirit and scope of the invention.
By way of example, the preferred system described above does not take into account the luff angles of the machines. However, it is noted that the present invention extends to systems that consider the luff angles of the machines.
By way of further example, the present invention is not limited to the particular: (i) means for defining envelopes around each boom that moves with the boom, (ii) means for detecting an intersection of the boundaries of the exclusion zones, and (iii) means responsive to a detected boundary intersection to prevent collision of the machines; described above.
Number | Date | Country | Kind |
---|---|---|---|
PR2570 | Jan 2001 | AU | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/AU02/00048 | 1/17/2002 | WO | 00 | 10/29/2003 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO02/058034 | 7/25/2002 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5198800 | Tozawa et al. | Mar 1993 | A |
5343739 | Curry | Sep 1994 | A |
5481248 | Kruh | Jan 1996 | A |
5634565 | Lesage | Jun 1997 | A |
6473715 | Eckstine | Oct 2002 | B1 |
6614721 | Bokhour | Sep 2003 | B1 |
Number | Date | Country | |
---|---|---|---|
20040055986 A1 | Mar 2004 | US |