US12000108B2 - Control system for construction machine, construction machine, and control method for construction machine - Google Patents

Control system for construction machine, construction machine, and control method for construction machine Download PDF

Info

Publication number
US12000108B2
US12000108B2 US17/419,850 US201917419850A US12000108B2 US 12000108 B2 US12000108 B2 US 12000108B2 US 201917419850 A US201917419850 A US 201917419850A US 12000108 B2 US12000108 B2 US 12000108B2
Authority
US
United States
Prior art keywords
control
amount
working equipment
bucket
working
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, expires
Application number
US17/419,850
Other languages
English (en)
Other versions
US20220074165A1 (en
Inventor
Yoshiro Iwasaki
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Komatsu Ltd
Original Assignee
Komatsu Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Komatsu Ltd filed Critical Komatsu Ltd
Assigned to KOMATSU LTD. reassignment KOMATSU LTD. ASSIGNMENT OF ASSIGNORS INTEREST (SEE DOCUMENT FOR DETAILS). Assignors: IWASAKI, YOSHIRO
Publication of US20220074165A1 publication Critical patent/US20220074165A1/en
Application granted granted Critical
Publication of US12000108B2 publication Critical patent/US12000108B2/en
Active legal-status Critical Current
Adjusted expiration legal-status Critical

Links

Images

Classifications

    • 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
    • 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/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • 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/08—Superstructures; Supports for superstructures
    • E02F9/10—Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
    • E02F9/12—Slewing or traversing gears
    • E02F9/121—Turntables, i.e. structure rotatable about 360°
    • E02F9/123—Drives or control devices specially adapted therefor
    • 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/2037—Coordinating the movements of the implement and of the frame
    • 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/22—Hydraulic or pneumatic drives
    • 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/22—Hydraulic or pneumatic drives
    • E02F9/2203—Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • 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/22—Hydraulic or pneumatic drives
    • E02F9/2264—Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271—Actuators and supports therefor and protection therefor
    • 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/261—Surveying the work-site to be treated
    • E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • 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)
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators

