AUTONOMOUS LOADING VEHICLE CONTROLLER

Description

Field

[0001] This invention relates to control of excavation/loading vehicles. In particular, this invention relates to autonomous or semi-autonomous control of excavation/loading vehicles.

Background

[0002] Autonomous (or robotic) excavation/loading vehicles are of interest in the mining and construction industries, where the aim is to remove operators from hazardous environments, improve machine utilization and productivity, and reduce maintenance costs. Autonomous excavation is also of interest in lunar or planetary exploration, where excavation cannot easily be carried out by remote control.

[0003] US6233511B1 describes a controller according to the preamble of claim 1 which permits an operator to coordinate the motion of two axes of a work implement such as the arm and bucket motions of a loader.

[0004] In mining and construction, autonomous excavation commonly involves excavation in fragmented rock using a load-haul-dump (LHD) machine. What makes robotic excavation challenging is the nature of the bucket-rock interactions. Performance is strongly influenced by the conditions of interaction between the machine and its environment. For example, the resistance faced by a bucket as it attempts to penetrate a rock pile may vary significantly depending upon the properties of the media (e.g., density and hardness), the rock pile geometry, and the distribution of rock particle sizes and shapes. Indeed, it would be very difficult to predetermine the exact nature of future bucket-rock interactions prior to the execution of any particular excavation operation.

[0005] Previous work attempted to automate excavation by using a controller and forces sensed at the bucket to shift between discrete dig paths to excavate a rock pile, or using a compliance controller to dig through soil targets. Both of these controllers were only tested in relatively homogeneous materials, and they did not perform well when sub-surface irregularities were encountered. Hence they were poorly suited for autonomous excavation of typical rock piles, and in real world situations where subsurface obstacles are frequently encountered. Other work using a fuzzy logic behaviour-based controller produced inconsistent results, and is difficult to implement and support as a commercial product. An admittance-based controller using sensed forces to regulate the velocity of the bucket actuator has been proposed, but was never implemented or tested.

Summary

[0006] Described herein is a dig controller for controlling interaction of an autonomous mining, construction or exploration or semi-autonomous loading vehicle (ALV), through a bucket movably attached to the ALV, with a rock pile, comprising: at least one controller that controls the bucket and/or the ALV in accordance with at least one sensor signal, wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile during a dig; wherein the at least one sensor signal is obtained from at least one sensor associated with one or more actuators on the ALV, other than a bucket actuator, or one or more movable actuated elements acted upon by the actuators,.wherein, the at least one controller comprises at least one adaptive admittance controller, which adaptive admittance controller maps a force signal obtained from one or more of the sensors to a change in bucket motion; and wherein the adaptive admittance controller implements a linear or non-linear movement control scheme for one or both the ALV and bucket in accordance with a predetermined, but tunable, bucket-loading algorithm.

[0007] In one embodiment, the dig controller further comprises at least one iterative learning controller (ILC) that uses feedback from at least one previous dig to modify the at least one sensor signal provided to the at least one controller.

[0008] The ALV, at least one controller that controls a bucket and/or the ALV in accordance with at least one sensor signal, wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile during a dig; and at least one ILC that uses feedback from at least one previous dig to modify the at least one sensor signal provided to the at least one controller.

[0009] In one embodiment, the at least one sensor signal is obtained by measuring a force received by a boom actuator. In another embodiment, the at least one sensor signal is obtained by measuring a force received by an actuated element.

[0010] In one embodiment, an admittance controller may control velocity of the bucket. An adaptive admittance controller may dynamically adjust at least one parameter in response to a difference between a sensor signal and a desired signal.

[0011] In one embodiment, the at least one controller maps one or more sensor signals to a range of possible bucket velocities or ALV velocities by using at least one of proportional, integral, and derivative control.

[0012] In one embodiment, the at least one controller may map a total force error to a range of possible sensed forces using at least one of proportional, integral, and derivative control. In another embodiment, the at least one ILC may map a signal from a previous dig to changes in dig controller response using at least one of proportional, integral, and derivative control.

[0013] In one embodiment, the dig controller may modify the at least one sensor signal provided to the controller such that bucket velocity or ALV velocity are changed.

[0014] In one embodiment, the dig controller may comprise at least one position controller that controls at least one of movement of the bucket of the ALV to at least one selected pose, and movement of the ALV relative to the rock pile. In another embodiment, the dig controller may comprise a first velocity ILC that perturbs an ALV velocity based on a sensor signal representative of interaction between the bucket and the rock pile during at least one previous dig, and a second ILC that modifies a sensor signal derived from boom and bucket force error measurement of at least one previous dig.

[0015] In another embodiment, the dig controller may comprise a first ILC that modifies a sensor signal being provided to a boom admittance controller, and a second ILC that modifies a sensor signal being provided to a bucket admittance controller, wherein modifying is based on feedback from at least one previous dig.

[0016] Also described herein is programmed media for use with an ALV dig controller comprising a computer, the programmed media comprising: a computer program stored on non-transitory storage media compatible with the computer, the computer program containing instructions to direct the computer to perform one or more of: receive at least one sensor signal from at least one sensor associated with one or more actuators other than a bucket actuator, or one or more actuated elements; wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile during a dig; and control the bucket and/or the ALV in accordance with the at least one sensor signal.

[0017] Also described herein is programmed media for use with an ALV dig controller comprising a computer, the programmed media comprising: a computer program stored on non-transitory storage media compatible with the computer, the computer program containing instructions to direct the computer to perform one or more of: control a bucket and/or the ALV in accordance with at least one sensor signal, wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile during a dig; and direct an ILC to use feedback from at least one previous dig to modify the at least one sensor signal; wherein modifying the at least one sensor signal changes the control of the bucket and/or the ALV.

[0018] Also described herein is a method of controlling an ALV, comprising: obtaining at least one sensor signal from at least one sensor associated with one or more actuators other than a bucket actuator, or one or more actuated elements; wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile during a dig; and controlling the bucket and/or the ALV in accordance with the at least one sensor signal.

[0019] Also described herein is a method of controlling an ALV, comprising: controlling a bucket and/or the ALV in accordance with at least one sensor signal, wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile during a dig; and modifying the at least one sensor signal using at least one ILC that incorporates feedback from at least one previous dig; wherein modifying the at least one sensor signal changes the control of the bucket and/or the ALV.

[0020] In one embodiment the method may include modifying the at least one sensor signal provided to the controller such that bucket velocity or ALV velocity are changed. Controlling may further comprise dynamically adjusting at least one parameter in response to a difference between a sensor signal and a desired signal.

[0021] The method may further comprise controlling at least one of movement of the bucket of the ALV to at least one selected pose, and movement of the ALV relative to the rock pile. The method may further comprise perturbing an ALV velocity based on a sensor signal representative of interaction between the bucket and the rock pile during at least one previous dig, and modifying a sensor signal derived from boom and bucket force error measurement of at least one previous dig. The method may further comprise modifying a sensor signal being provided to a boom admittance controller, and modifying a sensor signal being provided to a bucket admittance controller, wherein modifying is based on feedback from at least one previous dig.

[0022] In one embodiment, controlling may include mapping a total force error to a range of possible sensed forces using at least one of proportional, integral, and derivative control. The method may further comprise mapping a signal from a previous dig to changes in dig controller response using at least one of proportional, integral, and derivative control.

[0023] In another embodiment, the payload may be controlled based on a parameter of a breakout condition, or by modifying such a parameter.

Brief Description of the Drawings

