Patent Grant
10246087
The present disclosure relates to a work vehicle, and more particularly, to a collision mitigation system and method for the work vehicle.
Industries, such as construction, agriculture, mining, often employ articulated machines. An articulated machine, generally, includes front and rear frames hinged together by a hitch joint for relative pivotal movement. When one of the frames is moved relative to the other, the articulated machine turns to change a direction of travel. Unlike cars and trucks that can change direction only by rotating the wheels, articulated machine require a clearance distance of at least half the machine's length in order to complete a turn. This large reconfiguration of the machine's clearance distance may sometimes be hazardous in confined areas, when the machine is in close proximity with surrounding external objects including, but not limited to, other working machines, buildings and rocks. This may introduce difficulties or unanticipated interactions with the surrounding objects and lead to collisions when executing a turn or other operations in such machines.
U.S. Pat. No. 7,721,842 B2 (hereinafter referred to as the '842 patent) relates to an articulated work vehicle steering system with controlled steering cushioning and associated method. The steering system is provided for a work vehicle including articulated first and second vehicle sections. The steering system includes a controller adapted to determine from a speed-request signal, if a requested steering speed requested for the first vehicle section relative to the second vehicle section, about an articulation axis towards an end of an end region of a position range of the first vehicle section, is at least equivalent to a predetermined steering speed. The steering system further includes determining from a position signal if the first vehicle section is positioned in the end region of the position range; and, if the requested steering speed is at least the predetermined steering speed and the first vehicle section is positioned in the end region, and based on that signals that an actual steering speed of the first vehicle section be lower than the requested steering speed.
The steering system of the '842 patent provides manipulation of steering speed of an articulated work vehicle; however, such steering system does not provide any means to detect and/or prevent or mitigate collisions of such machines with external objects.
In one aspect of the present disclosure, an articulated work vehicle is described. The articulated work vehicle includes a front frame having a first pair of wheels and a rear frame having a second pair of wheels. The articulated work vehicle also includes a hitch pivotally coupling the front frame to the rear frame. The articulated work vehicle includes a powertrain configured to drive the first and second pair of wheels. The articulated work vehicle further includes a steering system configured to provide controlled articulation of the front frame relative to the rear frame about the hitch based on a driver control input. The articulated work vehicle includes a first sensor system configured to sense objects around the articulated work vehicle, a second sensor system configured to sense real-time articulation angle of the front frame relative to the rear frame and a third sensor system configured to sense real-time rotation of the first and second pair of wheels. The articulated work vehicle also includes real time processing circuitry electrically coupled to the steering system, the first sensor system, the second sensor system, and the third sensor system. The processing circuitry is configured to determine a safe-zone around the articulated work vehicle based on signals from the first sensor system corresponding to sensed objects around the articulated work vehicle. The processing circuitry is further configured to determine a position and velocity of one or more peripheral points on the articulated work vehicle based on signals from the second sensor system, and the third sensor system. The processing circuitry is configured to receive the driver control input. The processing circuitry is further configured to apply a limit to the driver control input when a peripheral point on the articulated work vehicle is expected to be within a predetermined distance to a nearest edge of the safe-zone.
In another aspect of the present disclosure, a collision mitigation system for an articulated work vehicle is described. The collision mitigation system includes a memory configured to store program instructions and sensor signals. The collision mitigation system also includes a controller in communication with the memory. The controller is configured to determine a safe-zone around the articulated work vehicle based on signals from a first sensor system corresponding to sensed objects around the articulated work vehicle. The controller is also configured to determine a position and velocity of one or more peripheral points on the articulated work vehicle based on signals from a set of sensor systems operatively coupled to the articulated work vehicle. The controller is also configured to receive a driver control input. The controller is further configured to apply a limit to the driver control input when a peripheral point on the articulated work vehicle is expected to be within a predetermined distance to a nearest edge of the safe-zone.
In yet another aspect of the present disclosure, a method for mitigating collisions for an articulated work vehicle is described. The method includes determining a safe-zone around the articulated work vehicle based on signals from a first sensor system corresponding to sensed objects around the articulated work vehicle. The method further includes determining a position and velocity of one or more peripheral points on the articulated work vehicle based on signals from a set of sensor systems operatively coupled to the articulated work vehicle. The method also includes receiving a driver control input. The method further includes applying a limit to the driver control input when a peripheral point on the articulated work vehicle is expected to be within a predetermined distance to a nearest edge of the safe-zone.
Other features and aspects of this disclosure will be apparent from the following description and the accompanying drawings.
The accompanying drawings, which are incorporated in and constitute a part of the specification, are illustrative of one or more embodiments and, together with the description, explain the embodiments. The accompanying drawings have not necessarily been drawn to scale. Further, any values or dimensions in the accompanying drawings are for illustration purposes only and may or may not represent actual or preferred values or dimensions. Where applicable, some or all select features may not be illustrated to assist in the description and understanding of underlying features.
The description set forth below in connection with the appended drawings is intended as a description of various embodiments of the described subject matter and is not necessarily intended to represent the only embodiment(s). In certain instances, the description includes specific details for the purpose of providing an understanding of the described subject matter. However, it will be apparent to those skilled in the art that embodiments may be practiced without these specific details. In some instances, structures and components may be shown in block diagram form in order to avoid obscuring the concepts of the described subject matter. Wherever possible, corresponding or similar reference numbers will be used throughout the drawings to refer to the same or corresponding parts.
Any reference in the specification to “one embodiment” or “an embodiment” means that a particular feature, structure, characteristic, operation, or function described in connection with an embodiment is included in at least one embodiment. Thus, any appearance of the phrases “in one embodiment” or “in an embodiment” in the specification is not necessarily referring to the same embodiment. Further, the particular features, structures, characteristics, operations, or functions may be combined in any suitable manner in one or more embodiments, and it is intended that embodiments of the described subject matter can and do cover modifications and variations of the described embodiments.
It must also be noted that, as used in the specification, appended claims and abstract, the singular forms “a,” “an,” and “the” include plural references unless the context clearly dictates otherwise. That is, unless clearly specified otherwise, as used herein the words “a” and “an” and the like carry the meaning of “one or more.” Additionally, it is to be understood that terms such as “left,” “right,” “up,” “down,” “top,” “bottom,” “front,” “rear,” “side,” “height,” “length,” “width,” “upper,” “lower,” “interior,” “exterior,” “inner,” “outer,” and the like that may be used herein, merely describe points of reference and do not necessarily limit embodiments of the described subject matter to any particular orientation or configuration. Furthermore, terms such as “first,” “second,” “third,” etc. merely identify one of a number of portions, components, points of reference, operations and/or functions as described herein, and likewise do not necessarily limit embodiments of the described subject matter to any particular configuration or orientation.
Generally speaking, embodiments of the present disclosure can provide a collision mitigation system for an articulated work vehicle which involves overriding an operator's steering command to avoid or mitigate collision of the articulated work vehicle by using information related to articulation angle, geometry of the machine's periphery and external objects surrounding the articulated work vehicle, while the articulated work vehicle is in operation. Embodiments of the disclosed subject matter can alternatively limit swing command in a work vehicle having a center pivot arrangement.
Referring to
In general, the machine 100 includes a body 101 to support the various components therein. Referring to
The machine 100 may include a front axle assembly 107 supported on the front frame 102 and a rear axle assembly 108 supported on the rear frame 104. The machine 100 may also include a first pair of wheels 109 and a second pair of wheels 110 supported by the front axle assembly 107 and the rear axle assembly 108, respectively.
The machine 100, in some embodiments, may also include a lift arm 116, typically, supported on the front frame 102. As illustrated, the lift arm 116 has a first end portion 117 that is pivotally mounted to the front frame 102 and a second end portion 118 that mounts a hydraulically controlled tool 120, hereinafter simply referred to as “tool 120.” The lift arm 116 may move in a generally vertical plane by a pair of lift cylinders 122 (one shown in
The machine 100 can also include a steering system 128 to control an articulation of the front frame 102 with respect to the rear frame 104 about the vertical axis ‘A.’ Referring to
As illustrated in
Referring to
It may be contemplated that the operations of the machine 100 may be controlled by a driver/operator thereof, usually present in the operator station 138, although the concepts in the present disclosure may also be practiced in a machine 100 that is autonomous or remotely controlled. For instance, the driver may provide a driver control input (hereinafter simply referred to as “control input”) to the steering control 140 to command the steering system 128, and thereby provide controlled articulation of the front frame 102 relative to the rear frame 104 about the hitch 106. The driver may achieve this by turning or otherwise moving the steering control 140. It may be understood that the steering control 140 may regulate steering cylinder pressures of the first and second steering cylinders 130, 132 of the steering system 128, and thereby control extension and retraction of the first and second steering cylinders 130, 132, based on the control input. The control input can include values for at least one of an articulation angle, an articulation angular speed, an articulation angle command, one or more steering cylinder pressure, and one or more linkage cylinder pressure; the terms used herein having their usual meanings.
In one embodiment, as illustrated in
The collision mitigation system 400 may also include multiple sensors, such as, capacitive, resistive, potentiometric, piezoelectric, or any other type of electromechanical sensors, associated with various components of the machine 100 for sensing a variety of different parameters in order to assess location of all peripheral points of the machine 100. For instance, the collision mitigation system 400 may include a second sensor system 404 configured to sense real-time articulation angle ‘β’ of the front frame 102 relative to the rear frame 104. The second sensor system 404 may include one or more rotary position sensors, such as, but not limited to, hitch angle sensor using gyroscopes and/or accelerometers, operatively associated with the hitch 106 to determine the articulation angle ‘β.’ Alternatively, the second sensor system 404 may include steering cylinder sensors associated with each of the first and second steering cylinders 130, 132 to determine the steering cylinder pressure values which in turn maybe used to determine the real-time articulation angle ‘β’ of the front frame 102 relative to the rear frame 104. In some examples, the second sensor system 404 may further utilize a sequence of values of the determined real-time articulation angle ‘β’ to calculate an articulation rate, i.e., the rate of change of the articulation angle ‘β’ in the machine 100, in any known manner. Further, the collision mitigation system 400 may include a third sensor system 406 configured to sense real-time rotation of the first and second pair of wheels 109, 110. The third sensor system 406 may include one or more rotation sensors separately associated with each of the first pair of wheels 109 and the second pair of wheels 110 to determine position and speed, of the wheels 109, 110. Furthermore, the machine 100 may, in some embodiments, include a fourth sensor system 408 configured to sense real-time position of the hydraulically controlled tool 120 therein. The fourth sensor system 408 may include one or more rotary position sensors, such as, but not limited to, gyroscopes and/or accelerometers operatively associated with the lift arm 116 to determine an angle, and thereby the position of the hydraulically controlled tool 120 with respect to the body 101 of the machine 100. Alternatively, the fourth sensor system 408 may include a linkage cylinder sensor (not shown) associated with the linkage cylinder 126 to determine the linkage cylinder pressure which may be used to determine the position of the hydraulically controlled tool 120 with respect to the body 101 of the machine 100.
In some embodiments, the collision mitigation system 400 may include real time processing circuitry 410, hereinafter simply referred to as “controller 410.” The controller 410 may be disposed in signal communication with each of the first sensor system 402, the second sensor system 404, the third sensor system 406 and the fourth sensor system 408. The controller 410 may be a logic unit using one or more integrated circuits, microchips, microcontrollers, microprocessors, all or part of a Central Processing Unit (CPU), Graphics Processing Unit (GPU), Digital Signal Processor (DSP), Field Programmable Gate Array (FPGA), or other circuits suitable for executing instructions or performing logic operations. Other peripheral circuitry such as buffers, latches, switches and so on may be implemented within the controller 410 or separately as desired. Various other circuits may also be associated with the controller 410, such as power supply circuitry, signal conditioning circuitry, solenoid driver circuitry, and other types of circuitry. Further, the collision mitigation system 400 can include a memory 412 in communication with the controller 410 and configured to store program instructions and sensor signals. The memory 412 may include a non-transitory computer readable medium, such as RAM, ROM, a flash memory, a hard drive, etc. The memory 412 may further be configured to store electronic data associated with operations of the machine 100.
In some embodiments, the controller 410, in the collision mitigation system 400, may be configured to determine a safe-zone around the machine 100 based on signals from the first sensor system 402 corresponding to sensed objects around the machine 100. As used herein, the “safe-zone” may be defined as a region around the body 101 of the machine 100 within which the components located at extreme peripheral points thereof can move or articulate without a risk of colliding with any external object. It may be understood that the safe-zone may be in the form of a three-dimensional envelope around the machine 100. In some implementations, the safe-zone may define a maximum angle of articulation of the machine 100 represented, for example, by a solid line 310 in
Further, the controller 410, in the collision mitigation system 400, may be configured to determine a position and velocity of one or more peripheral points on the machine 100 based on signals from the second sensor system 404, the third sensor system 406, and the fourth sensor system 408. The term “peripheral points,” as used herein, is any point located on outer or extreme edges of the body 101 of the machine 100; for example, in particular, lateral edges of the tool 120 as the front frame 102 is articulated with respect to the rear frame 104. It may be contemplated by a person skilled in the art that the position and velocity of the one or more peripheral points may be determined by considering the articulation angle ‘β’ and the articulation rate of the front frame 102 with respect to the rear frame 104 (as determined by the second sensor system 404), the movement of the machine 100 (as determined by the third sensor system 406), and further real-time position of the tool 120 (as determined by the fourth sensor system 408).
Further, the controller 410, in the collision mitigation system 400, may be configured to receive the control input, as provided by the steering control 140. In some implementations, the controller 410 may also receive a steering angle signal representative of a steering angle (which may be equivalent to the articulation angle ‘β’), a steering rate signal representative of a rate at which the steering angle is changing (which may be equivalent to the articulation rate), wheel rotation signals representative of motion of the wheels 109, 110, and a plurality of cylinder pressure signals representative of pressure of respective steering cylinders 130, 132 (which may be equivalent to the steering cylinder pressure).
Furthermore, the controller 410, in the collision mitigation system 400, is further configured to apply a limit to the control input when at least one peripheral point on the machine 100 is expected to be within a predetermined distance to a nearest edge of the safe-zone. The limit may be applied by limiting articulation between the front frame 102 and the rear frame 104 of the machine 100. In general, the controller 410 determines impending collision between one or more peripheral points in the machine 100 and the external object 302. In one example, the controller 410 may implement torque or speed reduction control at the hitch 106 to reduce the rate of articulation of the front frame 102 relative to the rear frame 104 about the hitch 106. In other examples, the controller 410 may implement torque or speed reduction control at the hitch 106 to provide a hard stop on the articulation of the front frame 102 relative to the rear frame 104 about the hitch 106. The limit to the control input, or the torque reduction, is implemented in a manner such that the movement of the one or more peripheral points (having a risk of collision with the external object 302) on the body 101 is restricted within the safe-zone in order to avoid impending collision; or at least the velocity of such peripheral points is reduced to mitigate the impact of collision between the machine 100 and the external object 302, for example if the machine 100 could not be stopped within the safe-zone. It may be understood that the controller 410 may compute the necessary torque reduction amount from the articulation characteristics of the machine 100. Further, the controller 410 may reduce the torque or speed by the computed amount, for instance, by modulating the powertrain 111 and/or the steering system 128 of the machine 100. For example, as shown in
In one embodiment, the controller 410 may be able to dynamically adjust the limit on the control input by considering the real-time signals from the sensors systems 402, 404, 406, 408. For instance, if an external object moves within a pre-calculated safe-zone while the front frame 102 is articulating with respect to the rear frame 104 (as determined by the first sensor system 402), the controller 410 may dynamically update the boundaries of the safe-zone in consideration of the newly moved external object 302 within proximity of the machine 100.
In some examples, the controller 410 may further include a feedback unit (not shown) for an operator of the machine 100, as one of the interface devices in the operator station 138. The feedback unit may be in the form of a warning light to notify the operator in advance, for example, that torque or speed reduction is being implemented because an impending collision with an external object 302 has been determined. In some examples, the controller 410 may further include a computing unit (not shown) which may record and/or transmit to a remote location, in real time or in a batch, the number of all collisions that had been avoided at various locations of the worksite 300. This may help to develop a better navigation plan of the machine 100 in order to avoid such obstacles during operation in the worksite 300. The controller 410 may further record and/or transmit magnitude of the contact between the body 101 and the external object 302, in cases when the collision could not be prevented, based on velocity of the machine's travel.
Machines having independent front and rear frames, articulated with respect to each other about a vertical axis, are widely used in off-road industries. For example, many wheel loaders are articulated machines that steer at least by “bending” the front and/or rear frames with respect to each other (and not by directly “turning” the wheels in some instances). In such machines, as the articulation between the front frame and the rear frame increases, a clearance distance required for completing a turn may approach up to at least half the machine's length. This large reconfiguration of the machine's safe operating zone may, sometimes, be hazardous in confined areas, whether it is in close proximity with surrounding external objects including, but not limited to, other working machines, buildings and rocks. This may introduce difficulties or unanticipated interactions with the surrounding objects and collisions during executing a turn or operation in such machines.
The present disclosure provides a collision mitigation system 400 which acquires information relating to articulation angle of the machine 100, implement arm geometry and external obstacles using various sensors and in case of an impending collision with an external object, like the external object 302, a steering override is performed by the collision mitigation system 400 either to avoid collision by limiting articulation or mitigate the force of impact of the collision by reducing the articulation rate. A main concept relates to an ability to override or alter an operator's steering command (via electro-hydraulic or all electric steering) with the knowledge of external objects in close proximity to the machine 100 (via the first sensor system 402) as well as the articulation angle of the machine 100 (via the second sensor system 404 and the third sensor system 406) and implement arm geometry (via the fourth sensor system 408), to avoid or reduce collision impact. Specifically, the controller 410 keeps track of the structure as well as the location of the peripheral points of the machine 100 in space, e.g. of the tool 120. If an external object, like the external object 302 entered into the safe zone, the controller 410 would determine the remaining angle that the machine 100 can still safely articulate without making contact. If the operator of the machine 100 gave or gives a control input that may cause a collision with the external object 302, the controller 410 takes an action to alter the control input to either avoid contact by limiting articulation, or mitigate the force of impact by reducing the articulation rate as the machine 100 approached the external object 302.
The working of the collision mitigation system 400 is represented in the form of a flowchart 500 in
The systems and methods of the present disclosure can prevent possible collisions of the machine 100, or at least reduce the impact of the collisions, with any external object 302 while articulating in the worksite 300. Thereby, embodiments of the present disclosure may reduce or altogether eliminate damage to the machine 100, such as frame damage, axle bending, and/or damage to hydraulic lines. Simultaneously, the embodiments of the present disclosure increase the safety of the operator inside the machine 100 and all those in proximity to the machine 100. Further, the embodiments of the present disclosure allows the operator to perform the steering operation with more ease and precision, and also reduce operator fatigue, as the operator could stay sufficiently confident that the present system may avoid possible collisions if anything goes wrong; and thus it may be contemplated that the present systems may also possibly help with training of inexperienced operators. Furthermore, the embodiments of the present disclosure allow the machine 100 to operate in confined spaces or tight quarters of the worksite 300, thereby improving overall machine's efficiency.
While aspects of the present disclosure have been particularly shown and described with reference to the embodiments above, it will be understood by those skilled in the art that various additional embodiments may be contemplated by the modification of the disclosed machines, systems and methods without departing from the spirit and scope of what is disclosed. Such embodiments should be understood to fall within the scope of the present disclosure as determined based upon the claims and any equivalents thereof.
| Number | Name | Date | Kind |
|---|---|---|---|
| 7721842 | Forero | May 2010 | B2 |
| 20060130750 | Ishikawa | Jun 2006 | A1 |
| 20080053741 | Forero | Mar 2008 | A1 |
| 20130191000 | Hahne | Jul 2013 | A1 |
| 20170329334 | Kashiwagi | Nov 2017 | A1 |
| Number | Date | Country |
|---|---|---|
| 104691616 | Jun 2015 | CN |
| Number | Date | Country | |
|---|---|---|---|
| 20180170369 A1 | Jun 2018 | US |