Definitions

  • the present invention relates to a control system for a construction machine, the construction machine, and a control method for the construction machine.
  • Patent Literature 1 In a technical field related to construction machines, there is known a control system for a construction machine that moves working equipment to follow a design surface that indicates a target shape of a construction target, as disclosed in Patent Literature 1.
  • the working equipment is controlled so as not to dig below the design surface.
  • the working equipment may dig below the design surface.
  • design surfaces having various shapes are set at the construction site, it may be difficult for the working equipment to follow the design surface.
  • various contents of works are required at the construction site, it may be difficult for the working equipment to follow the design surface.
  • An object of the present invention according to an aspect is to cause working equipment to follow a design surface regardless of a condition at a construction site.
  • a control system for a construction machine including working equipment the control system comprises: a target value generation unit configured to generate a target value of an amount of control of the working equipment; a prediction unit configured to calculate a predicted value of the amount of control of the working equipment based on the target value and a prediction model for the working equipment, and calculate an amount of drive to control the working equipment based on the predicted value; and a command unit configured to output a control command for control of the working equipment based on the amount of drive.
  • the working equipment can be caused to follow the design surface regardless of the condition at the construction site.
  • FIG. 1 is a perspective view illustrating an example of a construction machine according to the present embodiment.
  • FIG. 2 is a block diagram illustrating a control system for the construction machine according to the present embodiment.
  • FIG. 3 is a diagram schematically illustrating the construction machine according to the present embodiment.
  • FIG. 4 (A) and FIG. 4 (B) are diagrams schematically illustrating a bucket according to the present embodiment.
  • FIG. 5 is a functional block diagram illustrating a control device according to the present embodiment.
  • FIG. 6 is a diagram illustrating a method of calculating a target translational speed of the bucket by a target translational speed calculation unit according to the present embodiment.
  • FIG. 7 is a graph illustrating an example of a speed limit table according to the present embodiment.
  • FIG. 8 is a diagram illustrating a method of calculating a target rotation speed of the bucket by a target rotation speed calculation unit according to the present embodiment.
  • FIG. 9 is a diagram illustrating an example of an operation of the construction machine according to the present embodiment.
  • FIG. 10 is a flowchart illustrating a control method for the construction machine according to the present embodiment.
  • FIG. 11 is a graph illustrating a result of comparison between control of working equipment by the control method according to the present embodiment and control of the working equipment by a control method according to a comparative example.
  • FIG. 12 is a block diagram illustrating an example of a computer system according to the present embodiment.
  • the vehicle body coordinate system represents a coordinate system that has the origin fixed to a construction machine.
  • the vehicle body coordinate system is defined by an X-axis that extends in a defined direction based on the origin set to the construction machine, a Y-axis that is orthogonal to the X-axis, and a Z-axis that is orthogonal to each of the X-axis and the Y-axis.
  • a direction parallel to the X-axis is an X-axis direction.
  • a direction parallel to the Y-axis is a Y-axis direction.
  • a direction parallel to the Z-axis is a Z-axis direction.
  • a rotation or tilting direction about the X-axis is a ⁇ X direction.
  • a rotation or tilting direction about the Y-axis is a ⁇ Y direction.
  • a rotation or tilting direction about the Z-axis is a ⁇ Z direction.
  • FIG. 1 is a perspective view illustrating an example of a construction machine 100 according to the present embodiment.
  • the construction machine 100 as an excavator will be described.
  • the construction machine 100 is appropriately referred to as the excavator 100 .
  • the excavator 100 includes working equipment 1 that is operated by hydraulic pressure, a swing body 2 that is configured to support the working equipment 1 , and a traveling body 3 that is configured to support the swing body 2 .
  • the swing body 2 has a cab 4 which a driver gets into. In the cab 4 , a seat 4 S on which the driver is seated is arranged.
  • the swing body 2 is swingable about a swing axis RX with the swing body 2 supported by the traveling body 3 .
  • the traveling body 3 has a pair of tracks 3 C.
  • the excavator 100 travels by the rotation of the tracks 3 C.
  • the traveling body 3 may have tires.
  • the working equipment 1 is supported by the swing body 2 .
  • the working equipment 1 includes a plurality of working members movable relative to each other.
  • the plurality of working members have the same or similar functions. In other words, each of the plurality of working members moves relative to the swing body 2 to function to perform working, such as excavation, leveling, and loading, required of the excavator 100 .
  • the working members include a boom 6 , an arm 7 , and a bucket 8 .
  • the boom 6 is connected to the swing body 2 .
  • the arm 7 is connected to a distal end of the boom 6 .
  • the bucket 8 is connected to a distal end of the arm 7 .
  • the bucket 8 has a blade edge 9 .
  • the blade edge 9 of the bucket 8 is the edge of a straight blade.
  • the blade edge 9 of the bucket 8 may be the tip of a protruded tooth provided at the bucket 8 .
  • the boom 6 is rotatable about a boom axis AX 1 relative to the swing body 2 .
  • the arm 7 is rotatable about an arm axis AX 2 relative to the boom 6 .
  • the bucket 8 is rotatable relative to the arm 7 about each of a bucket axis AX 3 , a tilt axis AX 4 , and a rotating axis AX 5 .
  • the boom axis AX 1 , arm axis AX 2 , and bucket axis AX 3 are parallel to the Y-axis.
  • the tilt axis AX 4 is orthogonal to the bucket axis AX 3 .
  • the rotating axis AX 5 is orthogonal to each of the bucket axis AX 3 and the tilt axis AX 4 .
  • the swing axis RX is parallel to the Z-axis.
  • the X-axis direction is a front-rear direction of the swing body 2 .
  • the Y-axis direction is a vehicle width direction of the swing body 2 .
  • the Z-axis direction is a vertical direction of the swing body 2 .
  • a direction of the working equipment 1 relative to the driver seated on the seat 4 S is a front direction.
  • FIG. 2 is a block diagram illustrating a control system 200 for the excavator 100 according to the present embodiment.
  • FIG. 3 is a diagram schematically illustrating the excavator 100 according to the present embodiment.
  • FIG. 4 (A) and FIG. 4 (B) are diagrams schematically illustrating the bucket 8 according to the present embodiment.
  • the control system 200 for the excavator 100 includes an engine 5 , a plurality of hydraulic cylinders 10 configured to operate the working equipment 1 , a swing motor 16 configured to drive the swing body 2 , a hydraulic pump 17 configured to discharge hydraulic oil, a valve device 18 configured to distribute the hydraulic oil discharged from the hydraulic pump 17 to each of the plurality of hydraulic cylinders 10 and the swing motor 16 , a position calculation device 20 configured to calculate positional data of the swing body 2 , an angle detection device 30 configured to detect angles ⁇ of the working equipment 1 , an operation device 40 configured to operate the working equipment 1 and the swing body 2 , and a control device 50 .
  • the working equipment 1 is operated by power generated by the hydraulic cylinders 10 .
  • Each of the hydraulic cylinders 10 is driven on the basis of the hydraulic oil supplied from the hydraulic pump 17 .
  • the hydraulic cylinder 10 is a hydraulic actuator configured to operate the working members of the working equipment 1 .
  • the plurality of hydraulic cylinders 10 have the same or similar functions. In other words, the plurality of hydraulic cylinders 10 have functions for operating the plurality of working members.
  • the hydraulic cylinder 10 includes a boom cylinder 11 that is configured to operate the boom 6 , an arm cylinder 12 that is configured to operate the arm 7 , and a bucket cylinder 13 , a tilt cylinder 14 , and a rotating cylinder 15 that are configured to operate the bucket 8 .
  • the boom cylinder 11 generates power to rotate the boom 6 about the boom axis AX 1 .
  • the arm cylinder 12 generates power to rotate the arm 7 about the arm axis AX 2 .
  • the bucket cylinder 13 generates power to rotate the bucket 8 about the bucket axis AX 3 .
  • the tilt cylinder 14 generates power to rotate the bucket 8 about the tilt axis AX 4 .
  • the rotating cylinder 15 generates power to rotate the bucket 8 about the rotating axis AX 5 .
  • the rotation of the bucket 8 about the bucket axis AX 3 is appropriately referred to as bucket rotation
  • the rotation of the bucket 8 about the tilt axis AX 4 is appropriately referred to as tilt rotation
  • the rotation of the bucket 8 about the rotating axis AX 5 is appropriately referred to as rotation.
  • the swing body 2 swings by power generated by the swing motor 16 .
  • the swing motor 16 is a hydraulic motor and is driven on the basis of the hydraulic oil supplied from the hydraulic pump 17 .
  • the swing motor 16 generates power to cause the swing body 2 to swing about the swing axis RX.
  • the engine 5 is mounted on the swing body 2 .
  • the engine 5 generates power for driving the hydraulic pump 17 .
  • the hydraulic pump 17 discharges the hydraulic oil for driving the hydraulic cylinder 10 and the swing motor 16 .
  • the valve device 18 has a plurality of valves configured to distribute the hydraulic oil supplied from the hydraulic pump 17 to the plurality of hydraulic cylinders 10 and the swing motor 16 .
  • the valve device 18 adjusts the flow rate of the hydraulic oil supplied to each of the plurality of hydraulic cylinders 10 .
  • the adjustment of the flow rate of the hydraulic oil supplied to the hydraulic cylinder 10 adjusts the operating speed of the hydraulic cylinder 10 .
  • the valve device 18 regulates the flow rate of the hydraulic oil supplied to the swing motor 16 .
  • the adjustment of the flow rate of the hydraulic oil supplied to the swing motor 16 adjusts the rotation speed of the swing motor 16 .
  • the position calculation device 20 calculates the positional data of the swing body 2 .
  • the positional data of the swing body 2 includes the position of the swing body 2 , the attitude of the swing body 2 , and the orientation of the swing body 2 .
  • the position calculation device 20 has a position calculator 21 configured to calculate the position of the swing body 2 , an attitude calculator 22 configured to calculate the attitude of the swing body 2 , and an orientation calculator 23 configured to calculate the orientation of the swing body 2 .
  • the position calculator 21 calculates the position of the swing body 2 in a global coordinate system, as the position of the swing body 2 .
  • the position calculator 21 is arranged in the swing body 2 .
  • the global coordinate system represents a coordinate system that has the origin fixed to the earth.
  • the global coordinate system is a coordinate system defined by a Global Navigation Satellite System (GNSS).
  • GNSS Global Navigation Satellite System
  • the GNSS is a global navigation satellite system.
  • GPS global positioning system
  • the GNSS has a plurality of positioning satellites.
  • the GNSS detects a position defined by coordinate data of a latitude, a longitude, and an altitude.
  • the swing body 2 is provided with a GPS antenna.
  • the GPS antennas receives a radio wave from a GPS satellite and outputs a signal generated on the basis of the received radio wave to the position calculator 21 .
  • the position calculator 21 calculates the position of the swing body 2 in the global coordinate system, on the basis of the signal supplied from the GPS antenna.
  • the position calculator 21 calculates the position of a representative point O of the swing body 2 , for example, as illustrated in FIG. 3 .
  • the representative point O of the swing body 2 is set on the swing axis RX.
  • the representative point O may be set to the boom axis AX 1 .
  • the attitude calculator 22 calculates the inclination angle of the swing body 2 relative to a horizontal plane in the global coordinate system, as the attitude of the swing body 2 .
  • the attitude calculator 22 is arranged in the swing body 2 .
  • the attitude calculator 22 includes an inertial measurement unit (IMU).
  • the inclination angle of the swing body 2 relative to the horizontal plane includes a roll angle ⁇ indicating an inclination angle of the swing body 2 in the vehicle width direction and a pitch angle ⁇ indicating an inclination angle of the swing body 2 in the front-rear direction.
  • the orientation calculator 23 calculates the orientation of the swing body 2 relative to a reference orientation in the global coordinate system, as the orientation of the swing body 2 .
  • the reference orientation is, for example, north.
  • the orientation calculator 23 is arranged in the swing body 2 .
  • the orientation calculator 23 includes a gyroscope sensor.
  • the orientation calculator 23 may calculate the orientation on the basis of the signal supplied from the GPS antenna.
  • the orientation of the swing body 2 relative to the reference orientation includes a yaw angle ⁇ indicating an angle formed by the reference orientation and the orientation of the swing body 2 .
  • the angle detection device 30 detects the angles ⁇ of the working equipment 1 .
  • the angle detection device is arranged in the working equipment 1 .
  • the angles ⁇ of the working equipment 1 include a boom angle ⁇ 1 that indicates the angle of the boom 6 relative to the Z-axis, an arm angle ⁇ 2 that indicates the angle of the arm 7 relative to the boom 6 , a bucket angle ⁇ 3 that indicates the angle of the bucket 8 in a bucket rotation direction relative to the arm 7 , a tilt angle ⁇ 4 that indicates the angle of the bucket 8 in a tilt rotation direction relative to an XY plane, and a rotation angle ⁇ 5 that indicates the angle of the bucket 8 in a rotation direction relative to a YZ plane.
  • the angle detection device 30 has a boom angle detector 31 that detects the boom angle ⁇ 1 , an arm angle detector 32 that detects the arm angle ⁇ 2 , a bucket angle detector 33 that detects the bucket angle ⁇ 3 , a tilt angle detector 34 that detects the tilt angle ⁇ 4 , and a rotation angle detector 35 that detects the rotation angle ⁇ 5 .
  • the angle detection device 30 may include a stroke sensor configured to detect a stroke of the hydraulic cylinder 10 , or may include an angle sensor, such as a rotary encoder, configured to detect the angles ⁇ of the working equipment 1 . When the angle detection device 30 includes the stroke sensor, the angle detection device 30 calculates the angles ⁇ of the working equipment 1 on the basis of detection data of the stroke sensor.
  • the operation device 40 is operated by the driver to drive the hydraulic cylinder 10 and the swing motor 16 .
  • the operation device 40 is arranged in the cab 4 . Operation of the operation device 40 by the driver operates the working equipment 1 .
  • the operation device 40 includes a lever that is operated by the driver of the excavator 100 .
  • the lever of the operation device 40 includes a right operating lever 41 , a left operating lever 42 , and a tilt operating lever 43 .
  • Operation of the tilt operating lever 43 causes a tilt rotation or rotation of the bucket 8 .
  • FIG. 5 is a functional block diagram illustrating the control device 50 according to the present embodiment.
  • the control device 50 includes a positional data acquisition unit 51 , an angle data acquisition unit 52 , an operation data acquisition unit 53 , a design surface acquisition unit 54 , a target value generation unit 55 , a model predictive control unit 56 , a constraint condition calculation unit 57 , a command unit 58 , a determination unit 61 , and a storage unit 60 .
  • the positional data acquisition unit 51 acquires the positional data of the swing body 2 from the position calculation device 20 .
  • the positional data of the swing body 2 includes the position of the swing body 2 , the attitude of the swing body 2 , and the orientation of the swing body 2 .
  • the angle data acquisition unit 52 acquires angle data indicating the angles ⁇ of the working equipment 1 from the angle detection device 30 .
  • the angle data of the working equipment 1 includes the boom angle ⁇ 1 , the arm angle ⁇ 2 , the bucket angle ⁇ 3 , the tilt angle ⁇ 4 , and the rotation angle ⁇ 5 .
  • the operation data acquisition unit 53 acquires operation data of the operation device 40 operating the working equipment 1 .
  • the operation data of the operation device 40 includes an amount of operation of the operation device 40 .
  • the operation device 40 is provided with an operation amount sensor that detects an amount of operation of each lever.
  • the operation data acquisition unit 53 acquires the operation data of the operation device 40 from the operation amount sensor of the operation device 40 .
  • the design surface acquisition unit 54 acquires a design surface that indicates a target shape of a construction target.
  • the design surface indicates a three-dimensional target shape after construction by the excavator 100 .
  • a design surface data supply device 70 generates design surface data that indicates the design surface.
  • the design surface acquisition unit 54 acquires the design surface data from the design surface data supply device 70 .
  • the design surface data supply device 70 may be provided at a distant place from the excavator 100 .
  • the design surface data generated by the design surface data supply device 70 may be transmitted to the control device 50 via a communication system. Note that the design surface data generated by the design surface data supply device 70 may be stored in the storage unit 60 .
  • the design surface acquisition unit 54 may acquire the design surface data from the storage unit 60 .
  • the target value generation unit 55 generates a target value of an amount of control of the working equipment 1 .
  • the amount of control of the working equipment 1 includes one or both of a moving speed of the bucket 8 and the position of a predetermined portion of the bucket 8 .
  • the predetermined portion of the bucket 8 includes the blade edge 9 of the bucket 8 .
  • the moving speed of the bucket 8 includes a moving speed of the blade edge 9 .
  • the position of the predetermined portion of the bucket 8 includes the position of the blade edge 9 .
  • the target value generation unit 55 generates the target value of the amount of control of the working equipment 1 , on the basis of the operation data acquired by the operation data acquisition unit 53 .
  • the predetermined portion of the bucket 8 is the blade edge 9 .
  • the predetermined portion of the bucket 8 may not necessarily be the blade edge 9 .
  • the predetermined portion of the bucket 8 may be a floor surface (bottom surface) of the bucket 8 .
  • the moving speed of the bucket 8 includes a translational speed and a rotation speed of the bucket 8 .
  • the translational speed of the bucket 8 represents a moving speed in each of the X-axis direction, the Y-axis direction, and the Z-axis direction.
  • the rotation speed of the bucket 8 represents a rotational angular speed in each of the ⁇ X direction, the ⁇ Y direction, and the ⁇ Z direction.
  • the target value generation unit 55 includes a target translational speed calculation unit 551 configured to calculate a target translational speed v target that is a target value of the translational speed, and a target rotation speed calculation unit 552 configured to calculate a target rotation speed ⁇ target that is a target value of the rotation speed.
  • the target value generation unit 55 calculates each of the target translational speed v target and the target rotation speed ⁇ target , on the basis of the angle data acquired by the angle data acquisition unit 52 , the operation data acquired by the operation data acquisition unit 53 , and the design surface acquired by the design surface acquisition unit 54 .
  • FIG. 6 is a diagram illustrating a method of calculating the target translational speed v target of the bucket 8 by the target translational speed calculation unit 551 according to the present embodiment.
  • the target translational speed calculation unit 551 includes a translational speed calculation unit 551 A configured to calculate the translational speed of the bucket 8 on the basis of the operation data of the operation device 40 and the angle data of the working equipment 1 , a speed limit calculation unit 551 B configured to calculate a speed limit of the bucket 8 on the basis of a distance between the blade edge 9 and the design surface and the design surface data, a PI control unit 551 C, and a deceleration processing unit 551 D.
  • the target translational speed calculation unit 551 calculates the target translational speed v target of the bucket 8 so as not to dig below the design surface.
  • the target translational speed v target of the bucket 8 is calculated on the basis of formulas (1) to (6).
  • n ⁇ R 3 is a unit normal vector of the design surface closest to the blade edge 9
  • w R1 ⁇ R 3 ⁇ 3 is a rotation matrix for transformation from the vehicle body coordinate system to the global coordinate system
  • v sagyo ⁇ R 3 is a translational speed component of the bucket operated by the boom 6 and the arm 7 on a working equipment plane (XZ plane in the vehicle body coordinate system) of the translational speed upon operation of the working equipment 1 based on the operation of the operation device 40
  • V MAX is a maximum speed of the bucket 8 in a direction normal to the design surface, for prevention of digging below the design surface.
  • J v ⁇ R 3 ⁇ 5 and J ⁇ ⁇ R 3 ⁇ 5 represent a translational speed component and a rotation speed component of the Jacobian matrix, respectively.
  • the target translational speed calculation unit 551 is configured to calculate the distance between the blade edge 9 and the design surface, on the basis of the positional data of the swing body 2 acquired by the positional data acquisition unit 51 , the angle data of the working equipment 1 acquired by the angle data acquisition unit 52 , and working equipment data stored in the storage unit 60 .
  • the working equipment data includes a boom length L 1 , an arm length L 2 , a bucket length L 3 , a tilt length L 4 , and a bucket width L 5 .
  • the boom length L 1 is a distance between the boom axis AX 1 and the arm axis AX 2 .
  • the arm length L 2 is a distance between the arm axis AX 2 and the bucket axis AX 3 .
  • the bucket length L 3 is a distance between the bucket axis AX 3 and the blade edge 9 of the bucket 8 .
  • the tilt length L 4 is a distance between the bucket axis AX 3 and the tilt axis AX 4 .
  • the bucket width L 5 is a dimension in a width direction of the bucket 8 .
  • the working equipment data includes bucket profile data that indicates the shape and dimensions of the bucket 8 .
  • the bucket profile data includes external surface data of the bucket 8 including the profile of an external surface of the bucket 8 .
  • the bucket profile data includes coordinate data of a plurality of outline points RP of the bucket 8 on the basis of the predetermined portion of the bucket 8 .
  • the target translational speed calculation unit 551 calculates positional data of each of the outline points RP.
  • the target translational speed calculation unit 551 calculates a relative position between the representative point O of the swing body 2 and each of the plurality of outline points RP, in the vehicle body coordinate system.
  • the target translational speed calculation unit 551 is configured to calculate the relative position between the representative point O of the swing body 2 and each of the plurality of outline points RP of the bucket 8 , in the vehicle body coordinate system, on the basis of the working equipment data including the boom length L 1 , the arm length L 2 , the bucket length L 3 , the tilt length L 4 , the bucket width L 5 , and the bucket profile data, and the angle data of the working equipment 1 including the boom angle ⁇ 1 , the arm angle ⁇ 2 , the bucket angle ⁇ 3 , the tilt angle ⁇ 4 , and the rotation angle ⁇ 5 .
  • the target translational speed calculation unit 551 calculates a relative position between the representative point O and the blade edge 9 .
  • the design surface is defined in the vehicle body coordinate system. Therefore, the target translational speed calculation unit 551 is allowed to calculate the distance between the blade edge 9 and the design surface in the vehicle body coordinate system. In addition, the target translational speed calculation unit 551 calculates a position of each of the plurality of outline points RP in the global coordinate system.
  • the target translational speed calculation unit 551 is allowed to calculate the position of each outline point RP of the bucket 8 in the global coordinate system, on the basis of an absolute position of the representative point O of the swing body 2 and the relative position between the representative point O of the swing body 2 and the position of the outline point RP of the bucket 8 .
  • the speed limit calculation unit 551 B determines a speed limit of the boom 6 in the direction normal to the design surface by using a speed limit table indicating a relationship of the distance between the bucket 8 and the design surface to a speed limit of the working equipment 1 .
  • FIG. 7 is a graph illustrating an example of the speed limit table according to the present embodiment.
  • the speed limit table indicates the relationship of the distance between the blade edge 9 and the design surface to the speed limit of the working equipment 1 .
  • the speed limit table when the distance between the blade edge 9 and the design surface is 0, the speed of the working equipment 1 in the direction normal to the design surface becomes 0.
  • the speed limit table when the blade edge 9 is placed above a construction surface, the distance between the blade edge 9 and the design surface has a positive value. When the blade edge 9 is placed below the construction surface, the distance between the blade edge 9 and the construction surface has a negative value.
  • a speed for moving the blade edge 9 upward has a positive value.
  • the speed limit of the working equipment 1 is defined on the basis of the distance between the blade edge 9 and the construction surface.
  • an absolute value of the speed limit of the working equipment 1 has a value that is larger than a maximum value of a target speed of the working equipment 1 .
  • an absolute value of the target speed of the working equipment 1 is always smaller than the absolute value of the speed limit, and thus, the boom 6 is always driven at the target speed.
  • FIG. 8 is a diagram illustrating a method of calculating the target rotation speed (R target of the bucket 8 by the target rotation speed calculation unit 552 according to the present embodiment.
  • the target rotation speed calculation unit 552 includes a current attitude calculation unit 552 A configured to calculate a current attitude R cur of the bucket 8 on the basis of the angle data of the working equipment 1 , a target attitude calculation unit 552 B configured to calculate a target attitude R target of the bucket 8 on the basis of the operation data of the operation device 40 and the design surface data, a rotation speed calculation unit 552 C configured to calculate a rotation speed ⁇ ′ target on the basis of the current attitude R cur and the target attitude R target of the bucket 8 , and a P control unit 552 D configured to perform P control on the rotation speed ⁇ ′ target to calculate the target rotation speed ⁇ target .
  • the rotation speed ⁇ ′ target is calculated on the basis of formulas (7) to (10).
  • ⁇ T target is a parameter corresponding to a time required to correct the attitude of the bucket 8 .
  • the P control unit 552 D calculates the target rotation speed ⁇ target by performing P control on the basis of the rotation speed ⁇ ′ target calculated by the rotation speed calculation unit 552 C.
  • the model predictive control unit 56 calculates a predicted value of the amount of control of the working equipment 1 on the basis of the target value of the amount of control of the working equipment 1 generated by the target value generation unit 55 and a prediction model for the working equipment 1 .
  • the model predictive control unit 56 calculates an amount of drive to control the working equipment 1 on the basis of the predicted value.
  • the model predictive control unit 56 has a prediction model storage unit 561 configured to store the prediction model for the working equipment 1 , and a prediction unit 562 configured to calculate the predicted value of the amount of control of the working equipment 1 on the basis of the target value of the amount of control of the working equipment 1 and the prediction model for the working equipment 1 , and calculate the amount of drive to control the working equipment 1 on the basis of the predicted value of the amount of control of the working equipment 1 .
  • the prediction model storage unit 561 stores a prediction model for the excavator 100 including the working equipment 1 .
  • the prediction model includes a dynamic model for the excavator 100 .
  • the prediction model includes a model for the swing body 2 that swings about the swing axis RX, a model for the boom 6 that rotates about the boom axis AX 1 , a model for the arm 7 that rotates about the arm axis AX 2 , and a model for the bucket 8 that rotates about the bucket axis AX 3 , tilt axis AX 4 , and rotating axis AX 5 .
  • the prediction model is represented by a discrete state equation and an output equation.
  • the state equation of the prediction model for control of the excavator 100 discretized with a sampling time ⁇ T is shown in formula (11).
  • Matrices of the state equation is shown in formulas (12) and (13).
  • the output equation of the prediction model is shown in formula (14).
  • Each of M ⁇ R 5 ⁇ 5 and Co ⁇ R 5 is an inertial matrix of an equation of motion and a Coriolis force/gravity vector.
  • C tay ⁇ R 2np is a constant term when a tailor expansion of n ⁇ p around an angle ⁇ is performed at the predetermined time t.
  • n p is the number of design surfaces to be considered.
  • Outputs from the output equation of the prediction model are an angle ⁇ , an angular speed, the target translational speed v target , the target rotation speed ⁇ target , the distance d between the blade edge 9 and the design surface, and the flow rate Q of the hydraulic oil.
  • the prediction unit 562 performs an optimization operation on the basis of the prediction model and calculates the predicted value of the amount of control of the working equipment 1 .
  • the amount of control of the working equipment 1 includes one or both of the moving speed of the bucket 8 and the position of the predetermined portion of the bucket 8 .
  • the predetermined portion of the bucket 8 includes the blade edge 9 .
  • the amount of control of the working equipment 1 includes an angular speed of the boom 6 , an angular speed of the arm 7 , and an angular speed of the bucket 8 .
  • the angular speed of the bucket 8 includes an angular speed about the bucket axis AX 3 , an angular speed about the tilt axis AX 4 , and an angular speed about the rotating axis AX 5 .
  • the prediction unit 562 predicts a value on the left side of formula (14) several steps ahead from the present time.
  • the prediction unit 562 calculates the amount of drive to control the working equipment 1 , on the basis of at least one of a predicted value of the moving speed of the bucket 8 , a predicted value of the angular speed of each axis, a predicted value of the position of the blade edge 9 of the bucket 8 , and a predicted value of the flow rate of the hydraulic oil.
  • the prediction unit 562 calculates the amount of drive so that the predicted value of the amount of control follows the target value thereof.
  • the prediction unit 562 calculates the amount of drive so that the bucket 8 in a predetermined attitude follows a target design surface, on the basis of the predicted value of the moving speed of the bucket 8 , the predicted value of the angular speed of each axis, the predicted value of the position of the blade edge 9 of the bucket 8 , the predicted value of the flow rate of the hydraulic oil, a predicted value of a swing speed of the swing body 2 and the design surface. In other words, the prediction unit 562 calculates the amount of drive so that the bucket 8 does not dig below the design surface and the position of the blade edge 9 and the position of the design surface coincide with each other.
  • the prediction unit 562 calculates the amount of drive to control the working equipment 1 and the swing body 2 so that an evaluation function has a minimum value and each constraint condition is satisfied.
  • E y (t) is a difference between a target value and a predicted value in output
  • E u (t) is a difference between a target value and a predicted value in input
  • E ⁇ u (t) is a magnitude of the change in input
  • E c (t) is a penalty function that is imposed when the constraint conditions which are described later are not satisfied.
  • the evaluation function is shown in formulas (16) and (17).
  • t) is a target value of time t+i at the time t
  • t) is a plant output at the time t+i predicted at the time t
  • H is a prediction horizon that determines how many steps ahead a prediction is made
  • W is a diagonal matrix that weights to make a prediction variables.
  • the constraint condition calculation unit 57 calculates the constraint conditions.
  • the constraints include a first constraint condition relating to the performance of the excavator 100 and a second constraint condition relating to the position of the bucket 8 .
  • the prediction unit 562 calculates the amount of drive so as to satisfy the constraint conditions calculated by the constraint condition calculation unit 57 .
  • each hydraulic cylinder 10 has a functional range indicating a range in which the hydraulic cylinder 10 functions.
  • the functional range of the hydraulic cylinder 10 includes a hydraulic oil supply range defined for the hydraulic cylinder 10 .
  • a minimum value Q wm_min and a maximum value Q wm_max that are limit values of a hydraulic oil supply flow rate Q wm indicating the flow rate of the hydraulic oil supplied from the hydraulic pump 17 to the hydraulic cylinder 10 via the valve device 18 .
  • the hydraulic oil supply flow rate Q wm for the hydraulic cylinder 10 includes a hydraulic oil supply flow rate Q bm for the boom cylinder 11 , a hydraulic oil supply flow rate Q ar for the arm cylinder 12 , and a hydraulic oil supply flow rate Q bk for the bucket cylinder 13 .
  • a minimum value Q bm_min and a maximum value Q bm_max that are limit values of the hydraulic oil supply flow rate Q bm are defined.
  • a minimum value Q ar_min and a maximum value Q ar_max that are limit values of the hydraulic oil supply flow rate Q ar are defined.
  • a minimum value Q bk_min and a maximum value Q bk_max that are limit values of the hydraulic oil supply flow rate Q bk are defined.
  • the hydraulic oil supply range defined for the hydraulic cylinder 10 is in the range between the minimum value Q wm_min and the maximum value Q wm_max .
  • the constraint condition calculation unit 57 calculates the first constraint condition including the angles ⁇ , angular speed, angular acceleration, and flow rate of the hydraulic oil, of the working equipment 1 .
  • the prediction unit 562 calculates the amount of drive so as to satisfy the first constraint condition.
  • the constraint condition calculation unit 57 converts the constraint condition of the angular acceleration into the constraint condition of torque.
  • the constraint condition of the angular acceleration after conversion is shown in formula (23). ⁇ umlaut over ( ⁇ ) ⁇ min ⁇ M ⁇ 1 ( t ) ⁇ ( t ) ⁇ M ⁇ 1 ( t ) C o ( t ) ⁇ umlaut over ( ⁇ ) ⁇ max (23)
  • the constraint condition calculation unit 57 calculates the second constraint condition including the position of the bucket 8 relative to the design surface.
  • the prediction unit 562 calculates the amount of drive so as to satisfy the second constraint condition.
  • An output d(t) indicates the distance between the blade edge 9 and the design surface.
  • Formulas (24) and (25) show the constraint conditions for preventing the right and left ends of the blade edge 9 from digging below the design surface. n i ⁇ p L ( t ) ⁇ d i (24) n i ⁇ p R ( t ) ⁇ d i (25)
  • n i ⁇ p L ( t ) C i L ⁇ ⁇ ⁇ ( t ) + C t ⁇ a ⁇ y i L ( 26 )
  • n i ⁇ p R ( t ) C i R ⁇ ⁇ ⁇ ( t ) + C t ⁇ a ⁇ y i R ( 27 )
  • the prediction unit 562 uses the evaluation functions shown in formulas (16) and (17) to perform the optimization operation in the model predictive control so as to satisfy the constraint conditions shown in formulas (18) to (27).
  • An optimization problem in the present embodiment is shown in formula (28).
  • quadratic programming (QP) is used for the optimization operation, but another calculation method may be used.
  • ⁇ (t) is a control input torque for a control plant and is a solution of the optimization operation.
  • H u is a control horizon that determines how many steps ahead the inputs are to be handled in the optimization problem.
  • the command unit 58 outputs a control command to control the working equipment 1 on the basis of the amount of drive calculated by the prediction unit 562 .
  • the prediction unit 562 calculates a predicted value of an operation amount in the functional range of each working member or hydraulic cylinder 10 , on the basis of the target value and the prediction model of the working equipment 1 .
  • the prediction unit 562 calculates a predicted value of the angle ⁇ of each working member in the range of movement of the working member.
  • the prediction unit 562 calculates a predicted value of the boom angle ⁇ 1 within the range of movement of the boom 6 .
  • the prediction unit 562 calculates a predicted value of the arm angle ⁇ 2 within the range of movement of the arm 7 .
  • the prediction unit 562 calculates a predicted value of the bucket angle ⁇ 3 within the range of movement of the bucket 8 .
  • the prediction unit 562 predicts the hydraulic oil supply flow rate Q wm in the hydraulic oil supply range of each hydraulic cylinder 10 .
  • the hydraulic oil supply range defined for the hydraulic cylinder 10 is in the range between the minimum value Q wm_min and the maximum value Q wm_max .
  • the prediction unit 562 predicts the hydraulic oil supply flow rate Q bm in the hydraulic oil supply range of the boom cylinder 11 .
  • the prediction unit 562 predicts the hydraulic oil supply flow rate Q ar in the hydraulic oil supply range of the arm cylinder 12 .
  • the prediction unit 562 predicts the hydraulic oil supply flow rate Q bk in the hydraulic oil supply range of the bucket cylinder 13 . The same applies to the tilt cylinder 14 and the rotating cylinder 15 .
  • the determination unit 61 determines whether a first working member of the plurality of working members reaches a limit value of the functional range.
  • the functional range of each working member includes the range of movement of the working member.
  • the limit value of the functional range of the working member includes an end of the range of movement of the working member (an end of a stroke). In other words, the determination unit 61 determines whether the first working member approaches the end of the range of movement.
  • the determination unit 61 is configured to determine whether the working member approaches the range of movement on the basis of detection data of the angle detection device 30 .
  • the approach of the working member to the end of the stroke which is the end of the range of movement, represents that a difference between an actual angle of the working member (angle detected by the angle detection device 30 ) and a stroke end angle that indicates the end of the stroke of the working member is equal to or less than a predetermined threshold.
  • the determination unit 61 determines whether a first hydraulic cylinder 10 of the plurality of hydraulic cylinders 10 reaches the limit value of the functional range.
  • the functional range of the hydraulic cylinder 10 includes the hydraulic oil supply range defined for the hydraulic cylinder 10 .
  • the limit value of the functional range of the hydraulic cylinder 10 includes the minimum value Q wm_min and the maximum value Q wm_max of the hydraulic oil supply range.
  • the determination unit 61 determines whether the hydraulic oil supply flow rate Q wm for the first hydraulic cylinder 10 reaches the minimum value Q wm_min or the maximum value Q wm_max of the hydraulic oil supply range.
  • the reaching of the hydraulic oil supply flow rate for each hydraulic cylinder 10 to a limit value of the hydraulic oil supply range represents that a difference between an actual measurement value of the hydraulic oil supply flow rate for the hydraulic cylinder 10 (hydraulic oil supply flow rate detected by a flow rate sensor which is not illustrated) and the limit value thereof is equal to or less than a predetermined threshold value.
  • the prediction unit 562 calculates an amount of drive to control an operation amount of a second working member so as to prevent the first working member from approaching the limit value of the functional range.
  • the prevention of the first working member from approaching the limit value of the functional range represents that when the determination unit 61 determines that a difference ⁇ between the actual angle of the working member and the stroke end angle indicating the end of the stroke of the working member is equal to or less than the threshold value, the difference ⁇ at the time at which the determination is made by the determination unit 61 is prevented from further decreasing.
  • the prediction unit 562 calculates the amount of drive to control an angle of the second working member so as to prevent the first working member from approaching the end of the range of movement. In an example, when it is determined that the first working member reaches the limit value of the functional range, the prediction unit 562 calculates the amount of drive to control the operation amount of the second working member so that the first working member has a median functional range. In other words, when it is determined that the first working member approaches the end of the range of movement, the prediction unit 562 calculates the amount of drive to control the angle of the second working member so as to prevent the first working member from approaching the end of the range of movement.
  • the prediction unit 562 calculates an amount of drive to control an operation amount of a second hydraulic cylinder 10 so as to prevent the first hydraulic cylinder from approaching the limit value of the functional range.
  • the prevention of the first hydraulic cylinder 10 from approaching the limit value of the functional range represents that when the determination unit 61 determines that a difference ⁇ Q between the actual measurement value of the hydraulic oil supply flow rate for the hydraulic cylinder 10 and the limit value thereof is equal to or less than the threshold value, the difference ⁇ Q at the time at which the determination is made by the determination unit 61 is prevented from further decreasing.
  • the prediction unit 562 calculates an amount of drive to control an operation amount of a second hydraulic cylinder 10 so as to prevent the first hydraulic cylinder from approaching the limit value of the functional range. In an example, when it is determined that the first hydraulic cylinder 10 is to reach the limit value of the functional range, the prediction unit 562 calculates an amount of drive to control an operation amount of a second hydraulic cylinder 10 so that the first hydraulic cylinder has a median functional range.
  • the prediction unit 562 calculates the amount of drive to control a hydraulic oil supply flow rate Q wm_wm2 for the second hydraulic cylinder 10 so that the hydraulic oil supply flow rate Q wm1 for the first hydraulic cylinder changes to a median hydraulic oil supply range Q wm_mid .
  • FIG. 9 is a diagram illustrating an example of an operation of the excavator 100 according to the present embodiment.
  • the example will be described in which when it is determined that the first working member approaches the end of the range of movement, the angle of the second working member is controlled so as to prevent the first working member from approaching the end of the range of movement.
  • the first working member is the bucket 8 and the second working member is one or both of the boom 6 and the arm 7 .
  • the excavator 100 includes the swing body 2 configured to support the working equipment 1 .
  • the driver operates the operation device 40 to move the bucket 8 from a first position P 1 of the design surface IS to a second position P 2 that is closer to the swing body 2 than the first position P 1 .
  • the model predictive control unit 56 calculates the predicted value of the position of the blade edge 9 on the basis of a target value of the position of the blade edge 9 of the working equipment 1 and the prediction model, and calculates the amount of drive to control the working equipment 1 so that the blade edge 9 follows the design surface IS on the basis of the predicted value.
  • the command unit 58 controls the working equipment 1 on the basis of the amount of drive calculated by the model predictive control unit 56 .
  • the prediction unit 562 calculates the amount of drive to control the angle of one or both of the boom 6 and the arm 7 so as to prevent the bucket 8 from approaching the end of the range of movement.
  • the command unit 58 controls the angle of one or both of the boom 6 and the arm 7 on the basis of the amount of drive calculated by the model predictive control unit 56 .
  • the command unit 58 operates the boom 6 to rise so as to prevent the bucket 8 from approaching the end of the range of movement.
  • the command unit 58 may operate the arm 7 to dump so as to prevent the bucket 8 from approaching the end of the range of movement. Therefore, when it is desired to move the bucket 8 from the first position P 1 to the second position P 2 , the bucket 8 is inhibited from reaching the end of the stroke on the way. Therefore, the bucket 8 is allowed to move from the first position P 1 to the second position P 2 . Therefore, it is possible to level the construction target between the first position P 1 and the second position P 2 by a single movement of the bucket 8 .
  • the example has been described in which when it is determined that the first working member approaches the end of the range of movement, the angle of the second working member is controlled so as to prevent the first working member from approaching the end of the range of movement.
  • the hydraulic oil supply flow rate Q wm1 for the first hydraulic cylinder 10 reaches the limit value (the minimum value Q wm_min or the maximum value Q wm_max ) of the hydraulic oil supply range, the hydraulic oil supply flow rate Q wm2 for the second hydraulic cylinder 10 is controlled so that the hydraulic oil supply flow rate Q wm1 for the first hydraulic cylinder 10 changes to the median hydraulic oil supply range Q wm_mid .
  • the prediction unit 562 calculates the amount of drive to control one or both of the hydraulic oil supply flow rate Q bm for the boom cylinder 11 and the hydraulic oil supply flow rate Q ar for the arm cylinder 12 so that the hydraulic oil supply flow rate Q bk for the bucket cylinder 13 changes to the median hydraulic oil supply range (so that the hydraulic oil supply flow rate Q bk is reduced).
  • the command unit 58 outputs the control command to the valve device 18 on the basis of the amount of drive calculated by the prediction unit 562 so that one or both of the hydraulic oil supply flow rate Q bm for the boom cylinder 11 and the hydraulic oil supply flow rate Q ar for the arm cylinder 12 increase.
  • FIG. 10 is a flowchart illustrating a control method for the excavator 100 according to the present embodiment.
  • the control method in the work such as moving the bucket 8 from the first position P 1 to the second position P 2 as described with reference to FIG. 9 will be described.
  • the design surface acquisition unit 54 acquires the design surface data (step S 1 ).
  • the positional data acquisition unit 51 acquires the positional data of the swing body 2 from the position calculation device 20 , as a current value. Furthermore, the angle data acquisition unit 52 acquires the angle data and angular speed data of the working equipment 1 from the angle detection device 30 , as the current values (step S 2 ).
  • the driver operates the operation device 40 .
  • the operation data acquisition unit 53 acquires the operation data from the operation device 40 .
  • the target value generation unit 55 generates the target value of the amount of control of the working equipment 1 on the basis of at least the operation data of the operation device 40 (step S 3 ).
  • the target value of the amount of control of the working equipment 1 includes a target value of the moving speed of the bucket 8 .
  • the target value of the moving speed of the bucket 8 includes the target translational speed v target of the bucket 8 , described with reference to FIG. 6 , and the target rotation speed ⁇ target of the bucket 8 , described with reference to FIG. 8 .
  • the target value generation unit 55 calculates the target value including the target translational speed v target and target rotation speed ⁇ target of the bucket 8 , on the basis of the operation data of the operation device 40 , the angle data indicating each angle ⁇ of the working equipment 1 that changes by operating the operation device 40 and the angular speed data indicating the amount of change in each angle ⁇ per unit time, and the design surface data.
  • the constraint condition calculation unit 57 calculates the first constraint condition relating to the performance of the excavator 100 and the second constraint condition relating to the position of the bucket 8 , on the basis of the operation data of the operation device 40 , the angle data indicating each angle ⁇ of the working equipment 1 that changes by operating the operation device 40 and the angular speed data indicating the amount of change in each angle ⁇ per unit time, and the design surface data (step S 4 ).
  • the prediction unit 562 calculates the amount of drive to control the working equipment 1 so as to satisfy the constraint condition calculated in step S 5 , on the basis of the target value of the amount of control of the working equipment 1 and the prediction model stored in the prediction model storage unit 561 (step S 5 ).
  • the prediction unit 562 calculates the amount of drive of the working equipment 1 , for example, to ten steps ahead from the present time.
  • the prediction unit 562 calculates the predicted value of the amount of control of the working equipment 1 on the basis of the amount of drive calculated in step S 6 and the current value acquired in step S 3 (step S 6 ).
  • the prediction unit 562 calculates the predicted value of the moving speed of the working equipment 1 and the predicted value of the position of the blade edge 9 , for example, to ten steps ahead from the present time.
  • the prediction unit 562 determines whether a predicted value of a bucket speed that is calculated so that the blade edge 9 of the bucket 8 follows the design surface IS exceeds a maximum speed, on the basis of the operation data of the operation device 40 operating the working equipment 1 (step S 7 ).
  • step S 7 if it is determined that the predicted value of the bucket speed does not exceed the maximum speed (step S 7 : No), the prediction unit 562 recalculates the amount of drive so that the predicted value of the amount of control follows the target value thereof (step S 5 ).
  • the prediction unit 562 recalculates the amount of drive so as to minimize the value of the evaluation function defined by the target value and the current value of the amount of control.
  • the prediction unit 562 recalculates the amount of drive so as to satisfy the first constraint condition and the second constraint condition.
  • step S 7 if it is determined that the predicted value of the bucket speed exceeds the maximum speed (step S 7 : Yes), the determination unit 61 determines whether the bucket 8 approaches the end of the stroke that is the end of the range of movement, on the basis of angle data of the bucket 8 acquired by the angle data acquisition unit 52 (step S 8 ).
  • step S 8 if it is determined that the bucket 8 does not approach the end of the stroke (step S 8 : No), the boom 6 and the arm 7 are driven on the basis of the operation of the operation device 40 .
  • step S 8 if it is determined that the bucket 8 approaches the end of the stroke (step S 8 : Yes), the prediction unit 562 recalculates the amount of drive for operating the boom 6 to rise so as to prevent the bucket 8 from approaching the end of the range of movement (step S 5 ).
  • step S 8 if it is determined that the bucket 8 approaches the end of the stroke (step S 8 : Yes), the prediction unit 562 determines whether the evaluation function has the minimum value (step S 9 ).
  • the speed of the bucket 8 may be the angular speed or angular acceleration of each axis of the working equipment 1 or swing body 2 .
  • the maximum speed may be an upper limit.
  • the prediction unit 562 may determine whether a predicted value of the angular acceleration of each axis exceeds the upper limit angular acceleration.
  • step S 9 if it is determined that the evaluation function does not have the minimum value (step S 9 : No), the prediction unit 562 recalculates the amount of drive so that the predicted value of the amount of control follows the target value (step S 5 ).
  • the prediction unit 562 repeats the processing of step S 5 , step S 6 , step S 7 , step S 8 , and step S 9 until the evaluation function has the minimum value.
  • step S 9 if it is determined that the evaluation function has the minimum value (step S 9 : Yes), the command unit 58 outputs the control command for control of the working equipment 1 , on the basis of the amount of drive to control the working equipment 1 which is calculated in step S 6 (step S 10 ).
  • the amount of drive is calculated from the present time, for example, to ten steps ahead.
  • the command unit 58 outputs, as the control command, the amount of drive having been calculated in the first step, from the amounts of drive having been calculated ten steps ahead.
  • the bucket 8 moving from the first position P 1 to the second position P 2 is inhibited from reaching the end of the stroke on the way. Therefore, the bucket 8 is allowed to move from the first position P 1 to the second position P 2 . Therefore, it is possible to level the construction target between the first position P 1 and the second position P 2 by a single movement of the bucket 8 .
  • the model predictive control of the working equipment 1 makes it possible for the control device 50 to control the working equipment 1 so that the bucket 8 follows the design surface, regardless of the conditions of the construction site, which may change variously.
  • the bucket 8 when the bucket 8 is moved from the first position P 1 to the second position P 2 to level the construction target, the bucket 8 may reach the end of the stroke before the bucket 8 reaches the second position P 2 . This may make it impossible to level the ground with a single operation of the bucket 8 . Furthermore, when the bucket 8 is forcibly moved to the second position P 2 , the bucket 8 may dig below the design surface.
  • the model predictive control of the working equipment 1 can cause the working equipment 1 to follow the design surfaces. Therefore, it is possible to construct the construction target into a desired shape while suppressing a decrease in work efficiency.
  • FIG. 11 is a graph illustrating a result of comparison between control of the working equipment 1 by the control method according to the present embodiment and control of the working equipment 1 by a control method according to a comparative example.
  • the horizontal axis represents time and the vertical axis represents distance between the blade edge and the design surface.
  • FIG. 11 illustrates the distance between the blade edge and the design surface when the bucket 8 is moved from the first position P 1 to the second position P 2 as described with reference to FIG. 9 .
  • a line La indicates the result of control of the working equipment 1 controlled by the control method according to the present embodiment
  • a line Lb indicates the result of control of the working equipment 1 by the control method according to the comparative example.
  • the control method according to the comparative example is a control method in which feedback control is performed merely on the basis of the angle data of the working equipment 1 without performing the model predictive control.
  • the control method according to the present embodiment makes it possible for the bucket 8 to move along the design surface, from the first position P 1 to the second position P 2 , without digging below the design surface.
  • the model predictive control of the working equipment 1 makes it possible for the control device 50 to appropriately control the working equipment 1 so that the bucket 8 moves along the design surface.
  • FIG. 12 is a block diagram illustrating an example of a computer system 1000 according to the present embodiment.
  • the control device 50 described above includes the computer system 1000 .
  • the computer system 1000 includes a processor 1001 such as a central processing unit (CPU), a main memory 1002 that includes a nonvolatile memory such as a read only memory (ROM), and a volatile memory such as a random access memory (RAM), a storage 1003 , and an interface 1004 that includes an input/output circuit.
  • the functions of the control device 50 described above are stored, as programs, in the storage 1003 .
  • the processor 1001 reads a program from the storage 1003 , loads the program in the main memory 1002 , and executes the processing described above according to the program. Note that the programs may be distributed to the computer system 1000 via a network.
  • the computer system 1000 is configured to calculate the predicted value of the amount of control of the working equipment 1 , on the basis of the target value of the amount of control of the working equipment 1 and the prediction model for the working equipment 1 , calculate the amount of drive to control the working equipment 1 , on the basis of the predicted value, and output the control command for control of the working equipment 1 , on the basis of the amount of drive.
  • the target value generation unit 55 is configured to employ the speed (translational speed and rotation speed) of the bucket 8 to generate the target value for the model predictive control unit 56 .
  • the target value generation unit 55 may employ the position and attitude of the bucket 8 to generate the target value for the model predictive control unit 56 .
  • control device 50 may be provided in an external computer system for the excavator 100 .
  • the target value generation unit 55 and the model predictive control unit 56 may be provided in the external computer system so that the amount of drive calculated by the external computer system is transmitted to the excavator 100 via a wireless communication system.
  • the construction machine 100 is the excavator.
  • the component elements described in the above embodiments are applicable to a construction machine with working equipment, which is different from the excavator.
  • the swing motor 16 configured to swing the swing body 2 does not need to be the hydraulic motor.
  • the swing motor 16 may be an electric motor configured to be driven by power supply.
  • the working equipment 1 may be operated not by the hydraulic cylinder 10 but by power generated by an electric actuator such as an electric motor.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Operation Control Of Excavators (AREA)
  • Feedback Control In General (AREA)