[0024] For a greater understanding of the invention, and to show more clearly how it may be carried into effect, embodiments will be described, by way of example, with reference to the accompanying drawings, wherein:

Fig. 1A is a schematic diagram of an ALV;

Figs. 1B-1D are schematic diagrams of an ALV during three dig phases corresponding to entry (Fig. 1B), digging (Fig. 1C), and breakout (Fig. 1D);

Figs. 2A and 2B are block diagrams of generalized dig controller embodiments;

Fig. 3A is a block diagram of an admittance dig controller according to an embodiment;

Fig. 3B is a block diagram of an example of dig logic used in dig controller embodiments;

Fig. 3C is a block diagram of a dig controller according to one embodiment that includes an admittance controller;

Fig. 3D is a block diagram of a dig controller according to one embodiment that includes an iterative learning controller (ILC);

Fig. 3E is a block diagram of a dig controller according to another embodiment that includes an iterative learning controller;

Figs. 4A and 4B are block diagrams showing generation of boom and bucket correction forces according to embodiments;

Figs. 4C and 4D are block diagrams showing generation of entry throttle correction according to embodiments;

Fig. 5 is a plot showing dig efficiency points for 57 dig attempts using the experimental setup of Example 1;

Figs. 6A and 6B are plots showing boom and bucket desired force profiles, respectively, and the target forces (in boxes) used by boom and bucket admittance controllers in an embodiment described in Example 2;

Fig. 7 is a plot showing desired and actual boom entry force rate of change, according to an embodiment described in Example 2; and

Fig. 8 is a plot showing boom and bucket desired forces used to calculate total error for each dig attempt (dark shading for negative error; light shading for positive error), for the embodiment described in Example 2.

Detailed Description of Embodiments

[0025] As used herein, the term "autonomous loading vehicle" (ALV) is intended to refer generally to an autonomous, semi-autonomous, or robotic excavator machine or load-haul dump (LHD) vehicle used in accordance with the embodiments described herein.

[0026] As used herein, the term "actuator" is intended to refer to a component of the ALV that causes a change in vehicle configuration and/or motion. An actuator may carry out a function based on a command from a controller. For example, vehicle configuration may include position and/or orientation of a boom or dig tool, and/or position and/or orientation of the ALV.

[0027] As used herein, the term "actuated element" is intended to refer to a component of the ALV that is acted upon by an actuator, such as, for example, a boom or a dig tool, or actuator not currently receiving a command but being acted on by another actuator.

[0028] As used herein, the term "bucket" is intended to refer generally to a dig tool of an ALV, which may comprise a bucket, blade, chisel, fork, probe, bit, or other, as known in the art.

[0029] As used herein, the term "rock pile" is intended to refer generally to the material being loaded by the ALV. It is to be understood that the material may be of any type or composition as may be associated with excavation, construction, mining, and exploration, such as, but not limited to, soil, sand, gravel, ore, slag, salt, fragmented rock, regolith, or any combination thereof.

[0030] As used herein, the term "dig" is intended to refer generally to the actions performed by an ALV to carry out a desired function using its bucket. For example, a desired function may be to fill the bucket with material from the rock pile, wherein "dig" may be considered equivalent to "excavate". However, other actions (e.g., "load") may also be performed, and may optionally involve other dig tools. The dig actions of the ALV are controlled by dig controller embodiments described herein.

[0031] As used herein, the term "modify" means to change, adjust, or alter a magnitude or value, such as to increase or decrease a magnitude or value. The magnitude or value may pertain to a sensor signal. Modifying may be performed according to a mathematical operation or function, and/or may be performed in respect of a constant.

[0032] The dig controller embodiments for ALVs described herein provide efficient autonomous excavation in a wide range of materials in applications such as mining, construction, and exploration. The embodiments are particularly effective in rock piles including randomly sized fractured rock, which may be encountered in applications such as, for example, mining and construction.

[0033] A generic ALV is shown in Fig. 1A. Referring to Fig. 1A, the ALV includes a bucket 1 attached to a boom 2. The bucket is moved by actuating a bucket linear actuator 3 (curl), while the boom is moved by actuating a boom linear actuator 4 (hoist). These actuators, which may be electric, hydraulic, pneumatic, or a combination thereof, may be equipped with linear sensors or angular encoders to determine the configuration and/or motion of the bucket. Each actuator has a cylinder side and a rod side, shown as 7 and 8, respectively, for the bucket actuator 3. The boom and bucket actuators 4, 3, respectively, are connected to a vehicle 5 that can drive the boom and actuators to a desired location within the workspace. During loading, the vehicle drives the boom and bucket forward into the rock pile 6 (e.g., Fig. 1B). The interaction between the bucket and the rock pile (e.g., Fig. 1C) causes changes in pressure on both the cylinder side 7 and rod side 8 of both linear actuators (e.g., Fig. 1D), until the bucket is extracted from the rock pile.

[0034] Throughout the block diagrams of Figs. 2A, 2B, 3A-3E, and 4A-4D, descriptions of signals are provided in blocks with dashed lines. Generally, with reference to the block diagram of Fig. 2A, an ALV 10 interacts with a rock pile 6. Sensors produce sensor signals 14 representative of interaction between the bucket and the rock pile (e.g., reaction forces 40) and signals representative of motion of one or more bucket actuators 50. The sensors signals may be generated using one or more sensor or a combination of sensors selected from, but not limited to, accelerometer, force sensor, pressure sensor, torque sensor, load cell, and strain gauge. Bucket velocity may be sensed using one or more sensor or a combination of sensors, transducers, and the like selected from, but not limited to, accelerometer, linear variable differential transformer, wave reflection measurement (e.g., sonar, laser, infrared, video, optical encoder), and potentiometer (e.g., string, linear, or angular). The sensor signals are used by the dig controller 20, together with parameters 16 such as target forces 12, to generate control signals 18 that control the ALV.

[0035] Dig controller embodiments may include or utilize a sensing system 30 and controllers to control digging behavior of the ALV. Further detail is shown in the generalized embodiment block diagram of Fig. 2B. The sensing system 30 includes at least one sensor 32 and optionally a signal conditioner 34 that provides a sensor signal as input to the dig controller 20, which may include a logic device 22 and memory 24. Manual controls 26 and an operator interface 28 may also be provided. One or more sensors may be associated with an actuated element 64 of the ALV. For example, the controllers may include an actuator control device 60 to move the boom and bucket actuators 62 to an entry pose, to drive the ALV into the rock pile, and control forward motion of the ALV throughout the dig. The sensing system may detect that a force threshold is reached (e.g., 40 in Fig. 2A), upon which the dig controller 20 may use admittance controllers in an actuator control device 60 to regulate the velocity of the boom and/or bucket actuators 62 in response to the sensed forces. The sensing system may detect that the bucket actuator is fully extended (e.g., 50 in Fig. 2A), whereupon the forward motion of the ALV may be halted, and a position controller may be used to raise the boom to a weighing pose. The sensing system 30 may include at least one linear or angular sensor for each actuator (e.g., boom and bucket), and at least one force sensor for each actuator. In one embodiment, the force sensors include one or more pressure sensors on each actuator (e.g., one on the cylinder side, and one on the rod side of hydraulic actuators). The sensing system may optionally include a sensor for measuring the forward motion of the ALV. For example, the sensor may include one or more of an angular wheel encoder, an inertial sensor for detecting initial contact with the rock pile, and a vision system for detecting and/or assessing and/or characterizing the surface state of the rock pile. The vision system may include a ranging system capable of generating a 3-D representation of the rock pile surface. The 3-D representation may be used to select a point of contact between the bucket and rock pile such that digging time and effort are minimized. In these embodiments, a controller may include a proportional, integral, or derivative controller, or any combination thereof.

