EP3102744B1 - Steuergerät für autonomes ladefahrzeug - Google Patents
Steuergerät für autonomes ladefahrzeug Download PDFInfo
- Publication number
- EP3102744B1 EP3102744B1 EP15740514.3A EP15740514A EP3102744B1 EP 3102744 B1 EP3102744 B1 EP 3102744B1 EP 15740514 A EP15740514 A EP 15740514A EP 3102744 B1 EP3102744 B1 EP 3102744B1
- Authority
- EP
- European Patent Office
- Prior art keywords
- bucket
- dig
- controller
- alv
- sensor signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
- E02F9/265—Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/431—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
- E02F3/434—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like providing automatic sequences of movements, e.g. automatic dumping or loading, automatic return-to-dig
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2029—Controlling the position of implements in function of its load, e.g. modifying the attitude of implements in accordance to vehicle speed
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/205—Remotely operated machines, e.g. unmanned vehicles
Definitions
- This invention relates to control of excavation/loading vehicles.
- this invention relates to autonomous or semi-autonomous control of excavation/loading vehicles.
- 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.
- 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.
- 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,.
- 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.
- 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.
- ILC iterative learning controller
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- the dig controller may modify the at least one sensor signal provided to the controller such that bucket velocity or ALV velocity are changed.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- the payload may be controlled based on a parameter of a breakout condition, or by modifying such a parameter.
- autonomous loading vehicle 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.
- LHD load-haul dump
- 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.
- vehicle configuration may include position and/or orientation of a boom or dig tool, and/or position and/or orientation of the ALV.
- 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.
- 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.
- 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.
- dig is intended to refer generally to the actions performed by an ALV to carry out a desired function using its bucket.
- a desired function may be to fill the bucket with material from the rock pile, wherein “dig” may be considered equivalent to "excavate”.
- other actions e.g., "load”
- the dig actions of the ALV are controlled by dig controller embodiments described herein.
- 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.
- 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.
- FIG. 1A A generic ALV is shown in 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- a controller may include a proportional, integral, or derivative controller, or any combination thereof.
- the dig controller may include one or more admittance controllers 20A ( Fig. 3A ).
- Admittance controllers respond to changes in force with changes in velocity.
- 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.
- 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.
- 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.
- 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 .
- Aggressiveness of an admittance controller may be governed by one or more parameters.
- these parameters are the ALV entry throttle and the target force values 12 for the admittance controllers 20A for the boom and bucket.
- 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.
- 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.
- 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.
- 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.
- the controller e.g., an admittance controller, an adaptive admittance controller
- 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.
- reaction forces received by the boom actuator provide an indication of the interaction between the dig tool and the rock pile.
- 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.
- a sensor signal may be obtained by measuring strain in an actuated element, such as a boom.
- one or more other elements of the ALV 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.
- 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.
- 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.
- 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.
- an input sensor signal such as force
- an admittance controller such as force
- the degree to which forces are modified is dictated by the force error history from previous dig attempts.
- an ILC 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.
- 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.
- 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.
- the admittance controllers begin moving the boom and bucket actuators.
- 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.
- a weighing pose e.g., bucket fully curled and raised above the rock pile
- 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.
- the admittance and position controllers operate at high frequency to perform the digging operations, while the ILCs only operate once per dig cycle.
- 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.
- these updated forces are again perturbed by the admittance ILC before being fed back to the admittance controller.
- 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.
- 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.
- the ILCs apply a correction 92 to the sensed forces 94 based on the total force error 96 from several previous dig attempts.
- the entry throttle is initially tuned to a set value, the entry throttle is perturbed by the ILC to improve digging efficiency consistency.
- the entry throttle is perturbed by the ILC to improve digging efficiency consistency.
- 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.
- an ILC may modify incoming forces so that the admittance controllers respond more aggressively.
- 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.
- 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.
- 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.
- 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.
- DSP digital signal processor
- FPGA field programmable gate array
- ASIC application specific integrated circuit
- 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.
- VHSIC very high speed integrated circuit
- VHDL hardware descriptive language
- RTL register transfer language
- Verilog Verilog
- 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.
- 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.
- 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.
- 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 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.
- FIG. 3C A generalized block diagram for the admittance controller is shown in Fig. 3C .
- ⁇ A the actuator velocity
- k A > 0 the (admittance) proportional gain
- the force error is given by the target force f T minus the dig reaction force f S .
- f T was set at 80 kN, while k A was set at 1.1 ⁇ 10 -7 .
- k T was set at 80 kN
- 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.
- 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.
- 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.
- 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 chicken Uno board.
- the chicken 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.
- 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.
- 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).
- valves on the loader 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.
- the admittance controller alters the curl velocity in response to the changing forces resulting in less severe force changes.
- 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.
- 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.
- ⁇ 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.
- 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.
- 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 .
- ⁇ admittance is the admittance ILC gain. Any general controller ⁇ admittance could be used instead of the proportional controller ⁇ admittance .
- ILCs 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).
- 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.
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Operation Control Of Excavators (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Charge And Discharge Circuits For Batteries Or The Like (AREA)
Claims (22)
- 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; undwobei 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.
- 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.
- Aushubsteuergerät nach Anspruch 1, wobei die endgültige Schaufelnutzlast durch Ändern eines Parameters eingestellt wird, der einer Ausbruchsphase eines Aushubs entspricht.
- Aushubsteuergerät nach Anspruch 1, wobei das mindestens eine Sensorsignal durch Messen einer von einem Auslegerbetätigungselement (4) aufgenommenen Kraft erhalten wird.
- Aushubsteuergerät nach Anspruch 1, wobei das mindestens eine Sensorsignal durch Messen einer von einem betätigten Element aufgenommenen Kraft erhalten wird.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- 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.
- Verfahren nach Anspruch 12, ferner umfassend das Einstellen einer endgültigen Nutzlast durch Ändern eines Parameters, der einer Ausbruchsphase eines Aushubs entspricht.
- 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.
Applications Claiming Priority (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| US201461931243P | 2014-01-24 | 2014-01-24 | |
| US201462033904P | 2014-08-06 | 2014-08-06 | |
| PCT/CA2015/000044 WO2015109392A1 (en) | 2014-01-24 | 2015-01-23 | Autonomous loading vehicle controller |
Publications (4)
| Publication Number | Publication Date |
|---|---|
| EP3102744A1 EP3102744A1 (de) | 2016-12-14 |
| EP3102744A4 EP3102744A4 (de) | 2018-03-07 |
| EP3102744C0 EP3102744C0 (de) | 2023-07-05 |
| EP3102744B1 true EP3102744B1 (de) | 2023-07-05 |
Family
ID=53680534
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| EP15740514.3A Active EP3102744B1 (de) | 2014-01-24 | 2015-01-23 | Steuergerät für autonomes ladefahrzeug |
Country Status (7)
| Country | Link |
|---|---|
| EP (1) | EP3102744B1 (de) |
| AU (1) | AU2015208631B2 (de) |
| CA (1) | CA2935576C (de) |
| CL (1) | CL2016001684A1 (de) |
| MX (1) | MX377011B (de) |
| RU (1) | RU2703086C2 (de) |
| WO (1) | WO2015109392A1 (de) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2025014401A1 (en) * | 2023-07-07 | 2025-01-16 | Epiroc Rock Drills Aktiebolag | Methods and loading systems for loading vehicles for loading material into loading vehicles from a pile |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9816248B2 (en) | 2015-10-30 | 2017-11-14 | Deere & Company | System and method for assisted bucket load operation |
| WO2017105308A1 (en) * | 2015-12-18 | 2017-06-22 | Volvo Construction Equipment Ab | System and method for determining a material entity to be removed from a pile and a control unit for a working machine comprising such a system. |
| JP7451240B2 (ja) * | 2020-03-13 | 2024-03-18 | 株式会社小松製作所 | 作業システム、コンピュータによって実行される方法、および学習済みの姿勢推定モデルの製造方法 |
| WO2022097499A1 (ja) * | 2020-11-09 | 2022-05-12 | 国立大学法人広島大学 | 作業機械の自動運転装置 |
| CA3129016A1 (en) * | 2021-04-07 | 2022-10-07 | Queen's University At Kingston | Automatic classification of excavation materials |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20120330463A1 (en) * | 2010-03-09 | 2012-12-27 | Kuka Laboratories Gmbh | Method for Mounting Components by Means of an Industrial Robot |
Family Cites Families (22)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH07268897A (ja) * | 1994-03-23 | 1995-10-17 | Caterpillar Inc | 自己適合性掘削制御システムとその方法 |
| US5461803A (en) * | 1994-03-23 | 1995-10-31 | Caterpillar Inc. | System and method for determining the completion of a digging portion of an excavation work cycle |
| US5493798A (en) * | 1994-06-15 | 1996-02-27 | Caterpillar Inc. | Teaching automatic excavation control system and method |
| US5544055A (en) * | 1994-07-29 | 1996-08-06 | Vermeer Manufacturing Company | Track trencher control system and process |
| US5553407A (en) * | 1995-06-19 | 1996-09-10 | Vermeer Manufacturing Company | Excavator data acquisition and control system and method of use |
| US5681312A (en) * | 1996-05-31 | 1997-10-28 | Acromed Corporation | Spine construct with band clamp |
| US6233511B1 (en) * | 1997-11-26 | 2001-05-15 | Case Corporation | Electronic control for a two-axis work implement |
| US6523765B1 (en) * | 1998-03-18 | 2003-02-25 | Hitachi Construction Machinery Co., Ltd. | Automatically operated shovel and stone crushing system comprising the same |
| US6363632B1 (en) * | 1998-10-09 | 2002-04-02 | Carnegie Mellon University | System for autonomous excavation and truck loading |
| US6205687B1 (en) * | 1999-06-24 | 2001-03-27 | Caterpillar Inc. | Method and apparatus for determining a material condition |
| US6510628B1 (en) * | 2001-10-31 | 2003-01-28 | Caterpillar Inc | Method and apparatus for determining a contact force of a work tool |
| US6879899B2 (en) * | 2002-12-12 | 2005-04-12 | Caterpillar Inc | Method and system for automatic bucket loading |
| US6845311B1 (en) * | 2003-11-04 | 2005-01-18 | Caterpillar Inc. | Site profile based control system and method for controlling a work implement |
| US7630793B2 (en) * | 2004-12-10 | 2009-12-08 | Caterpillar S.A.R.L. | Method of altering operation of work machine based on work tool performance footprint to maintain desired relationship between operational characteristics of work tool and work machine |
| US8065060B2 (en) * | 2006-01-18 | 2011-11-22 | The Board Of Regents Of The University And Community College System On Behalf Of The University Of Nevada | Coordinated joint motion control system with position error correction |
| US7979181B2 (en) * | 2006-10-19 | 2011-07-12 | Caterpillar Inc. | Velocity based control process for a machine digging cycle |
| US8793055B2 (en) * | 2007-07-13 | 2014-07-29 | Volvo Construction Equipment Ab | Method for providing an operator of a work machine with operation instructions and a computer program for implementing the method |
| WO2009145682A1 (en) * | 2008-05-27 | 2009-12-03 | Volvo Construction Equipment Ab | A method for controlling a hydraulic system |
| AU2009260176A1 (en) * | 2008-06-16 | 2009-12-23 | Commonwealth Scientific And Industrial Research Organisation | Method and system for machinery control |
| US8160783B2 (en) * | 2008-06-30 | 2012-04-17 | Caterpillar Inc. | Digging control system |
| FI20105082A0 (fi) * | 2010-01-29 | 2010-01-29 | Waertsilae Finland Oy | Kaasunvaihtoventtiilin sähköhydraulisen käyttöjärjestelmän säätöjärjestely |
| KR101696292B1 (ko) * | 2011-12-15 | 2017-01-13 | 현대중공업 주식회사 | 휠로더의 버켓 지면접촉 방지장치 및 제어방법 |
-
2015
- 2015-01-23 EP EP15740514.3A patent/EP3102744B1/de active Active
- 2015-01-23 WO PCT/CA2015/000044 patent/WO2015109392A1/en not_active Ceased
- 2015-01-23 RU RU2016134403A patent/RU2703086C2/ru active
- 2015-01-23 MX MX2016008819A patent/MX377011B/es active IP Right Grant
- 2015-01-23 AU AU2015208631A patent/AU2015208631B2/en active Active
- 2015-01-23 CA CA2935576A patent/CA2935576C/en active Active
-
2016
- 2016-06-30 CL CL2016001684A patent/CL2016001684A1/es unknown
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20120330463A1 (en) * | 2010-03-09 | 2012-12-27 | Kuka Laboratories Gmbh | Method for Mounting Components by Means of an Industrial Robot |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2025014401A1 (en) * | 2023-07-07 | 2025-01-16 | Epiroc Rock Drills Aktiebolag | Methods and loading systems for loading vehicles for loading material into loading vehicles from a pile |
Also Published As
| Publication number | Publication date |
|---|---|
| EP3102744C0 (de) | 2023-07-05 |
| RU2016134403A (ru) | 2018-03-01 |
| RU2016134403A3 (de) | 2018-08-21 |
| CL2016001684A1 (es) | 2016-11-18 |
| EP3102744A1 (de) | 2016-12-14 |
| RU2703086C2 (ru) | 2019-10-15 |
| MX2016008819A (es) | 2016-09-08 |
| AU2015208631B2 (en) | 2019-07-25 |
| CA2935576A1 (en) | 2015-07-30 |
| MX377011B (es) | 2025-03-04 |
| EP3102744A4 (de) | 2018-03-07 |
| AU2015208631A1 (en) | 2016-07-28 |
| CA2935576C (en) | 2022-08-02 |
| WO2015109392A1 (en) | 2015-07-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CA2935576C (en) | Autonomous loading vehicle controller | |
| Fernando et al. | Iterative learning-based admittance control for autonomous excavation | |
| CN101903839B (zh) | 持续的作业机具角度控制 | |
| US8909437B2 (en) | Payload Estimation system | |
| Bradley et al. | The development, control and operation of an autonomous robotic excavator | |
| US8521371B2 (en) | Systems and methods for remapping of machine implement controls | |
| US9822507B2 (en) | Work vehicle with enhanced implement position control and bi-directional self-leveling functionality | |
| Dobson et al. | Admittance control for robotic loading: design and experiments with a 1‐tonne loader and a 14‐tonne load‐haul‐dump machine | |
| US7555855B2 (en) | Automatic digging and loading system for a work machine | |
| US8924094B2 (en) | System for work cycle detection | |
| US9441348B1 (en) | Hydraulic system with operator skill level compensation | |
| US20090228394A1 (en) | Adaptive payload monitoring system | |
| US9803336B2 (en) | System and method for determining dump locations | |
| Fernando et al. | Towards controlling bucket fill factor in robotic excavation by learning admittance control setpoints | |
| CN102341549A (zh) | 建筑机械、建筑机械的控制方法及使计算机执行该方法的程序 | |
| Cannon et al. | Models for automated earthmoving | |
| US20250109571A1 (en) | Down-force control in a work machine having articulating arms | |
| Cao et al. | Intelligentization of wheel loader shoveling system based on multi-source data acquisition | |
| WO2025071790A1 (en) | Auto-level and down-force control in a work machine having articulating arms | |
| Dobson et al. | Admittance control for robotic loading: Underground field trials with an LHD | |
| Ishikawa et al. | Trajectory tracking switching control system for autonomous crawler dump under varying ground condition | |
| Maeda et al. | Iterative autonomous excavation | |
| US20200157770A1 (en) | On demand machine rimpull adjustment to prevent tire slip | |
| Fiset et al. | Effects of turning radius on skid-steered wheeled robot power consumption on loose soil | |
| JP7710420B2 (ja) | 作業機械 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
| PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
| 17P | Request for examination filed |
Effective date: 20160822 |
|
| AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
| AX | Request for extension of the european patent |
Extension state: BA ME |
|
| DAX | Request for extension of the european patent (deleted) | ||
| RIC1 | Information provided on ipc code assigned before grant |
Ipc: E02F 9/20 20060101AFI20171011BHEP Ipc: E21C 27/30 20060101ALI20171011BHEP Ipc: E02F 9/26 20060101ALI20171011BHEP Ipc: E02F 3/43 20060101ALI20171011BHEP |
|
| A4 | Supplementary search report drawn up and despatched |
Effective date: 20180202 |
|
| RIC1 | Information provided on ipc code assigned before grant |
Ipc: E21C 27/30 20060101ALI20180129BHEP Ipc: E02F 9/26 20060101ALI20180129BHEP Ipc: E02F 9/20 20060101AFI20180129BHEP Ipc: E02F 3/43 20060101ALI20180129BHEP |
|
| RAP1 | Party data changed (applicant data changed or rights of an application transferred) |
Owner name: EPIROC ROCK DRILLS AKTIEBOLAG |
|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: EXAMINATION IS IN PROGRESS |
|
| 17Q | First examination report despatched |
Effective date: 20190104 |
|
| GRAP | Despatch of communication of intention to grant a patent |
Free format text: ORIGINAL CODE: EPIDOSNIGR1 |
|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: GRANT OF PATENT IS INTENDED |
|
| INTG | Intention to grant announced |
Effective date: 20230202 |
|
| GRAS | Grant fee paid |
Free format text: ORIGINAL CODE: EPIDOSNIGR3 |
|
| GRAA | (expected) grant |
Free format text: ORIGINAL CODE: 0009210 |
|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE PATENT HAS BEEN GRANTED |
|
| AK | Designated contracting states |
Kind code of ref document: B1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
| REG | Reference to a national code |
Ref country code: CH Ref legal event code: EP |
|
| REG | Reference to a national code |
Ref country code: AT Ref legal event code: REF Ref document number: 1584956 Country of ref document: AT Kind code of ref document: T Effective date: 20230715 |
|
| REG | Reference to a national code |
Ref country code: DE Ref legal event code: R096 Ref document number: 602015084437 Country of ref document: DE |
|
| REG | Reference to a national code |
Ref country code: IE Ref legal event code: FG4D |
|
| U01 | Request for unitary effect filed |
Effective date: 20230710 |
|
| U07 | Unitary effect registered |
Designated state(s): AT BE BG DE DK EE FI FR IT LT LU LV MT NL PT SE SI Effective date: 20230719 |
|
| REG | Reference to a national code |
Ref country code: LT Ref legal event code: MG9D |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: GR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20231006 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: ES Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20231105 |
|
| U20 | Renewal fee for the european patent with unitary effect paid |
Year of fee payment: 10 Effective date: 20231219 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: RS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 Ref country code: NO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20231005 Ref country code: IS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20231105 Ref country code: HR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 Ref country code: GR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20231006 Ref country code: ES Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: PL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| REG | Reference to a national code |
Ref country code: DE Ref legal event code: R097 Ref document number: 602015084437 Country of ref document: DE |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SM Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 Ref country code: RO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 Ref country code: CZ Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 Ref country code: SK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| PLBE | No opposition filed within time limit |
Free format text: ORIGINAL CODE: 0009261 |
|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: NO OPPOSITION FILED WITHIN TIME LIMIT |
|
| 26N | No opposition filed |
Effective date: 20240408 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MC Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MC Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| REG | Reference to a national code |
Ref country code: CH Ref legal event code: PL |
|
| GBPC | Gb: european patent ceased through non-payment of renewal fee |
Effective date: 20240123 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: GB Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20240123 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: CH Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20240131 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: GB Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20240123 Ref country code: CH Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20240131 |
|
| U20 | Renewal fee for the european patent with unitary effect paid |
Year of fee payment: 11 Effective date: 20241218 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20240123 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20240123 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: CY Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT; INVALID AB INITIO Effective date: 20150123 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: HU Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT; INVALID AB INITIO Effective date: 20150123 |
|
| PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: TR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20230705 |
|
| U20 | Renewal fee for the european patent with unitary effect paid |
Year of fee payment: 12 Effective date: 20251217 |