US17/419,850 2019-02-01 2019-12-19 Control system for construction machine, construction machine, and control method for construction machine Active 2041-01-30 US12000108B2 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2019017390A JP7283910B2 (ja) 2019-02-01 2019-02-01 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP2019-017390 2019-02-01
PCT/JP2019/049873 WO2020158234A1 (ja) 2019-02-01 2019-12-19 建設機械の制御システム、建設機械、及び建設機械の制御方法

Publications (2)

Publication Number Publication Date
US20220074165A1 US20220074165A1 (en) 2022-03-10
US12000108B2 true US12000108B2 (en) 2024-06-04

Family

ID=71839965

Family Applications (1)

Application Number Title Priority Date Filing Date
US17/419,850 Active 2041-01-30 US12000108B2 (en) 2019-02-01 2019-12-19 Control system for construction machine, construction machine, and control method for construction machine

Country Status (6)

Country Link
US (1) US12000108B2 (ko)
JP (1) JP7283910B2 (ko)
KR (1) KR102582987B1 (ko)
CN (1) CN113302359B (ko)
DE (1) DE112019006225T5 (ko)
WO (1) WO2020158234A1 (ko)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2023051363A (ja) * 2021-09-30 2023-04-11 株式会社小松製作所 作業機械を制御するためのシステムおよび方法
JP2023050846A (ja) * 2021-09-30 2023-04-11 株式会社小松製作所 作業機械を制御するためのシステム、方法およびプログラム
CN114688004B (zh) * 2022-03-16 2023-10-27 三一重机有限公司 流量分配方法、装置及作业机械