[0036] Dig controller embodiments are shown in Figs. 3A-3E. The dig controller may include one or more admittance controllers 20A (Fig. 3A). Admittance controllers respond to changes in force with changes in velocity. Generally, an admittance controller seeks to maintain a mechanical admittance relationship between the environment (e.g., the rock pile) and a dig tool such that dig tool velocity is altered to achieve a desired environment reaction force. For example, in one embodiment, an admittance controller may map a force signal to a change in bucket motion (e.g., a desired velocity, as shown in Fig. 3C). Sensor signal input to the dig controller may be one or more parameter selected from, or may include all of: entry height, angle, boom force target, throttle, digging boom and bucket force targets, boom and bucket admittance controller gains, breakout condition, and weighing height and angle. For example, in one embodiment, when bucket forces increase, the velocity of the bucket is adjusted to bring the sensed forces within desired values. Use of admittance controllers provides embodiments that are relatively invariant to bucket-rock pile interactions because they regulate force, not position, of the bucket. This dynamic force regulation is particularly desirable for digging through a rock pile with random rock sizes, because pre-determined (i.e., static) path targets would be difficult to follow given the randomly shaped obstacles that may be present in a typical rock pile. Admittance controller parameters may include proportional, integral, or derivative control terms, and a controller may implement a linear or nonlinear control scheme, e.g., according to a mathematical operation or function, and/or according to a constant. An admittance controller may be operated using dig logic 22 such as that shown in the embodiment of Fig. 3B.

[0037] Aggressiveness of an admittance controller may be governed by one or more parameters. In one embodiment, these parameters are the ALV entry throttle and the target force values 12 for the admittance controllers 20A for the boom and bucket. However, excavation efficiency is governed by the controller parameters and unknown rock pile parameters (more generally, the environmental parameters). The unknown rock pile parameters may include, for example, the rock size distribution, the pile shape, rock parameters (shape, Young's modulus, Poisson's ratio, etc.), moisture content, cohesion, and angle of repose, among others. It would be impractical to measure each of these parameters because of their number, and because the rock pile changes so frequently. While equations exist for modelling more homogeneous materials, such as soils, they are generally ill-suited for modelling non-homogeneous and highly variable targets such as fractured rock piles.

[0038] The admittance controller overcomes this problem by treating the rock pile as an unmodelled body that provides changing reaction forces as the bucket passes through the pile. The admittance controller uses these forces to modify the motion of the bucket without explicitly knowing the characteristics of the rock pile. Whereas admittance controllers work well when the controller parameters have been tuned for a current state of the rock pile, they may need to be re-tuned when the rock pile changes significantly. For example, an admittance controller tuned for a wet rock pile may be too aggressive when the pile dries out, resulting in wasted effort and decreased efficiency.

[0039] In some applications or situations the boom actuator may be used to sense the digging force and provide a sensor signal that is used by the controller (e.g., an admittance controller, an adaptive admittance controller) to change the velocity of the bucket. Here, no commands are issued to the boom actuator, and forces sensed in the boom actuator are in response to the interaction between the dig tool and the rock pile. Thus, reaction forces received by the boom actuator provide an indication of the interaction between the dig tool and the rock pile. In this example the bucket actuator receives commands from the controller, and the boom actuator becomes an actuated element because no commands are sent to it by the controller. Alternatively, or in combination with the above, a sensor signal may be obtained by measuring strain in an actuated element, such as a boom.

[0040] It will be appreciated that one or more other elements of the ALV (i.e., other than the boom) could be used together with, or instead of the boom actuator, to provide sensor signal(s) to the controller, and used for controlling the ALV, provided that such one or more other elements are associated with appropriate sensor(s) to generate sensor signal(s) related to a dig parameter such as interaction between the dig tool and the rock pile.

[0041] In certain applications it may be desirable to optimize control of the ALV for less than maximum filling of the bucket. Such an embodiment may, for example, reduce strain on ALV components, thereby reducing down-time for maintenance and associated costs. This may be achieved by controlling the payload based on a parameter of a breakout condition, or by modifying such a parameter.

[0042] In a mining application, for example, rock pile parameters can vary significantly from one dig to the next even if the material being extracted remains of the same type. Admittance control as described herein has proved resilient to such changes; however, significant changes to digging conditions might give rise to a need to re-tune the admittance controller. Constantly tuning the admittance controller would not be practical or desirable. Some embodiments as described herein avoid the tuning problem by including at least one iterative learning controller (ILC) 70, 72, as shown in Figs. 3D and 3E. An ILC modifies the inputs to an admittance controller so that the controller parameters can remain constant while the controller response is altered. For example, as shown in Figs. 3D and 3E, an ILC may modify an input sensor signal, such as force, to an admittance controller, so that a desired dig behaviour is achieved while the entry throttle and force targets remain the same. In one embodiment, for example, Fig. 3E, the degree to which forces are modified is dictated by the force error history from previous dig attempts.

[0043] For example, if a dig attempt is more difficult than a previous attempt, the force error may be large and negative. In this case a large positive corrective force would be added to all forces going into the admittance controller, and the admittance controller would respond more aggressively. An advantage of an ILC is that it allows the algorithm to respond to changing rock pile conditions without having to re-tune (e.g., select constants that optimize performance) the admittance controller. This feature saves time, and eliminates the need for a specialist who would otherwise be needed for the re-tuning process.

[0044] In another embodiment, an adaptive admittance controller may be used. Parameters (e.g., proportional, integral, or derivative control terms) may be tuned or adapted dynamically (e.g., in real time or substantially in real time) to compensate for rapid changes in rock pile characteristics, such as stiffness, during a dig, thereby avoiding the need for modelling the rock pile. For example, an adaptive admittance controller may use the force tracking error to dynamically adjust admittance parameters throughout the dig in real time. In a further embodiment, an adaptive admittance controller may be used together with at least one ILC.

[0045] One embodiment of a dig controller, shown in the block diagram of Fig. 3D, includes two admittance controllers 20A and two ILCs 70, 72. A further embodiment may also include scripted entry and exit controllers. A further embodiment may include a detector for detecting if/when the ALV is stuck. The entry controller moves the boom and bucket actuators to an entry pose (e.g., bucket level with and just above the ground) using, for example, a proportional position controller. The ALV is then commanded to move towards the rock pile at a rate determined by the entry throttle set point, and the bucket engages the rock pile. When the sensed forces exceed a target value the admittance controllers begin moving the boom and bucket actuators. When the bucket has reached its maximum curl an exit controller takes over. The exit controller moves the boom and bucket to a weighing pose (e.g., bucket fully curled and raised above the rock pile) using, e.g., a proportional position controller. When the material in the bucket is weighed, the weight, dig time, and work performed by the actuators is used to assess the success of the dig attempt. An optimum dig maximizes bucket payload while minimizing dig time and work expended. In one configuration the admittance and position controllers operate at high frequency to perform the digging operations, while the ILCs only operate once per dig cycle.

[0046] An admittance controller may implement any mathematical relationship that maps the range of force errors to a range of possible actuator velocities. An admittance controller may modify a parameter, for example, in response to the magnitude of a sensed signal less a desired signal value. Fig. 3E is a block diagram of an admittance controller 20A according to one embodiment. Perturbed forces are used by the admittance controller to publish changes in the boom and bucket actuator velocities. These velocities are integrated to provide a set of desired positions for the boom and bucket actuator position controllers 60. The desired positions are tracked by the position controllers to provide the desired change in actuator length. The change in length causes the bucket to move in the rock pile, which causes the reaction forces to change. This change in force is sensed by pressure sensors 90 and used to calculate the new boom and bucket actuator forces 80. In one embodiment, these updated forces are again perturbed by the admittance ILC before being fed back to the admittance controller. Once a dig attempt is complete the total force error 85 is used to update the force perturbation for the next dig attempt, while the entry throttle ILC adds the new entry slope error to the previous entry slope errors so that the next entry throttle perturbation can be calculated.

[0047] In the embodiment of Fig. 3E, an ILC applies a correction 87 to the default entry throttle based on the entry force slope from several previous dig attempts. Other parameters used are the digging force targets. As shown in the embodiments of Figs. 4A, 4B, 4C, and 4D, the ILCs apply a correction 92 to the sensed forces 94 based on the total force error 96 from several previous dig attempts. For example, in Fig. 4C, while the entry throttle is initially tuned to a set value, the entry throttle is perturbed by the ILC to improve digging efficiency consistency. In Figs. 4C and 4D, the initial force rise for each dig attempt may be represented by the slope of a line passing through the lowest force reading, and the highest force reading, during the entry period (between bucket entry and admittance control). These slopes are compared against an ideal entry force slope to calculate the slope error for each dig attempt. These errors are stored in memory and a specified number n of them are summed. The sum 98 is used by the entry ILC to calculate how the entry throttle should be perturbed for the next dig attempt.

[0048] As shown in Fig. 4A, for example, an ILC may modify incoming forces so that the admittance controllers respond more aggressively. For example, Figs. 4C and 4D show that the ILCs increase the target entry throttle, and artificially increase the incoming forces. The increased values cause the ALV to enter the rock pile at a higher velocity, and curl and hoist the bucket faster. In these examples, increasing the entry, boom, and bucket velocities increases overall dig controller aggressiveness, and decreases digging variability compared to using parameters obtained from a training rock pile.

[0049] Dig controller embodiments may be implemented in analog and/or digital (hardware/software) platforms. Specific implementations may be provided for compatibility with existing control systems, ALVs, sensors, etc., such as may be required to retrofit or upgrade existing systems and ALVs. For example, a dig controller may be implemented in whole or in part using discrete components, using digital technology (e.g., in a digital signal processor (DSP), field programmable gate array (FPGA), or application specific integrated circuit (ASIC) device), or using a combination thereof. One or more components of the dig controller may be implemented in an algorithm using a suitable hardware language such as, for example, very high speed integrated circuit (VHSIC), hardware descriptive language (VHDL), register transfer language (RTL), or Verilog. Such an algorithm may be implemented in, for example, a FPGA or ASIC device, or other suitable logic device. Some embodiments and implementations may include one or more sensors or transducers.

[0050] Embodiments will be further described by way of the following non-limiting Examples.

Example 1

[0051] This example illustrates the design and field testing of an embodiment of a loading algorithm based on admittance control using forces sensed from the bucket-rock interactions to modify the velocity of the bucket during digging. In this example, the loading algorithm (shown below) has three parts corresponding to three dig phases. The three dig phases, entry, digging, and breakout, are shown schematically in Figs. 1B, 1C, and 1D, respectively.

[0052] The entry phase is shown in Fig. 1B. The entry phase ends when the bucket is in the entry position, and the forward motion of the ALV causes the bucket rock reaction forces to rise above a preset value. During the digging phase (Fig. 1C) the admittance controller causes the bucket to curl upwards or downwards to maintain a desired reaction force while the boom is used only to measure the digging reaction forces. The breakout phase (Fig. 1D) starts when the bucket has fully curled, and ends when the bucket is in the weighing position. The admittance controller is the part of the algorithm that governs the motion of the bucket through the rock pile. The admittance controller uses the error between the sensed dig reaction forces and a digging force target to alter the velocity of the bucket actuator. A generalized block diagram for the admittance controller is shown in Fig. 3C. Whereas any controller C can be used to map the force error to the actuator velocities, the admittance controller in this example is one-sided and proportional, such that

where υ_A is the actuator velocity, k_A > 0 is the (admittance) proportional gain, and the force error is given by the target force f_T minus the dig reaction force f_S. For this loader and rock pile, f_T was set at 80 kN, while k_A was set at 1.1 × 10^-7. These values were determined experimentally by adjusting them until the mass of payload in the bucket was high and consistent. The values may also be determined using off-line tuning methods for the admittance controller, wherein the values are calculated based on known vehicle parameters, and average rock pile stiffness. The controller was restricted to only making positive changes to the bucket velocity (i.e., only upward curl was allowed). In this example, this restriction was imposed so that no energy was wasted compressing rock against the underside of the bucket (and to maintain traction of the ALV wheels). However, this restriction is not always necessary, and may be omitted in other embodiments.

[0053] The drive train commands were set such that the loader was driven straight into the rock pile at a constant velocity. The entry position was selected such that the bucket scraped the asphalt substrate to ensure the bucket penetrated the rock pile at entry. The combination of drive train commands and entry pose resulted in substantially consistent penetration depth. After entry, the throttle was set to full to maximize the bucket actuator speed and power while the forward thrust was limited by applying partial brake. The brake level was set such that the forward thrust tended to increase the forces experienced in the actuators, which caused the admittance controllers to attempt to reduce the forces by curling backwards. The forward thrust tends to bias the controller towards the breakout condition ensuring that the dig completes before the bucket forces rise sufficiently to overcome the capacity of the actuators.

Field Test Apparatus and Method

[0054] An automated 1-tonne surface loader and a blasted limestone rock pile were used to test and tune the loading algorithm. The loader was a Kubota R520s that was outfitted for automation by adding sensors, actuators, and on-board computer systems. Only boom and bucket extension and pressure sensors were used for this example. The boom and bucket actuator extensions were measured at 10 Hz by a custom hall effect sensor. Each extension sensor contained two Honeywell SPSL225 contactless IP69 linear encoders mounted in a custom housing. Two Measurement Specialties MSP-400 pressure sensors were installed on the rod and cylinder ports of each actuator so that the net force acting on the actuators could be calculated. The pressure sensor data was captured at 107 Hz by a single Arduino Uno board. The Arduino Uno pressure and actuator extension messages were passed to the main computer over a Robot Operating System (ROS) Electric network. The main computer was a Mini-ITX Intel Core i5 64-bit PC running Ubuntu 11.10, and ROS Electric. The main computer used a ROS network to publish and subscribe to topics over a wireless network. The autonomous loading algorithm was run on a separate Intel Core i5 64-bit laptop (running Ubuntu 11.10, and ROS Electric) connected to the wireless network. This laptop was also used for data collection.

[0055] In the tests, a fully-saturated controller was tested first, followed by an un-saturated admittance controller. One goal of these tests was to determine the difference between curling at maximum velocity and using the admittance controller to match curl velocity to the sensed reaction forces. Once the loading algorithm was tuned for this loader and rock pile, the various loading algorithm parameters were held constant for the dig attempts plotted in Fig. 5.

[0056] Each dig attempt started by manually moving the loader in front of the rock pile. The loading algorithm assumed control of the loader for entry, digging, and weighing. The loader was left in the weighing position for 5 seconds to allow the bucket and payload to stop moving. The payload mass m_P was calculated using Equation (2), and the boom force f_boom in the weighing pose. Equation (2) was determined experimentally by calibrating the loader using known masses.