Citations (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4143778A (en) * 1977-06-03 1979-03-13 Harnischfeger Corporation Shovel attachment means for hydraulic excavator
EP0790355A1 (en) 1995-08-14 1997-08-20 Hitachi Construction Machinery Co., Ltd. Excavation region setting apparatus for controlling region limited excavation by construction machine
US5975833A (en) * 1996-01-30 1999-11-02 Hitachi Construction Machinery Co., Ltd. Swing type hydraulic excavator
US6140787A (en) * 1997-07-23 2000-10-31 Rsi Technologies Ltd. Method and apparatus for controlling a work implement
US20040088103A1 (en) * 2002-10-29 2004-05-06 Koichiro Itow Engine control device
US20100100338A1 (en) * 2006-10-31 2010-04-22 Caterpillar Inc. Monitoring system
US20130190960A1 (en) * 2010-10-06 2013-07-25 Sumitomo Heavy Industries, Ltd. Hybrid working machine
US20130325268A1 (en) * 2011-03-01 2013-12-05 Hitachi Construction Machinery Co., Ltd. Control device for hybrid construction machinery
US20140020375A1 (en) * 2011-05-25 2014-01-23 Hitachi Construction Machinery Co., Ltd. Hydraulic working machine
US20140147238A1 (en) * 2010-10-14 2014-05-29 Masataka Sasaki Construction machine
US20140200776A1 (en) * 2012-04-11 2014-07-17 Komatsu Ltd. Excavation control system for hydraulic excavator
WO2014167718A1 (ja) 2013-04-12 2014-10-16 株式会社小松製作所 建設機械の制御システム及び制御方法
US20150176252A1 (en) * 2013-12-20 2015-06-25 Doosan Infracore Co., Ltd. System and method of controlling vehicle of construction equipment
CN105874131A (zh) 2015-11-19 2016-08-17 株式会社小松制作所 作业机械以及作业机械的控制方法
US20160244950A1 (en) * 2014-05-30 2016-08-25 Komatsu Ltd. Work machine control system, work machine, and work machine control method
US20160258128A1 (en) * 2015-03-05 2016-09-08 Hitachi, Ltd. Trace Generation Device and Working Machine
US20170130428A1 (en) * 2014-07-30 2017-05-11 Sumitomo Heavy Industries, Ltd. Shovel
JP2017179961A (ja) 2016-03-31 2017-10-05 日立建機株式会社 建設機械
US20170342678A1 (en) * 2016-05-31 2017-11-30 Komatsu Ltd. Construction machine control system, construction machine, and construction machine control method
WO2018030220A1 (ja) 2016-08-12 2018-02-15 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
US20180051442A1 (en) * 2015-06-18 2018-02-22 Hitachi Construction Machinery Co., Ltd. Replaceable component management system for construction machine
CN108055855A (zh) 2016-09-16 2018-05-18 日立建机株式会社 作业机械
US20180355583A1 (en) * 2015-12-04 2018-12-13 Hitachi Construction Machinery Co., Ltd. Control system for hydraulic construction machine
US20190017249A1 (en) * 2016-09-16 2019-01-17 Hitachi Construction Machinery Co., Ltd. Construction machine
US20190127946A1 (en) * 2016-07-06 2019-05-02 Hitachi Construction Machinery Co., Ltd. Work machine
US20190218749A1 (en) * 2017-02-21 2019-07-18 Hitachi Construction Machinery Co., Ltd. Work machine
US20190302794A1 (en) * 2018-03-30 2019-10-03 Deere & Company Targeted loading assistance system
US20190338494A1 (en) * 2016-03-31 2019-11-07 Hitachi Construction Machinery Co., Ltd. Construction machine
US20200018037A1 (en) * 2017-09-26 2020-01-16 Hitachi Construction Machinery Co., Ltd. Work machine
US20200141091A1 (en) * 2017-09-19 2020-05-07 Hitachi Construction Machinery Co., Ltd. Work machine
US20200224384A1 (en) * 2018-03-28 2020-07-16 Hitachi Construction Machinery Co., Ltd. Work machine
US20220106773A1 (en) * 2019-02-01 2022-04-07 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine
US20220106764A1 (en) * 2019-02-01 2022-04-07 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine
US20220127825A1 (en) * 2019-02-01 2022-04-28 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017104408A1 (ja) * 2016-11-29 2017-06-22 株式会社小松製作所 作業機制御装置および作業機械
CN107109819B (zh) * 2016-11-29 2020-07-28 株式会社小松制作所 工作装置控制装置以及作业机械
JP6951069B2 (ja) * 2016-11-30 2021-10-20 株式会社小松製作所 作業機制御装置および作業機械

Patent Citations (51)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4143778A (en) * 1977-06-03 1979-03-13 Harnischfeger Corporation Shovel attachment means for hydraulic excavator
EP0790355A1 (en) 1995-08-14 1997-08-20 Hitachi Construction Machinery Co., Ltd. Excavation region setting apparatus for controlling region limited excavation by construction machine
US5975833A (en) * 1996-01-30 1999-11-02 Hitachi Construction Machinery Co., Ltd. Swing type hydraulic excavator
US6140787A (en) * 1997-07-23 2000-10-31 Rsi Technologies Ltd. Method and apparatus for controlling a work implement
US20040088103A1 (en) * 2002-10-29 2004-05-06 Koichiro Itow Engine control device
US6959241B2 (en) * 2002-10-29 2005-10-25 Komatsu Ltd. Engine control device
US20100100338A1 (en) * 2006-10-31 2010-04-22 Caterpillar Inc. Monitoring system
US20130190960A1 (en) * 2010-10-06 2013-07-25 Sumitomo Heavy Industries, Ltd. Hybrid working machine
US20140147238A1 (en) * 2010-10-14 2014-05-29 Masataka Sasaki Construction machine
US20130325268A1 (en) * 2011-03-01 2013-12-05 Hitachi Construction Machinery Co., Ltd. Control device for hybrid construction machinery
US20140020375A1 (en) * 2011-05-25 2014-01-23 Hitachi Construction Machinery Co., Ltd. Hydraulic working machine
US20140200776A1 (en) * 2012-04-11 2014-07-17 Komatsu Ltd. Excavation control system for hydraulic excavator
WO2014167718A1 (ja) 2013-04-12 2014-10-16 株式会社小松製作所 建設機械の制御システム及び制御方法
US9464406B2 (en) 2013-04-12 2016-10-11 Komatsu Ltd. Control system for construction machine and control method
US20150176252A1 (en) * 2013-12-20 2015-06-25 Doosan Infracore Co., Ltd. System and method of controlling vehicle of construction equipment
US20160244950A1 (en) * 2014-05-30 2016-08-25 Komatsu Ltd. Work machine control system, work machine, and work machine control method
US20170130428A1 (en) * 2014-07-30 2017-05-11 Sumitomo Heavy Industries, Ltd. Shovel
US10704230B2 (en) * 2014-07-30 2020-07-07 Sumitomo Heavy Industries, Ltd. Shovel
US20160258128A1 (en) * 2015-03-05 2016-09-08 Hitachi, Ltd. Trace Generation Device and Working Machine
US20180051442A1 (en) * 2015-06-18 2018-02-22 Hitachi Construction Machinery Co., Ltd. Replaceable component management system for construction machine
CN105874131A (zh) 2015-11-19 2016-08-17 株式会社小松制作所 作业机械以及作业机械的控制方法
US9834908B2 (en) 2015-11-19 2017-12-05 Komatsu Ltd. Work machine and control method for work machine
US20170145662A1 (en) 2015-11-19 2017-05-25 Komatsu Ltd. Work machine and control method for work machine
US20180355583A1 (en) * 2015-12-04 2018-12-13 Hitachi Construction Machinery Co., Ltd. Control system for hydraulic construction machine
US20170284057A1 (en) * 2016-03-31 2017-10-05 Hitachi Construction Machinery Co., Ltd. Construction machine
CN107268699A (zh) 2016-03-31 2017-10-20 日立建机株式会社 工程机械
JP2017179961A (ja) 2016-03-31 2017-10-05 日立建機株式会社 建設機械
US10301794B2 (en) 2016-03-31 2019-05-28 Hitachi Construction Machinery Co., Ltd. Construction machine
US20190338494A1 (en) * 2016-03-31 2019-11-07 Hitachi Construction Machinery Co., Ltd. Construction machine
US20170342678A1 (en) * 2016-05-31 2017-11-30 Komatsu Ltd. Construction machine control system, construction machine, and construction machine control method
US20190127946A1 (en) * 2016-07-06 2019-05-02 Hitachi Construction Machinery Co., Ltd. Work machine
US10774502B2 (en) * 2016-07-06 2020-09-15 Hitachi Construction Machinery Co., Ltd. Work machine
WO2018030220A1 (ja) 2016-08-12 2018-02-15 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
KR20180135939A (ko) 2016-08-12 2018-12-21 가부시키가이샤 고마쓰 세이사쿠쇼 건설 기계의 제어 시스템, 건설 기계, 및 건설 기계의 제어 방법
US20190292747A1 (en) * 2016-08-12 2019-09-26 Komatsu Ltd. Control system of construction machine, construction machine, and control method of construction machine
CN109154150A (zh) 2016-08-12 2019-01-04 株式会社小松制作所 建筑机械的控制系统、建筑机械及建筑机械的控制方法
US20190017249A1 (en) * 2016-09-16 2019-01-17 Hitachi Construction Machinery Co., Ltd. Construction machine
US20190226181A1 (en) 2016-09-16 2019-07-25 Hitachi Construction Machinery Co., Ltd. Work machine
US10794046B2 (en) 2016-09-16 2020-10-06 Hitachi Construction Machinery Co., Ltd. Work machine
CN108055855A (zh) 2016-09-16 2018-05-18 日立建机株式会社 作业机械
US20190218749A1 (en) * 2017-02-21 2019-07-18 Hitachi Construction Machinery Co., Ltd. Work machine
US20200141091A1 (en) * 2017-09-19 2020-05-07 Hitachi Construction Machinery Co., Ltd. Work machine
US20200018037A1 (en) * 2017-09-26 2020-01-16 Hitachi Construction Machinery Co., Ltd. Work machine
US11085168B2 (en) * 2017-09-26 2021-08-10 Hitachi Construction Machinery Co., Ltd. Work machine
US20200224384A1 (en) * 2018-03-28 2020-07-16 Hitachi Construction Machinery Co., Ltd. Work machine
US11149404B2 (en) * 2018-03-28 2021-10-19 Hitachi Construction Machinery Co., Ltd. Work machine
US20190302794A1 (en) * 2018-03-30 2019-10-03 Deere & Company Targeted loading assistance system
US10831213B2 (en) * 2018-03-30 2020-11-10 Deere & Company Targeted loading assistance system
US20220106773A1 (en) * 2019-02-01 2022-04-07 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine
US20220106764A1 (en) * 2019-02-01 2022-04-07 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine
US20220127825A1 (en) * 2019-02-01 2022-04-28 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine

Also Published As

Publication number Publication date
DE112019006225T5 (de) 2021-09-02
US20220074165A1 (en) 2022-03-10
WO2020158234A1 (ja) 2020-08-06
JP2020125598A (ja) 2020-08-20
JP7283910B2 (ja) 2023-05-30
KR102582987B1 (ko) 2023-09-25
CN113302359A (zh) 2021-08-24
CN113302359B (zh) 2023-07-28
KR20210095681A (ko) 2021-08-02

Similar Documents

Publication Publication Date Title
US20220106773A1 (en) Control system for construction machine, construction machine, and control method for construction machine
US12000108B2 (en) Control system for construction machine, construction machine, and control method for construction machine
KR101934052B1 (ko) 작업기 제어 장치 및 작업 기계
US20220106764A1 (en) Control system for construction machine, construction machine, and control method for construction machine
US11585071B2 (en) Hystat swing motion actuation, monitoring, and control system
JP2023083576A (ja) 建設機械の制御システム、建設機械、及び建設機械の制御方法
CN111989439B (zh) 推土铲控制装置及推土铲控制方法
CN111971437B (zh) 推土铲控制装置及推土铲控制方法
US20230033938A1 (en) Work machine control system, work machine, and method for controlling work machine
US12031291B2 (en) Blade control device and blade control method

Legal Events

Date Code Title Description
AS Assignment

Owner name: KOMATSU LTD., JAPAN

Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:IWASAKI, YOSHIRO;REEL/FRAME:056718/0549

Effective date: 20210622

FEPP Fee payment procedure

Free format text: ENTITY STATUS SET TO UNDISCOUNTED (ORIGINAL EVENT CODE: BIG.); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

STPP Information on status: patent application and granting procedure in general

Free format text: DOCKETED NEW CASE - READY FOR EXAMINATION

STPP Information on status: patent application and granting procedure in general

Free format text: NON FINAL ACTION MAILED

STPP Information on status: patent application and granting procedure in general

Free format text: RESPONSE TO NON-FINAL OFFICE ACTION ENTERED AND FORWARDED TO EXAMINER

STPP Information on status: patent application and granting procedure in general

Free format text: NOTICE OF ALLOWANCE MAILED -- APPLICATION RECEIVED IN OFFICE OF PUBLICATIONS

STPP Information on status: patent application and granting procedure in general

Free format text: PUBLICATIONS -- ISSUE FEE PAYMENT VERIFIED

STCF Information on status: patent grant

Free format text: PATENTED CASE