[0057] The volume of rock within the bucket was also verified by using the video feed from the wireless workstation. The payload was then dumped manually, and the loader was repositioned in front of the rock pile.

Experimental Results

[0058] In total 57 dig attempts were made and the dig efficiencies from each dig are shown in Fig. 5. Of these, 23 dig attempts were conducted by curling the bucket at a maximum rate after entry (saturated digs), and 21 dig attempts were conducted by using a proportional (P) admittance controller, and 13 dig attempts were conducted by using a proportional-integral (PI) admittance controller, to match the bucket velocity to the sensed reaction forces (controlled digs). Five saturated digs, two P controlled digs, and two PI controlled digs failed because the entry forces were insufficient for the saturated or un-saturated admittance controllers to take control of the dig. Saturated dig 18 (S 18) and P controlled dig 11 (P11) took 30 seconds longer than average due to wireless network issues, and low rock pile entry respectively. The PI controller digs achieved 9% more payload and took 2 s longer than the fully saturated digs. Average saturated (S 1 1), P controlled (P7), and PI controlled (PI68) dig attempts are presented, followed by the slow digs (S 18 and P11), a high work dig (PI71), and two failed digs (S8 and P6).

[0059] When considering the actuator positions, valve commands (based on valve positions), and actuator forces for the nominal digs (S 11 and P7), the valves on the loader have a deadband between ± 0.5. No fluid can flow to the actuators for any commanded valve positions within the deadband, hence any command within the deadband can be treated as zero valve displacement (a closed valve). The saturated dig curls the bucket at maximum velocity and the forces oscillate severely. In the controlled dig, the admittance controller alters the curl velocity in response to the changing forces resulting in less severe force changes.

[0060] For the slow digs (S18 and P11), the lack of actuator response to the full valve commands, and the high forces (well above both the entry and digging targets) in S 18 indicated a network communication issue between the loader computer and the laptop running the loading algorithm. The force profile does show the level of force imparted to the pile by the drive train when the bucket stops moving, and the final payload mass indicates that the bucket was filled by the end of the dig. P11 is more interesting because the forces are very close to the 80 kN force target throughout the dig. When the forces rise above the target the admittance controller curls the bucket, which causes the forces to drop and allows the vehicle to penetrate deeper into the pile. When the loader stalls against the pile the forces rise, and another curl command is sent.

[0061] The command and force histories for the failed digs (S8 and P6) show that the forces never rose above the entry force, so the bucket controller was never activated, and the digs failed. The forces were likely low due to the bucket hitting the ground and unloading the front wheels. Unloading the front wheels decreases the thrust and dig reaction forces.

[0062] Work and dig time were calculated between entry (after the entry force target is reached), and breakout (when the bucket curls past the breakout condition). "Instantaneous" work (only the current force reading is used) was calculated by using Equation (3), where W_d is the work performed by the actuators, F_h and F_c are the hoist and curl forces in the boom and bucket actuators, respectively, and d_h and d_c are the displacements for each actuator. Let n be the total number of sensor readings and let the subscript i denote the time index associated with each sensor reading. Thus, instantaneous work was calculated as:

[0063] The average dig efficiency values are given for both the saturated and P controlled digs in Table 1. The dig time rose dramatically when the bucket was controlled by the P admittance controller compared to when the bucket was moved at its maximum rate. However, all controlled digs were more consistent than the saturated digs, and the payload mass was increased by 10 %.

Table 1. Saturated and P controlled dig efficiency averages

εd	Saturated	Controlled	Difference
td [s]	7.0±12.3	24.3±11.2	+247%
Wd [N m]	729±176	444±107	-61%
Md [kg]	654±384	721±170	+10%

[0064] Total work was calculated using Equation (4), where both the current force and last force readings are used in the total work equation:

[0065] The results are presented in Table 2.

Table 2. Saturated, P controlled, and PI controlled dig efficiency averages

All digs
εd	Saturated	Difference	P Controller	Difference	PI Controller
td [s]	6.5±12.1	+277 %	24.5±11.3	-33 %	8.1±5.0
Wd [N m]	24 458±8 495	+15 %	28 145±6 711	-3 %	27 287±14 511
Md [kg]	721±326	0.2 %	719±170	+10 %	792±335

Without failed digs
td [s]	6.2±12.G	+315 %	25.7±10.1	-37 %	9.6±3.8
Wd [N m]	25 658±8 697	+15 %	29 551±1 929	+8 %	32 246±8 766
Md [kg]	784±254	-3 %	755±40	+ 22 %	924±85

Example 2

[0066] Key parameters for the entry and digging phases of an ALV may be identified as the entry throttle and the boom and bucket force targets. Desired force profiles, such as shown in Figs. 6A and 6B, may be used as basis for dividing a loading ILC into two parts: the entry ILC that governs the entry throttle; and the admittance controller ILC that modifies the sensed forces going into the admittance controllers.

Entry ILC

[0067] The entry ILC compared the slope of the boom entry force profile to the slope of the desired entry force profile as shown in Fig. 7. A force rise below 100 kN/s indicates that the rock pile provided less resistance than a training rock pile, while a force rise above this target indicates a more resistive pile. Compensation for a less resistive pile may be achieved by adjusting the entry throttle according to the relationship shown in Equation 5.

[0068] In Equation (5), Γ_entry is any desired controller that maps the entry slope error e_{entry slope} to a throttle increment, referred to as the entry throttle correction C_{Entry throttle}. The simplest controller is a proportional controller entry that linearly maps slope error to a throttle correction increment. i is the number of dig cycles to consider. ω_i is an optional weight applied to each entry slope error. This weight term can be used to bias the correction towards a desired set of entry slope error readings. For instance, the most recent entry slope errors are likely to best represent the current state of the rock pile. For example, a weight that exponentially decreases with respect to i may be used to apply the largest weights to the most recent tests.

[0069] Equation 6 shows a specific instance of the entry ILC where slope errors from five dig attempts are multiplied by an exponentially decreasing weight, and summed before being multiplied by a proportional gain entry.

[0070] After five additional dig attempts the initial correction would be forgotten, and the current correction would be based on the five more recent entry slopes. A similar ILC is used to apply a correction to the sensed forces going into the admittance controllers.

Admittance ILC

[0071] The admittance ILC compares the calculated forces to the desired forces, and uses the result to modify the forces used by the admittance controllers. An example force profile is shown in Fig. 8. The total error between the sensed forces and the desired forces e_{F Net} is calculated using Equation 7.

[0072] Again, the integral of the force difference (F_Desired - F_Sensed) is taken over the digging duration between t_Start and t_End. The admittance ILC correction to the sensed forces C_{Sensed forces} is calculated using Equation 8.

[0073] Again, an exponentially decaying term is used to bias the correction towards the five most recent dig attempts, but any number of dig attempts can be considered, and all could have equal weight. γ_admittance is the admittance ILC gain. Any general controller Γ_admittance could be used instead of the proportional controller γ_admittance.

[0074] An advantage of the ILCs is that once the admittance controller parameters are tuned for a given vehicle and rock pile they need never be tuned again. The ILCs discussed in this section have only two parameters each: the number of previous dig attempts i, and the ILC gains y. Another way to view the ILC gains is in terms of the aggressiveness of the entire digging algorithm (admittance and ILC controllers).

[0075] If the ILC gains are high the admittance controllers will respond more aggressively to changes in the rock pile, and if the ILC gains are low the controllers will respond less aggressively. This level of control is perfect for operators since it is a single value that can be tuned based on the overall loading goals. If an LHD payload is below the desired mass flow rate of the mill the operator can increase the aggressiveness of the controller by increasing the ILC gains. If the mass flow rate exceeds what the mill can handle, the ILC gains can be reduced, e.g., to save on tire wear and fuel consumption.

Equivalents

[0076] Those skilled in the art will recognize or be able to ascertain variants of the embodiments described herein. Such variants are within the scope of the invention and are covered by the appended claims.

Claims

1. A dig controller (20) for controlling interaction of an autonomous mining, construction or exploration loading vehicle (ALV) (5, 10) through a bucket movably attached to the ALV, with a rock pile, comprising:

at least one controller controls the bucket (1) and/or the ALV in accordance with at least one sensor signal (14), wherein the at least one sensor signal is representative of interaction between the bucket and the rock pile (16) during a dig;

whereby the at least one sensor signal is obtained from at least one sensor (32) associated with one or more actuators on the ALV, other than a bucket actuator, or one or more moveable actuated elements actuated upon by the actuators,

characterised in that the at least one controller comprises at least one adaptive admittance controller, which adaptive admittance controller maps a force signal obtained from one or more of the sensors to a change in bucket motion; and

wherein the adaptive admittance controller implements a linear or non-linear movement control scheme for one or both the ALV and bucket in accordance with a predetermined, but tunable, bucket-loading algorithm.

2. The dig controller of claim 1, wherein the bucket loading algorithm comprises parts corresponding to predetermined dig phases that include entry, digging, and breakout of a loaded bucket.

3. The dig controller of claim 1, wherein a final bucket payload is adjusted by modifying a parameter corresponding to a breakout phase of a dig.

4. The dig controller of claim 1, wherein the at least one sensor signal is obtained by measuring a force received by a boom actuator (4).

5. The dig controller of claim 1, wherein the at least one sensor signal is obtained by measuring a force received by an actuated element.

6. The dig controller of claim 1, wherein the adaptive admittance controller dynamically adjusts at least one parameter in response to a difference between the sensor signal(s) and a desired signal.

7. The dig controller of claim 1, wherein the at least one adaptive admittance controller maps one or more sensor signals to a range of possible bucket velocities or ALV velocities by using at least one of proportional, integral, and derivative control.

8. The dig controller of any one of claims 1 to 7, further comprising at least one iterative learning controller (ILC) (70,72) that uses feedback from at least one previous dig to modify the at least one sensor signal provided to the at least one adaptive admittance controller.

9. The dig controller of claim 8, wherein the ALV comprises a moveable boom and a bucket movable attached to the boom, wherein the dig controller further comprises a first velocity ILC (70,72) that perturbs an ALV velocity based on a sensor signal representative of interaction between the bucket and the rock pile during at least one previous dig, and a second ILC that modifies a sensor signal derived from boom and bucket force error measurement of at least one previous dig.

10. The dig controller of claim 8, including a first ILC that modifies a sensor signal being provided to a boom admittance controller, and a second ILC that modifies a sensor signal being provided to a bucket admittance controller, wherein modifying is based on feedback from at least one previous dig.

11. The dig controller of claim 8, wherein the at least one ILC maps a signal from a previous dig to changes in dig controller response using at least one of proportional, integral, and derivative control.

12. A method of controlling an autonomous loading vehicle (ALV) (5, 10) having a movable bucket, comprising:

causing the bucket to engage and interact with a rock pile;

obtaining during interaction of the bucket with the rock pile at least one sensor signal (14) from at least one sensor associated with one or more actuators, other than a bucket actuator (3) , or one or more actuated elements at or of the ALV which are actuated by respective one of the actuators;

and using a dig controller in accordance with any one of claims 1 to 11 in controlling movement of the bucket and/or the ALV in accordance with the at least one sensor signal during interaction with the rock pile.

13. The method of claim 12, comprising obtaining the at least one sensor signal (14) by measuring a force applied by a boom actuator to a boom with the bucket, or by measuring strain in the actuated element.

14. The method of claim 12, including modifying the at least one sensor signal provided to the dig controller such that bucket velocity or ALV velocity are changed.

15. The method of claim 12, wherein controlling further comprises dynamically adjusting at least one parameter in response to a difference between the sensor signal and a desired signal.

16. The method of claim 12, further comprising controlling at least one of movement of the bucket of the ALV to at least one selected pose, and movement of the ALV relative to the rock pile.

17. The method of claim 12, wherein the bucket is attached to a boom of the ALV, the method further comprising perturbing an ALV velocity based on a sensor signal representative of interaction between the bucket and the rock pile during at least one previous dig, and modifying a sensor signal derived from boom and bucket force error measurement of at least one previous dig.

18. The method of claim 12, wherein the bucket is attached to a boom of the ALV, the method further comprising modifying a sensor signal being provided to a boom admittance controller controlling the boom, and modifying a sensor signal being provided to a bucket admittance controller of the bucket, wherein modifying is based on feedback from at least one previous dig.

19. The method of claim 12, wherein controlling includes mapping a total force error to a range of possible sensed forces using at least one of proportional, integral, and derivative control.

20. The method of claim 12, further comprising mapping a signal from a previous dig to changes in dig controller response using at least one of proportional, integral, and derivative control.

21. The method of claim 12, further comprising adjusting a final payload by modifying a parameter corresponding to a breakout phase of a dig.

22. A non-transitory storage media product encoding a program for controlling an autonomous mining, construction or exploration loading vehicle (ALV) which when executed on a processor of the ALV provides a dig controller according to any one of claims 1 to 11 and controls the ALV in accordance with the steps of any one of claims 12 to 20.

Ansprüche

1. Aushubsteuergerät (20) zur Steuerung der Interaktion eines autonomen Bergbau-, Bau- oder Explorations-Ladefahrzeugs (ALV) (5, 10) über eine beweglich an dem ALV angebrachte Schaufel mit einem Steinhaufen, umfassend:

mindestens ein Steuergerät steuert die Schaufel (1) und/oder das ALV in Übereinstimmung mit mindestens einem Sensorsignal (14), wobei das mindestens eine Sensorsignal die Interaktion zwischen der Schaufel und dem Steinhaufen (16) während eines Aushubs darstellt; wobei das mindestens eine Sensorsignal aus mindestens einem Sensor (32) erhalten wird, der mit einem oder mehreren Betätigungselementen am ALV verbunden ist, die kein Schaufelbetätigungselement sind, oder mit einem oder mehreren beweglichen betätigten Elementen, die durch die Betätigungselemente betätigt werden,

dadurch gekennzeichnet, dass das mindestens eine Steuergerät mindestens einen adaptiven Admittanzregler umfasst, wobei der adaptive Admittanzregler ein von einem oder mehreren der Sensoren erhaltenes Kraftsignal einer Änderung der Schaufelbewegung zuordnet; und

wobei der adaptive Admittanzregler ein lineares oder nichtlineares Bewegungssteuerungsschema für einen oder beide vom dem ALV und der Schaufel, in Übereinstimmung mit einem vorbestimmten, aber abstimmbaren Algorithmus zur Schaufelbeladung implementiert.

2. Aushubsteuergerät nach Anspruch 1, wobei der Algorithmus zur Schaufelbeladung Teile umfasst, die vorbestimmten Aushubphasen entsprechen, die das Einfahren, das Ausheben und das Ausbrechen einer beladenen Schaufel umfassen.

3. Aushubsteuergerät nach Anspruch 1, wobei die endgültige Schaufelnutzlast durch Ändern eines Parameters eingestellt wird, der einer Ausbruchsphase eines Aushubs entspricht.

4. Aushubsteuergerät nach Anspruch 1, wobei das mindestens eine Sensorsignal durch Messen einer von einem Auslegerbetätigungselement (4) aufgenommenen Kraft erhalten wird.

5. Aushubsteuergerät nach Anspruch 1, wobei das mindestens eine Sensorsignal durch Messen einer von einem betätigten Element aufgenommenen Kraft erhalten wird.

6. Aushubsteuergerät nach Anspruch 1, wobei der adaptive Admittanzregler mindestens einen Parameter als Antwort auf eine Differenz zwischen dem/den Sensorsignal(en) und einem Sollsignal dynamisch einstellt.

7. Aushubsteuergerät nach Anspruch 1, wobei der mindestens eine adaptive Admittanzregler ein oder mehrere Sensorsignale einem Bereich möglicher Schaufelgeschwindigkeiten oder ALV-Geschwindigkeiten zuordnet, indem er mindestens eine der Funktionen Proportional-, Integral- und Differenzialsteuerung verwendet.

8. Aushubsteuergerät nach einem der Ansprüche 1 bis 7, ferner umfassend mindestens eine iterativ lernende Regelung (ILR) (70, 72), die eine Rückmeldung von mindestens einem vorangegangenen Aushub verwendet, um das mindestens eine Sensorsignal zu modifizieren, das dem mindestens einen adaptiven Admittanzregler übermittelt wird.

9. Aushubsteuergerät nach Anspruch 8, wobei das ALV einen beweglichen Ausleger und eine an dem Ausleger angebrachte bewegliche Schaufel umfasst, wobei das Aushubsteuergerät ferner eine erste Geschwindigkeits-ILR (70, 72) umfasst, die eine ALV-Geschwindigkeit auf der Grundlage eines Sensorsignals stört, das die Wechselwirkung zwischen der Schaufel und dem Steinhaufen während mindestens eines vorangegangenen Aushubs darstellt, und eine zweite ILR, die ein Sensorsignal modifiziert, das von der Ausleger- und Schaufelkraft-Fehlermessung mindestens eines vorangegangenen Aushubs abgeleitet ist.

10. Aushubsteuergerät nach Anspruch 8, umfassend eine erste ILR, die ein Sensorsignal modifiziert, das einem Ausleger-Admittanzregler übermittelt wird, und eine zweite ILR, die ein Sensorsignal modifiziert, das einem Schaufel-Admittanzregler übermittelt wird, wobei die Modifizierung auf einer Rückmeldung von mindestens einem vorangegangenen Aushub basiert.

11. Aushubsteuergerät nach Anspruch 8, wobei die mindestens eine ILR ein Signal von einem vorangegangenen Aushub auf Änderungen in der Antwort des Aushubsteuergeräts zuordnet, indem sie mindestens eine der Funktionen Proportional-, Integral- und Differenzialsteuerung verwendet.

12. Verfahren zur Steuerung eines autonomen Ladefahrzeugs (ALV) (5, 10) mit einer beweglichen Schaufel, umfassend:

Veranlassen der Schaufel, mit einem Steinhaufen in Berührung zu kommen und zu interagieren;

Erfassen mindestens eines Sensorsignals (14) während der Interaktion der Schaufel mit dem Steinhaufen von mindestens einem Sensor, der mit einem oder mehreren Betätigungselementen, außer einem Schaufelbetätigungselement (3), oder einem oder mehreren betätigten Elementen an oder vom ALV verbunden ist, die von einem der jeweiligen Betätigungselemente betätigt werden;

und Verwendung eines Aushubsteuergeräts nach einem der Ansprüche 1 bis 11 zur Steuerung der Bewegung der Schaufel und/oder des ALV in Übereinstimmung mit dem mindestens einen Sensorsignal während der Interaktion mit dem Steinhaufen.

13. Verfahren nach Anspruch 12, umfassend das Erhalten des mindestens einen Sensorsignals (14) durch Messen einer Kraft, die von einem Auslegerbetätigungselement auf einen Ausleger mit der Schaufel ausgeübt wird, oder durch Messen der Belastung in dem betätigten Element.

14. Verfahren nach Anspruch 12, bei dem das mindestens eine Sensorsignal, das dem Aushubsteuergerät übermittelt wird, so modifiziert wird, dass die Schaufelgeschwindigkeit oder die ALV-Geschwindigkeit geändert wird.

15. Verfahren nach Anspruch 12, wobei das Steuern ferner das dynamische Einstellen mindestens eines Parameters als Antwort auf eine Differenz zwischen dem Sensorsignal und einem Sollsignal umfasst.

16. Verfahren nach Anspruch 12, ferner umfassend die Steuerung von mindestens einer der Bewegungen der Schaufel des ALV in mindestens eine ausgewählte Stellung und der Bewegung des ALV relativ zum Steinhaufen.

17. Verfahren nach Anspruch 12, wobei die Schaufel an einem Ausleger des ALV angebracht ist, wobei das Verfahren ferner die Störung einer ALV-Geschwindigkeit auf der Grundlage eines Sensorsignals, das die Wechselwirkung zwischen der Schaufel und dem Steinhaufen während mindestens eines vorangegangenen Aushubs darstellt, und die Modifizierung eines Sensorsignals umfasst, das von der Ausleger- und Schaufelkraft-Fehlermessung mindestens eines vorangegangenen Aushubs abgeleitet ist.

18. Verfahren nach Anspruch 12, wobei die Schaufel an einem Ausleger des ALV angebracht ist, wobei das Verfahren ferner das Modifizieren eines Sensorsignals, das einem Ausleger-Admittanzregler übermittelt wird, der den Ausleger steuert, und das Modifizieren eines Sensorsignals, das einem Schaufel-Admittanzregler der Schaufel übermittelt wird, umfasst, wobei das Modifizieren auf einer Rückmeldung von mindestens einem vorangegangenen Aushub basiert.

19. Verfahren nach Anspruch 12, wobei das Steuern das Zuordnen eines Gesamtkraftfehlers zu einem Bereich möglicher erfasster Kräfte unter Verwendung einer Proportional-, Integral- oder Differenzialsteuerung umfasst.

20. Verfahren nach Anspruch 12 ferner umfassend die Zuordnung eines Signals von einem vorangegangenen Aushub zu Änderungen in der Antwort des Aushubsteuergeräts unter Verwendung von Proportional-, Integral- und/oder Differenzialsteuerung.

21. Verfahren nach Anspruch 12, ferner umfassend das Einstellen einer endgültigen Nutzlast durch Ändern eines Parameters, der einer Ausbruchsphase eines Aushubs entspricht.

22. Nichtflüchtiges Speichermediumprodukt, das ein Programm zur Steuerung eines autonomen Bergbau-, Bau- oder Explorations-Ladefahrzeugs (ALV) kodiert, das, wenn es auf einem Prozessor des ALV ausgeführt wird, ein Aushubsteuergerät nach einem der Ansprüche 1 bis 11 bereitstellt und das ALV gemäß den Schritten nach einem der Ansprüche 12 bis 20 steuert.

Revendications

1. Dispositif de commande d'excavation (20) pour commander une interaction d'un véhicule à chargement autonome (ALV) d'exploitation minière, de construction ou d'exploration (5, 10) par l'intermédiaire d'un godet fixé de manière mobile à l'ALV, avec un tas de roches, comprenant :

au moins un dispositif de commande commandant le godet (1) et/ou l'ALV conformément à au moins un signal de capteur (14), dans lequel l'au moins un signal de capteur est représentatif d'une interaction entre le godet et le tas de roches (16) pendant une excavation ;

l'au moins un signal de capteur étant obtenu à partir d'au moins un capteur (32) associé à un ou plusieurs actionneurs sur l'ALV, autres qu'un actionneur de godet, ou à un ou plusieurs éléments mobiles actionnés par les actionneurs,

caractérisé en ce que

l'au moins un dispositif de commande comprend au moins un dispositif de commande d'admission adaptatif, lequel dispositif de commande d'admission adaptatif mappe un signal de force obtenu à partir d'un ou plusieurs capteurs à un changement dans un mouvement de godet ; et

dans lequel le dispositif de commande d'admission adaptatif met en oeuvre un schéma de commande de déplacement linéaire ou non linéaire pour l'un ou l'autre de l'ALV et du godet, ou les deux, conformément à un algorithme de chargement de godet prédéterminé mais accordable.

2. Dispositif de commande d'excavation selon la revendication 1, dans lequel l'algorithme de chargement de godet comprend des parties correspondant à des phases d'excavation prédéterminées qui comportent l'entrée, l'excavation et l'extraction d'un godet chargé.

3. Dispositif de commande d'excavation selon la revendication 1, dans lequel une charge utile de godet finale est réglée en modifiant un paramètre correspondant à une phase d'extraction d'une excavation.

4. Dispositif de commande d'excavation selon la revendication 1, dans lequel l'au moins un signal de capteur est obtenu en mesurant une force reçue par un actionneur de flèche (4).

5. Dispositif de commande d'excavation selon la revendication 1, dans lequel l'au moins un signal de capteur est obtenu en mesurant une force reçue par un élément actionné.

6. Dispositif de commande d'excavation selon la revendication 1, dans lequel le dispositif de commande d'admission adaptatif règle dynamiquement au moins un paramètre en réponse à une différence entre le ou les signaux de capteur et un signal souhaité.

7. Dispositif de commande d'excavation selon la revendication 1, dans lequel l'au moins un dispositif de commande d'admission adaptatif mappe un ou plusieurs signaux de capteur à une gamme de vitesses de godet ou de vitesses ALV possibles à l'aide d'au moins l'une parmi une commande proportionnelle, une commande intégrale et une commande dérivée.

8. Dispositif de commande d'excavation selon l'une quelconque des revendications 1 à 7, comprenant en outre au moins un dispositif de commande d'apprentissage itératif (ILC) (70,72) qui utilise la rétroaction d'au moins une excavation précédente pour modifier l'au moins un signal de capteur fourni à l'au moins un dispositif de commande d'admission adaptatif.

9. Dispositif de commande d'excavation selon la revendication 8, dans lequel l'ALV comprend une flèche mobile et un godet mobile fixé à la flèche, dans lequel le dispositif de commande d'excavation comprend en outre un premier ILC de vitesse (70,72) qui perturbe une vitesse d'ALV sur la base d'un signal de capteur représentatif d'une interaction entre le godet et le tas de roches pendant au moins une excavation précédente, et un deuxième ILC qui modifie un signal de capteur dérivé d'une mesure d'erreur de force de flèche et de godet d'au moins une excavation précédente.

10. Dispositif de commande d'excavation selon la revendication 8, comportant un premier ILC qui modifie un signal de capteur fourni à un dispositif de commande d'admission de flèche, et un deuxième ILC qui modifie un signal de capteur fourni à un dispositif de commande d'admission de godet, dans lequel la modification est basée sur la rétroaction d'au moins une excavation précédente.

11. Dispositif de commande d'excavation selon la revendication 8, dans lequel l'au moins un ILC mappe un signal d'une excavation précédente à des changements dans une réponse de dispositif de commande d'excavation à l'aide d'au moins l'une parmi une commande proportionnelle, une commande intégrale et une commande dérivée.

12. Procédé de commande d'un véhicule à chargement autonome (ALV) (5, 10) équipé d'un godet mobile, comprenant les étapes consistant à :

amener le godet à se mettre en prise et à interagir avec un tas de roches ;

obtenir, pendant l'interaction du godet avec le tas de roches, au moins un signal de capteur (14) à partir d'au moins un capteur associé à un ou plusieurs actionneurs, autres qu'un actionneur de godet (3), ou à un ou plusieurs éléments actionnés de l'ALV, ou au niveau de celui-ci, qui sont actionnés par l'un respectif des actionneurs ;

et utiliser un dispositif de commande d'excavation conformément à l'une quelconque des revendications 1 à 11 pour commander un déplacement du godet et/ou de l'ALV conformément à l'au moins un signal de capteur pendant l'interaction avec le tas de roches.

13. Procédé selon la revendication 12, comprenant l'étape consistant à obtenir l'au moins un signal de capteur (14) en mesurant une force appliquée par un actionneur de flèche à une flèche avec le godet, ou en mesurant une contrainte dans l'élément actionné.

14. Procédé selon la revendication 12, comportant l'étape consistant à modifier l'au moins un signal de capteur fourni au dispositif de commande d'excavation de sorte à changer une vitesse de godet ou une vitesse d'ALV.

15. Procédé selon la revendication 12, dans lequel la commande comprend en outre l'étape consistant à régler dynamiquement au moins un paramètre en réponse à une différence entre le signal de capteur et un signal souhaité.

16. Procédé selon la revendication 12, comprenant en outre l'étape consistant à commander au moins l'un parmi un déplacement du godet de l'ALV vers au moins une position sélectionnée, et un déplacement de l'ALV par rapport au tas de roches.

17. Procédé selon la revendication 12, dans lequel le godet est fixé à une flèche de l'ALV, le procédé comprenant en outre l'étape consistant à perturber une vitesse d'ALV sur la base d'un signal de capteur représentatif d'une interaction entre le godet et le tas de roches pendant au moins une excavation précédente, et à modifier un signal de capteur dérivé d'une mesure d'erreur de force de flèche et de godet d'au moins une excavation précédente.

18. Procédé selon la revendication 12, dans lequel le godet est fixé à une flèche de l'ALV, le procédé comprenant en outre l'étape consistant à modifier un signal de capteur fourni à un dispositif de commande d'admission de flèche commandant la flèche, et à modifier un signal de capteur fourni à un dispositif de commande d'admission de godet du godet, dans lequel la modification est basée sur la rétroaction d'au moins une excavation précédente.

19. Procédé selon la revendication 12, dans lequel la commande comporte le mappage d'une erreur de force totale à une gamme de forces détectées possibles à l'aide d'au moins l'une parmi une commande proportionnelle, une commande intégrale et une commande dérivée.

20. Procédé selon la revendication 12, comprenant en outre l'étape consistant à mapper un signal d'une excavation précédente à des changements dans une réponse de dispositif de commande d'excavation à l'aide d'au moins l'une parmi une commande proportionnelle, une commande intégrale et une commande dérivée.

21. Procédé selon la revendication 12, comprenant en outre l'étape consistant à régler une charge utile finale en modifiant un paramètre correspondant à une phase d'extraction d'une excavation.

22. Produit de support de stockage non transitoire codant un programme de commande d'un véhicule à chargement autonome (ALV) d'exploitation minière, de construction ou d'exploration qui, lorsqu'il est exécuté sur un processeur de l'ALV, fournit un dispositif de commande d'excavation selon l'une quelconque des revendications 1 à 11 et commande l'ALV conformément aux étapes de l'une quelconque des revendications 12 à 20.

Drawing