WO2023053992A1 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
WO2023053992A1
WO2023053992A1 PCT/JP2022/034600 JP2022034600W WO2023053992A1 WO 2023053992 A1 WO2023053992 A1 WO 2023053992A1 JP 2022034600 W JP2022034600 W JP 2022034600W WO 2023053992 A1 WO2023053992 A1 WO 2023053992A1
Authority
WO
WIPO (PCT)
Prior art keywords
bucket
work machine
excavation
correction
allowable range
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.)
Ceased
Application number
PCT/JP2022/034600
Other languages
English (en)
French (fr)
Inventor
将貴 秋山
樹哉 迫
大輔 野田
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.)
Kobelco Construction Machinery Co Ltd
Original Assignee
Kobelco Construction Machinery Co 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
Priority claimed from JP2022091808A external-priority patent/JP2023053887A/ja
Application filed by Kobelco Construction Machinery Co Ltd filed Critical Kobelco Construction Machinery Co Ltd
Priority to EP22875863.7A priority Critical patent/EP4394131A4/en
Priority to CN202280064461.8A priority patent/CN117980566A/zh
Priority to US18/690,942 priority patent/US20240376694A1/en
Publication of WO2023053992A1 publication Critical patent/WO2023053992A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors 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)
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2033Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/24Safety devices, e.g. for preventing overload
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller

Definitions

  • the present invention relates to work machines that can be automatically operated.
  • Patent Document 1 discloses a construction machine that can be operated automatically.
  • the construction machine automatically performs an operation taught by teaching (teaching operation), and determines whether or not the position of the operation taught by the teaching is within an allowable range before executing the operation. and prompting re-teaching when the position is not within the allowable range.
  • the purpose of the present invention is to provide a work machine that can operate automatically within an allowable range without increasing the burden on workers.
  • a working machine that includes a lower traveling body, an upper revolving body, a working device, and a controller.
  • the upper revolving body is rotatably mounted on the lower traveling body.
  • the working device is attached to the upper revolving body so as to be able to perform a working operation.
  • the controller controls driving of the upper revolving body and the work device so as to cause the upper revolving body and the work device to perform a predetermined operation.
  • the controller determines that the restricted portion of the working device exceeds or may exceed a preset allowable range. It is configured to correct the designated operation so as not to exceed the permissible range.
  • FIG. 1 is a side view of a working machine according to a first embodiment of the present invention
  • FIG. It is a circuit diagram of the working machine and the portable terminal.
  • FIG. 4 is a plan view showing a trajectory of the tip of the bucket associated with a designated operation in the working machine
  • FIG. 10 is a side view showing the trajectory of the tip of the bucket in the designated operation
  • FIG. 4 is a side view showing a first position for determining tolerances on the work machine; It is a side view which shows the 2nd position for determining the said allowable range. It is a side view which shows the 3rd position for determining the said allowable range.
  • FIG. 11 is a side view showing a fourth position for determining the allowable range;
  • FIG. 4 is a plan view showing a trajectory of the tip of the bucket associated with a designated operation in the working machine
  • FIG. 10 is a side view showing the trajectory of the tip of the bucket in the designated operation
  • FIG. 4 is a side view showing a first position
  • FIG. 5 is a side view showing the allowable range determined based on the first to fourth positions;
  • FIG. 10 is a diagram showing the allowable range before the allowable range is updated;
  • FIG. 4B is a side view showing the tolerance range after the tolerance range has been updated;
  • FIG. 4 is a side view showing the dump truck bed and the lower boundary surface of the allowable range set thereabove;
  • FIG. 14 is a side view showing an example in which two waypoints are set between the start point and end point of the excavation operation of the work machine according to the third embodiment;
  • FIG. 5 is a side view showing an example in which a via point is set between the start point and the end point;
  • FIG. 14 is a side view showing an example in which the same correction as the correction of the excavation operation according to the first embodiment is performed in the working machine according to the fourth embodiment;
  • FIG. 11 is a side view showing an example of correction of excavation motion according to the fourth embodiment;
  • FIG. 14 is a side view showing another example of excavation motion correction according to the fourth embodiment.
  • Figure 15 is a side view showing the amount of excavation reduced by the correction shown in Figure 14;
  • FIG. 11 is a side view showing a change in excavation depth to compensate for the reduced excavation volume; It is a flow chart which shows the processing performed by the control unit concerning the 4th embodiment.
  • FIG. 14 is a side view showing correction of excavation performed in the work machine according to the fifth embodiment;
  • FIG. 19 is a side view of the bucket of the work machine shown in FIG.
  • FIG. 19 is a side view showing the trajectory of the tip of the bucket in an excavating operation before the correction shown in FIG. 18 is performed;
  • FIG. 19 is a diagram showing the trajectory of the tip of the bucket due to the excavation operation after the correction shown in FIG. 18 has been performed;
  • FIG. 14 is a side view showing an example in which a portion including the end point of the excavation operation is corrected in the working machine according to the fifth embodiment;
  • FIG. 14 is a diagram showing an example in which a portion including the lowest point in the excavation operation is corrected in the work machine according to the fifth embodiment;
  • FIG. 1 is a side view of a work machine 1 according to an embodiment of the invention.
  • the work machine 1 is a hydraulic excavator, and includes a machine body 25 including a lower travel body 21 and an upper revolving body 22 , an attachment 30 , and a work drive device 40 .
  • the lower traveling body 21 includes a pair of crawlers, and can travel on the ground by moving the pair of crawlers.
  • the upper revolving body 22 is attached to the lower traveling body 21 via a revolving device 24 so as to be able to revolve.
  • the turning device 24 is a turning driving device that turns the upper turning body 22 .
  • the upper revolving body 22 includes a cab (cab) 23 located in its front portion.
  • the attachment 30 is a work device, and is attached to the upper revolving body 22 so as to be able to perform work operations including vertical rotation.
  • the attachment 30 includes a boom 31 , an arm 32 and a bucket 33 .
  • the boom 31 has a base end attached to the upper revolving body 22 so as to be vertically rotatable (raising and lowering), and a tip end on the opposite side.
  • the arm 32 has a base end attached to the tip of the boom 31 so as to be vertically rotatable with respect to the boom 31 and a tip on the opposite side.
  • the bucket 33 is a tip attachment that is the tip of the attachment 30 and is attached to the tip of the arm 32 so as to be rotatable in the front-rear direction with respect to the arm 32 .
  • the bucket 33 has a shape that enables excavation, leveling, scooping, and the like of an object to be excavated such as earth and sand.
  • the object to be excavated is not limited to earth and sand, and may be stones or waste (industrial waste, etc.).
  • the working machine according to the present invention is not limited to an excavating machine, and therefore the work object is not limited to an excavating object.
  • the tip attachment that constitutes the tip of the working device according to the present invention is not limited to the bucket 33, and may be a grapple that grips, a lifting magnet that attracts, or the like.
  • the work drive device 40 hydraulically moves the attachment 30 to perform the work operation.
  • the work drive device 40 in this embodiment includes a plurality of hydraulic cylinders, each of which is extendable, including a boom cylinder 41 , an arm cylinder 42 and a bucket cylinder 43 .
  • the boom cylinder 41 rotates the boom 31 with respect to the upper swing body 22 .
  • the boom cylinder 41 has a base end rotatably connected to the upper rotating body 22 and a tip end rotatably connected to the boom 31 .
  • the arm cylinder 42 rotates the arm 32 with respect to the boom 31 .
  • the arm cylinder 42 has a base end rotatably connected to the boom 31 and a tip end rotatably connected to the arm 32 .
  • the bucket cylinder 43 rotates the bucket 33 with respect to the arm 32 .
  • the bucket cylinder 43 has a base end rotatably connected to the arm 32 and a tip end rotatably connected to the link member 34 .
  • the link member 34 is rotatably connected to the bucket 33 and connects the bucket cylinder 43 and the bucket 33 to each other.
  • the working machine 1 further includes a turning angle sensor 52 as a turning angle detector and a working attitude detector 60 .
  • the turning angle sensor 52 detects the turning angle of the upper turning body 22 with respect to the lower traveling body 21 .
  • the turning angle sensor 52 is, for example, an encoder, resolver, or gyro sensor.
  • the turning angle of the upper turning body 22 when the front of the upper turning body 22 coincides with the front of the lower traveling body 21 is 0°.
  • the working posture detector 60 detects the working posture, which is the posture of the attachment 30, which is the working device.
  • the working posture detector 60 includes a boom tilt angle sensor 61, an arm tilt angle sensor 62, and a bucket tilt angle sensor 63 in this embodiment.
  • the boom tilt angle sensor 61 is attached to the boom 31 and detects the attitude of the boom 31 .
  • the boom tilt angle sensor 61 acquires the tilt angle of the boom 31 with respect to the horizontal line.
  • the boom tilt angle sensor 61 is, for example, a tilt (acceleration) sensor.
  • the attitude detector 60 may include a rotation angle sensor for detecting the rotation angle of the boom 31 around the boom foot pin or a stroke sensor for detecting the stroke of the boom cylinder 41 instead of the boom tilt angle sensor 61. good.
  • the arm tilt angle sensor 62 is attached to the arm 32 and detects the posture of the arm 32 .
  • the arm tilt angle sensor 62 acquires the tilt angle of the arm 32 with respect to the horizontal line.
  • the arm tilt angle sensor 62 is, for example, a tilt (acceleration) sensor.
  • the working posture detector 60 includes a rotation angle sensor for detecting the rotation angle of the arm 32 about the arm connecting pin or a stroke sensor for detecting the stroke of the arm cylinder 42 instead of the arm tilt angle sensor 62. It's okay.
  • the bucket tilt angle sensor 63 is attached to the link member 34 and detects the attitude of the bucket 33 .
  • the bucket tilt angle sensor 63 acquires the tilt angle of the bucket 33 with respect to the horizontal.
  • the bucket tilt angle sensor is, for example, a tilt (acceleration) sensor.
  • the working posture detector 60 includes a rotation angle sensor for detecting the rotation angle of the bucket 33 about the bucket connecting pin or a stroke sensor for detecting the stroke of the bucket cylinder 43 instead of the bucket inclination angle sensor 63. It's okay.
  • the work machine 1 further includes a GNSS (Global Navigation Satellite System) sensor 26 .
  • the GNSS sensor 26 is a GPS sensor or the like, is provided on the upper swing body 22, and detects the coordinates of the position of the upper swing body 22 within the work site.
  • the GNSS sensor 26 may be provided on the undercarriage 21 or the attachment 30 .
  • the GNSS sensor 26 is a positioning sensor, and acquires the coordinates of the position of the work machine 1 (upper swing body 22) in the global coordinate system.
  • the position detection device is not limited to the GNSS sensor 26, and may be a ranging sensor such as a total station.
  • the work machine 1 further includes a LiDAR (Light Detection and Ranging or Laser Imaging Detection and Ranging) 27 .
  • the LiRAR 27 is provided on the upper rotating body 22, but may be provided on the attachment 30 (for example, the boom 31).
  • the LiDAR 27 is an acquisition device that acquires the surrounding conditions of the work site. Specifically, the LiDAR 27 acquires point cloud data indicating the distance from the position where the LiDAR 27 is attached to an object (dump truck or obstacle) in the work site.
  • the acquisition device is not limited to the LiDAR 27, and may be a stereo camera or a TOF (Time Of Flight) sensor.
  • the working machine 1 can communicate with the mobile terminal 3 shown in FIGS. 1 and 2.
  • the mobile terminal 3 is a terminal, such as a tablet terminal, that is carried and operated by a worker at the work site.
  • a worker who operates the mobile terminal 3 is, for example, a person who manages the work machine 1 .
  • the mobile terminal 3 may be a smart phone or the like.
  • FIG. 2 is a circuit diagram of the working machine 1 and the mobile terminal 3.
  • the working machine 1 includes a control unit 11 , a working machine-side communication device 12 and a storage device 13 .
  • the mobile terminal 3 includes a mobile terminal side control unit 15 , a mobile terminal side communication device 16 and a display 17 .
  • the turning angle information is information acquired by the turning angle sensor 52 , that is, information about the turning angle (attitude) of the upper turning body 22 with respect to the lower traveling body 21 .
  • the working attitude information is information about the working attitude of the attachment 30, and includes information about the attitude of the boom 31 acquired by the boom inclination angle sensor 61 and the arm information acquired by the arm inclination angle sensor 62. 32 and information about the attitude of the bucket 33 acquired by the bucket tilt angle sensor 63 .
  • the coordinates of the position of the upper swing body 22 in the work site detected by the GNSS sensor 26 are input to the control unit 11 . Further, the control unit 11 receives information about the surrounding conditions of the work site acquired by the LiDAR 27 .
  • the control unit 11 automatically controls the operation of the work machine 1. Specifically, the control unit 11 causes the upper rotating body 22 and the attachment 30 to perform a designated operation specified in advance, in this embodiment, a series of operations from excavating earth and sand to dumping soil. It can function as control means for controlling the driving of the upper rotating body 22 and the attachment 30 .
  • the working machine 1 can thus be automatically operated.
  • the control unit 11 automatically operates the swing device 24 and the work drive device 40 based on information detected by the swing angle sensor 52 and the work posture detector 60, respectively.
  • the storage device 13 stores the specified action.
  • the specified operation includes a series of operations in this embodiment, and is specified by teaching by the operator.
  • the tip portion of the attachment 30, which is the tip of the bucket 33 in this embodiment draws a predetermined trajectory.
  • the work machine side communication device 12 can communicate with the mobile terminal side communication device 16 of the mobile terminal 3 .
  • FIGS. 3 and 4 are respectively a plan view and a side view showing the trajectory of the tip of the attachment 30 (the tip of the bucket 33 in this embodiment) in the series of operations.
  • the tip of the bucket 33 rotates together with the upper rotating body 22 from point A to point C via point B shown in FIGS. After that, the tip of the bucket 33 moves from the point C to the point E via the point D toward the upper revolving body 22 .
  • the trajectory of the tip of the bucket 33 designated by teaching is indicated by a dotted line.
  • the control unit 11 controls the driving of the upper swing body 22 and the attachment 30 so that the tip of the bucket 33 passes through the points A to E, which are a plurality of target points, in order.
  • the body 22 and the attachment 30 are caused to perform the series of motions.
  • the point B and the point D are a distance Lx ( For example, it is set at a position separated by 6000 mm).
  • the point C is set at a position separated from the turning center axis 20 of the upper turning body 22 in the X direction by a distance (for example, 7000 mm) larger than the distance Lx.
  • the control unit 11 also functions as setting means for setting a permissible range of operation of the attachment 30 in order to prevent interference between the obstacles and the like and the attachment 30 .
  • the control unit 11 sets the allowable range based on information such as the obstacles at the work site.
  • the front boundary surface 73 of the allowable range is indicated by a dashed line.
  • the allowable range may be set in a coordinate system based on the work machine 1, such as a machine coordinate system with the center of rotation of the upper rotating body 22 as an origin, or in a coordinate system based on the work site. For example, it may be set in a global coordinate system.
  • the inner side (the The range on the side closer to the turning center axis 20; the range on the right side of the front boundary surface 73 indicated by the dashed line in FIGS. 3 and 4) is set as the allowable range.
  • the point C is out of the allowable range.
  • the control unit 11 determines that the restriction target portion of the attachment 30, which is the tip of the bucket 33 in this embodiment, exceeds the allowable range (Fig. 4, the tip of the bucket 33 protrudes forward beyond the front boundary surface 73), the designated operation is performed so that the tip of the bucket 33 does not exceed the allowable range (set inside the front boundary surface 73). to correct.
  • the restriction target portion which is the portion of the attachment 30 that is prohibited from deviating from the allowable range, is the tip of the bucket 33, but the restriction target portion is limited to the tip of the bucket 33. can be set arbitrarily.
  • the control unit 11 sets the positions of the points B, C, and D to a distance (for example, 5900 mm) that is smaller than the distance Lx from the turning center axis 20 in the X direction. Change to the position where By correcting the designated operation in this way, the trajectory 71 of the tip of the bucket 33 from the point B to the point D via the point C is changed to the trajectory shown by solid lines in FIGS. 72, i.e., the locus along the front boundary surface 73 at a position on or behind the front boundary surface 73 indicated by the dashed line in FIGS. 3 and 4 (right side in FIGS. 3 and 4). be done. In this way, deviation of the tip of the bucket 33 outside the front boundary surface 73 is restricted. This eliminates the need for the operator to re-designate the designated operation by teaching in order to prevent the tip of the bucket 33 from exceeding the allowable range, thereby reducing the burden on the operator.
  • a distance for example, 5900 mm
  • the control unit 11 controls the specified operation so that the portion of the attachment 30 other than the tip of the bucket 33 does not exceed the allowable range even if the portion of the attachment 30 exceeds the allowable range in at least a part of the specified operation. may be corrected. That is, the restriction target portion of the attachment 30 may be an appropriately set portion other than the tip of the bucket 33 .
  • the tip of the arm 32 may be the farthest portion from the upper swing body 22 .
  • the tip of the boom 31 may be the furthest part from the upper rotating body 22 . In this way, even if the tip of the arm 32 or the tip of the boom 31 exceeds the allowable range, the specified operation is corrected so that the tip does not exceed the allowable range. is prevented from being exceeded.
  • the allowable range is set based on a plurality of possible positions of the tip of the bucket 33, which is the restriction target portion of the attachment 30.
  • FIG. This setting is effective in a site where the allowable range cannot be clearly determined or in a site where the surrounding environment of the work machine 1 changes.
  • the restriction target portion of the attachment 30 is not limited to the tip of the bucket 33, and may be the tip of the arm 32, for example.
  • the tip of the bucket 33 is positioned at the first position shown in FIG. Stored in the control unit 11 .
  • the first position defines the upper end of the tolerance to be set.
  • the tip of the bucket 33 is positioned at the second position shown in FIG. 5B and the second position is stored in the control unit 11 .
  • the second position defines the lower end of the allowable range.
  • the tip of the bucket 33 is positioned at the third position shown in FIG. 5C and the third position is stored in the control unit 11 .
  • the third position defines the front end of the tolerance range.
  • the tip of the bucket 33 is positioned at the fourth position shown in FIG. 5D and the fourth position is stored in the control unit 11 .
  • the fourth position defines the trailing edge of the tolerance.
  • the control unit 11 sets the allowable range Ra as shown in FIG. 5D.
  • Such setting of the allowable range Ra may be performed in a coordinate system (machine coordinate system) based on the work machine 1, or in a coordinate system (for example, a global coordinate system) based on the work site. may be done.
  • the allowable range Ra can be easily set. Moreover, even in a site where the environment around the working machine 1 changes, the allowable range Ra can be flexibly set.
  • the permissible range Ra shown in FIG. 5D is set in front of the working machine 1, but not only in front of the working machine 1 but also behind the working machine 1, for example, as shown in FIG.
  • a permissible range Rb may be set.
  • the allowable range Ra set in front of the work machine 1 is applied when the swing angle of the upper swing body 22 is in the range of -90° to 90° with 0° interposed therebetween.
  • the allowable range Rb set to the rear is applied when the swing angle of the upper swing body 22 is in the range of -90° to 90° with 180° (-180°) interposed therebetween.
  • the permissible range Rb shown in FIG. 6 is set only above the upper rotating body 22 in order to avoid obstacles behind the work machine 1, but is not limited to this.
  • the control unit 11 shown in FIG. 2 transmits to the mobile terminal 3 that the control unit 11 itself corrects the specified action, that is, the series of actions, and the mobile terminal side control unit 15 of the mobile terminal 3 shall notify the amendment.
  • the control unit 11 and the mobile terminal side control unit 15 constitute notification means.
  • the mobile terminal-side control unit 15 causes the display 17 of the mobile terminal 3 to display information about the correction, and the speaker of the mobile terminal 3 notifies about the correction. output a sound for, and/or The notification can notify the operator who manages the work machine 1 that the specified motion will be corrected.
  • control unit 11 may be difficult for the control unit 11 to cause the upper revolving body 22 and the attachment 30 to perform the specified motion corrected by the control unit 11 .
  • the control unit 11 is preferably configured to function as stop control means for stopping the operations of the upper rotating body 22 and the attachment 30 . As a result, it is possible to prevent the upper rotating body 22 and the attachment 30 from making unreasonable movements.
  • the allowable range When the allowable range is set in a coordinate system (machine coordinate system) based on the work machine 1, it moves following the movement of the lower traveling body 21 of the work machine 1 in the traveling direction.
  • a coordinate system for example, a global coordinate system
  • the allowable range for the work machine 1 moves along with the movement of the work machine 1 in the traveling direction. relative position changes.
  • the control unit 11 controls the position of the upper rotating body 22 detected by the GNSS sensor 26, that is, the position in the coordinate system when the allowable range is set in the coordinate system based on the work site. , the allowable range is updated as the work machine 1 moves.
  • the allowable range shown in FIG. 4 that is, the allowable range from the turning center axis 20 to the position separated by the distance Lx (for example, 6000 mm) to the left (X direction) of the lower traveling body 21 is the work site.
  • the control unit 11 moves the turning center axis
  • the allowable range is updated so that the distance from 20 to the outer edge of the allowable range (the left end in FIG. 7) is reduced to a distance Lxr (for example, 5000 mm) smaller than the distance Lx before updating.
  • the update of the allowable range accompanying the movement of the work machine 1 in this manner is performed by adjusting the relative positions of the attachment 30 and the like and the allowable range regardless of the movement of the work machine 1 in the coordinate system based on the work site. Allows relationships to be properly determined. This eliminates the need for the operator to reset the allowable range after the work machine 1 is moved, thereby reducing the burden on the operator.
  • the mobile terminal side communication device 16 of the mobile terminal 3 shown in FIG. 2 can communicate with the working machine side communication device 12 of the working machine 1 .
  • the mobile terminal-side control unit 15 of the mobile terminal 3 acquires locus information and allowable range information from the work machine 1 through the mobile terminal-side communication device 16 .
  • the trajectory information includes information about the trajectory 71 drawn by the tip of the bucket 33 accompanying the specified motion, and information about the trajectory 72 of the tip of the bucket 33 after being changed by correction of the specified motion. include.
  • the permissible range information includes information about the permissible range set as described above and information about the relative positions of the upper rotating body 22 and the attachment 30 with respect to the permissible range.
  • the control unit 11 and the mobile terminal side control unit 15 display information about the specified motion and information about the result of correction of the specified motion by the control unit 11 on the display 17, which is a motion information display device. It functions as an operation display control means for causing the Specifically, trajectories indicated by dotted lines and solid lines in FIGS. 3 and 4, respectively, that is, a trajectory 71 drawn by the tip of the bucket 33 accompanying the specified motion before correction, and a specified motion after correction. A trajectory 72 drawn by the tip of the bucket 33 as it moves is displayed on the display 17 .
  • the display on the display 17 allows the operator to compare the trajectories 71 and 72 before and after the correction to accurately grasp the post-correction movement of the upper rotating body 22 and the attachment 30. It is possible to change the conditions for correction or reset the designated operation when there is a problem with subsequent movement.
  • control unit 11 and the mobile terminal side control unit 15 display the set allowable range and the relative positions of the upper rotating body 22 and the attachment 30 with respect to the allowable range on a display serving as a position information display device. 17.
  • the display 17 displays a front boundary surface 73 of the allowable range and graphics representing the upper swing body 22 and the attachment 30, respectively.
  • the display provided by the display 17 enables the operator to easily grasp the relative positions of the upper rotating body 22 and the attachment 30 with respect to the allowable range (for example, the front boundary surface 73), and furthermore , it is possible to take measures such as moving the working machine 1 when there is a problem with the relative position.
  • the permissible range is set based on a plurality of positions where the tip of the bucket 33, which is the restriction target portion of the attachment 30, can be positioned.
  • the control unit 11 which is the setting means according to the second embodiment, sets the permissible range based on the information about the surrounding conditions input from the management device 4 shown in FIG.
  • the management device 4 manages the surrounding conditions of the work site, and is, for example, a management server.
  • the management device 4 manages information on the positions of obstacles, passages, and the like in the work site.
  • the work machine side communication device 12 of the work machine 101 shown in FIG. 2 can communicate with the management device 4 .
  • the control unit 11 acquires the surrounding conditions of the work site managed by the management device 4 from the management device 4 .
  • the operator of the work machine 101 does not need to perform an operation for setting the allowable range. Therefore, the allowable range can be easily set.
  • control unit 11 which is the setting means of the work machine 101 according to the second embodiment, sets the allowable range based on the ambient conditions of the work site acquired by the LiDAR 27 shown in FIG.
  • FIG. 9 is a side view showing the loading platform 6 of the dump truck 5 and its surroundings, exemplifying the work of dumping earth and sand onto the loading platform 6. As shown in FIG. The setting of the allowable range can also be applied to the work of leveling the earth and sand loaded on the loading platform 6 with the bucket 33 .
  • the amount of earth and sand loaded on the loading platform 6 increases with the number of times of earth removal work on the loading platform 6 .
  • the surrounding conditions around the loading platform 6 acquired by the LiDAR 27 change from moment to moment.
  • the tip of the bucket 33 moves from the left side to the right side in the figure while drawing a trajectory 71 indicated by a dotted line in FIG.
  • the control unit 11 sets an allowable range above the earth and sand loaded on the loading platform 6 based on the surrounding conditions of the work site acquired by the LiDAR 27 .
  • the lower boundary surface 73 of the allowable range is indicated by a dashed line.
  • the side closer to the loading platform 6 than the lower boundary surface 73 (lower side in FIG. 9) is outside the allowable range, and the side farther from the loading platform 6 than the lower boundary surface 73 (upper side in FIG. 9). is the allowable range.
  • the control unit 11 changes the allowable range (the lower boundary surface 73 of the allowable range) every moment in accordance with changes in the amount of earth and sand loaded on the loading platform 6 . In this way, it is possible to set an appropriate allowable range according to changes in the ambient conditions based on the acquired ambient conditions.
  • the control unit 11 which is a correcting means, corrects the specified motion so that the tip of the bucket 33 draws a trajectory 72 indicated by a solid line in FIG.
  • FIG. 10 Note that the description of the configuration common to the first embodiment and the effects produced thereby will be omitted, and mainly the differences from the first embodiment will be described.
  • symbol as 1st Embodiment is attached
  • point A and point B which are target points, are positioned near the front boundary surface (left boundary surface in FIG. 10) 73 of the allowable range indicated by the dashed line. is set.
  • the point B is located below the point A and is closer to the front boundary surface 73 of the tolerance than the point A is. Also, the distance between the points A and B is greater than the distance between the points A and B in the first embodiment shown in FIG.
  • the control unit 11 which is a control means of the work machine 201, controls the driving of the upper rotating body 22 and the attachment 30 so that the tip of the bucket 33 passes through the points A and B in this order.
  • the upper rotating body 22 and the attachment 30 are caused to perform the specified operation.
  • the path of the tip of the bucket 33 between the point A and the point B is not fixed, and therefore any path can be taken between the point A and the point B. Therefore, depending on the route, the tip of the bucket 33 may exceed the allowable range (in FIGS. 10 and 11, it may protrude to the left of the front boundary surface 73), as indicated by a locus 71 indicated by a dotted line.
  • the control unit 11 controls the point A and the At least one via point is set at a position between the point B and within the allowable range (a position on the right side of the front boundary surface 73 in FIGS. 10 and 11).
  • the at least one waypoint includes two waypoints C1 and C2 in the example shown in FIG. However, said at least one waypoint may comprise one or more waypoints.
  • the control unit 11 sets the two waypoints C1 and C2 on the line L1 connecting the points A and B.
  • the line L1 may be straight or curved.
  • the line L1 exemplified in FIG. 10 is a straight line when viewed from the side of the upper revolving body 22 of the working machine 201, and also when viewed in a direction along the revolving axis of the upper revolving body 22 (work line). (even viewed from above the machine 201) is straight.
  • the two waypoints C1 and C2 may be set at equal intervals in the X direction, which is the front-rear direction of the upper rotating body 22, or may be set at equal intervals in the Z direction, which is the vertical direction of the upper rotating body 22. Alternatively, they may be set at positions equally dividing the line L1 itself. Setting the two waypoints C1 and C2 on the line L1, which is a straight line connecting the point A and the point B as described above, can simplify the calculation operation for the setting. can.
  • the control unit 11 functions as correction means for correcting the specified motion so that the tip of the bucket 33 passes through the waypoints C1 and C2.
  • the correction is such that the tip of the bucket 33 exceeds the allowable range even when the point A and the point B are close to the allowable range front boundary surface 73), that is, the front boundary surface 73 is exceeded. to reliably prevent
  • FIG. 11 shows a second example of setting of the waypoints by the control unit 11.
  • the control unit 11 sets the via point C at a position between the two target points A and B and within the allowable range (inner side of the front boundary surface 73, right side in FIG. 11). do.
  • the point B is the final point of the designated motion before correction, and is therefore the downstream target point of the two target points A and B.
  • the waypoint C is set on a straight line L2 passing through the point B.
  • the straight line L2 is a horizontal plane at an angle formed by the horizontal plane when the tip of the bucket 33 passes through the point B by the designated motion before correction and the movement direction of the attachment 30, that is, the moving direction of the tip of the bucket 33. is tilted with respect to
  • the operation at point B is an excavation operation.
  • the setting of the waypoint C as described above enables the attachment 30 to suitably perform the work (excavation work) by the designated operation at the point B. As shown in FIG.
  • the via point C is located directly below the point A when viewed from the side of the upper revolving body 22, and when viewed in the direction along the central axis of revolving of the upper revolving body 22 (the above It is located between the point A and the point B (when the work machine 201 is viewed from above).
  • the straight line L2 is the horizontal plane and the movement direction of the attachment 30 when the attachment 30 performs a predetermined work at the point B, more specifically, the movement direction of the restriction target portion (the tip of the bucket 33 in this embodiment). may be inclined with respect to the horizontal plane at an angle formed by
  • the predetermined work at the point B is excavation work.
  • the attachment 30 can be made to perform the predetermined work (excavation work) at the point B in a suitable manner.
  • FIG. 12 to 17 a working machine 301 according to a fourth embodiment will be described with reference to FIGS. 12 to 17.
  • FIG. Note that the description of the configuration common to the first embodiment and the effects produced thereby will be omitted, and mainly the differences from the first embodiment will be described.
  • symbol as 1st Embodiment is attached
  • the designated operation according to the fourth embodiment is an excavation operation for excavating earth and sand, which is an excavation target, with the bucket 33 of the work machine 301, and the excavation operation is corrected.
  • the object to be excavated is not limited to earth and sand, and may be stones, wastes, or the like.
  • the purpose of the excavation operation is to excavate earth and sand in an excavation range (rectangular range in FIG. 12) 80 surrounded by broken lines in FIG. It is set to the front (to the right in FIG. 12).
  • the permissible range according to the fourth embodiment is defined by a plurality of boundary surfaces indicated by dashed lines in FIG. , a fourth boundary surface 73d and a fifth boundary surface 73e.
  • the second boundary surface 73b is a vertical surface set at a position away from the work machine 301 in front of the lower traveling body 21, and the first boundary surface 73a extends further from the upper end of the second boundary surface 73b. It is a horizontal plane extending away from the work machine 401 .
  • the start point A is the end point of the excavation operation, is at the same height as the soil surface, and is located in front of the second boundary surface 73b (that is, outside the allowable range).
  • the third boundary surface 73c is a horizontal surface along the bottom surface of the excavation range 80 and has a front end and a rear end connected to the second and fourth boundary surfaces 73b and 73d, respectively.
  • the fourth boundary surface 73d is a vertical surface that vertically crosses the earth and sand at a position forward of the front end of the lower traveling body 21 of the working machine 301 and is connected to the rear end of the third boundary surface 73c.
  • the fifth boundary surface 73e is a horizontal surface along the ground on which the work machine 301 rests and is connected to the upper end of the fourth boundary surface 73d.
  • the tip of the bucket 33 excavates along the trajectory 71 indicated by the dashed line in FIG. Exceeding tolerance. More specifically, the tip of the bucket 33 protrudes forward (to the right in FIG. 12) from the second boundary surface (front boundary surface) 73b.
  • correction is performed to change the starting point A to a position on the second boundary surface 73b.
  • the tip of the bucket 33 draws a locus 72 indicated by a solid line. In this trajectory 72 , the penetrating direction in which the bucket 33 penetrates into the earth and sand is substantially vertical, and it is difficult for the tip of the bucket 33 to follow the trajectory 72 .
  • control unit 11 which is the correction means according to the fourth embodiment, is arranged so that the start point X in the excavation operation after correction is within the allowable range, as indicated by the solid line in FIG.
  • the entire excavation range is shifted toward the work machine 301 (to the left in FIG. 13) so that it is positioned at the same height as the soil surface.
  • the height of the power plane can be obtained, for example, by a LiDAR (Height Detector) 27 shown in FIG.
  • the horizontal movement distance La from the start point A of the excavation motion before correction to the start point X of the excavation motion after correction, and the distance La from the end point B of the excavation motion before correction to the and the horizontal movement distance Lb to the end point Y of the excavation operation are equal to each other.
  • the horizontal distance Lb from the end point B of the excavation operation before correction to the point C at the same height on the fourth boundary surface 73d is the start point of the excavation operation before the correction. Since it is larger than the horizontal distance La from A to point D at the same height on the second boundary surface (front boundary surface) 73b, it is assumed that the entire excavation range of the upper revolving body 22 is moved by the horizontal distance Lc. When it is shifted forward (to the right in FIG. 14), the start point X of the excavation operation after correction exceeds the allowable range, that is, the start point moves outside the second boundary surface 73b (to the right in FIG. 14). It will stick out.
  • the entire range of the excavation operation is shifted by the distance La, which is smaller than the distance Lc, so that the start point X of the excavation operation after correction does not exceed the allowable range. Therefore, the start point X of the excavation operation after correction is changed to a point on the second boundary surface 73b.
  • the point B' corresponding to the end point B before the shift cannot reach the fourth boundary surface 73d, and the allowable Since it is located outside the range (behind the fourth boundary surface 73d), the trajectory of the tip of the bucket 33 is shown in FIG. Corrections are made to alter the trajectory 74 shown.
  • the shape of the portion of the trajectory 74 from the starting point X on the second boundary surface 73b to the via point E on the third boundary surface 74d is the same as the trajectory 71 before correction. From E to the end point Y, the trajectory is such that the tip of the bucket 33 rises substantially vertically. Therefore, the waypoint E is the vertical boundary surface closer to the working machine 301 of the boundary surfaces defining the allowable range, that is, the fourth boundary surface 73d, and the trajectory 71 of the bucket 33 before correction. It is the point of intersection with the trajectory 72 obtained by shifting forward by the distance La.
  • the end point Y in the trajectory 74 is located on the front side of the end point B' in the trajectory 72 before the change, so the trajectory 72 before the change is In comparison, the excavated amount of earth and sand is reduced by the area S1 of the shaded area in FIG. .
  • the control unit 11 selects a further trajectory to increase the excavation depth to compensate for the reduced amount of excavation. is preferably arranged to change the
  • FIG. 16 shows a specific example of the further trajectory change.
  • the trajectory 74 shown in FIG. 15 is changed to a lower trajectory 75 .
  • the lowest point D is the lowest point among the points included in the locus 74 . If the trajectory 74 includes multiple lowest points, any of the lowest points is selected.
  • the lowest point D is changed to a point F directly below it (lowest point after change), and the way point E is a point directly below it (on the fourth boundary surface 73d).
  • the waypoint is changed to G.
  • the trajectory 75 is a curved portion connecting the final common point H, the lowest point D and the intermediate point E shown in FIG.
  • the final common point H is the most downstream point of the portion of the locus 75 common to the locus 74 .
  • Such modification is sandwiched between the curve portion before modification (the curve portion connecting points H, D, and E) and the curve portion after modification (the curve portion connecting points H, F, and G). It is possible to supplement the excavation amount by the area of the region (the area S2 of the hatched region in FIG. 16). The lowest point F after the change and the lowest point F after the change and When the waypoint G is set, the excavation amount reduced by the correction shown in FIG. 15 is completely compensated by the further correction shown in FIG.
  • the final common point H is obtained by reducing the step of the corrected trajectory 75 caused by changing the lowest point D and the waypoint E to the changed lowest point F and the waypoint G after change. It is set so as to ensure smooth movement of the bucket 33 .
  • the final common point H is set at a position upstream of the lowest point D by a distance Lh on the locus 74, and the final common point H and the changed lowest point F are connected by straight lines, the trajectory 75 after the further correction is specified. Setting the final common point H such that the difference between the slope of the straight line and the slope of the tangent line of the locus 74 at the final common point H is small, preferably both slopes are equal, is the locus 75. allows to smooth out the
  • the post-change lowest point F is set at a height equal to or higher than the second boundary surface 73b, which is the lower boundary surface of the allowable range. need to Therefore, compensation for the excavation amount due to the downward change from the lowest point D to the post-change lowest point F is performed within the allowable range inside the third boundary surface 73c.
  • FIG. 17 is a flow chart showing processing performed by the control unit 11 for correction according to the fourth embodiment.
  • the control unit 11 determines whether or not at least one of the two end points (start point A and end point B) of the excavation operation before correction is outside the allowable range. It is determined whether or not there is deviation in the direction (step S1). Only when it is determined that at least one of the end points of the excavation motion before correction is outside the allowable range (YES in step S1), the control unit 11 causes the at least one end point to fall within the allowable range. (step S2). For example, if the trajectory before correction is a trajectory 71 whose end point B greatly deviates from the allowable range as shown in FIG. In the same figure, it is moved in the horizontal direction by a horizontal distance La) and shifted to the locus 72 .
  • step S1 If it is determined that all of the end points of the excavation motion before correction are within the allowable range (NO in step S1), horizontal movement of the range of the excavation motion is not necessary, so step S2 and the steps related thereto will be described later. , steps S3 to S6 are omitted.
  • control unit 11 determines whether or not the end point of the horizontally moved excavation operation is still outside the allowable range (step S3). For example, in the example shown in FIG. 14, it is determined whether the point B' after the horizontal movement of the end point B is still outside the allowable range.
  • step S3 When it is determined that the end point is outside the allowable range (YES in step S3), the control unit 11 adjusts the trajectory so that the end point outside the allowable range is within the allowable range. Correct (step S4). For example, when the end point B' after the movement is outside the allowable range as shown in FIG. 14 and 15, the trajectory 72 is changed to a trajectory 74 that rises substantially vertically from the via point E to the end point Y. FIG.
  • control unit 11 determines whether or not the amount of excavation will decrease as the trajectory is corrected (step S5). Only when it is determined that the excavation amount will decrease (YES in step S5), the control unit 11 further corrects the trajectory so as to compensate for the decreased excavation amount (step S6). For example, when the excavation amount decreases by an area S1 as shown in FIGS. The trajectory 74 passing through the point E is changed downward to the trajectory 75 passing through the lowest point F after change and the intermediate point G after change.
  • the control unit 11 determines whether or not the lowest point of the trajectory of the tip of the bucket 33 is outside the allowable range (step S7). Only when it is determined in step S7 that the lowest point is outside the allowable range (YES in step S7), the control unit 11 corrects the lowest point (step S8). For example, if the lowest point F shown in FIG. 16 is below the third boundary surface 73c of the allowable range, the lowest point F is adjusted to fall within the allowable range. Correct the lower point F upward.
  • the control unit 11 controls the drive of the attachment 30 so as to cause the attachment 30 to perform the excavation operation, which is the designated operation finally determined through the processing of steps S1 to S8 described above (step S9 ).
  • FIG. Note that the description of the configuration common to the first embodiment and the effects produced thereby will be omitted, and mainly the differences from the first embodiment will be described.
  • symbol as 1st Embodiment is attached
  • the excavation operation of excavating earth and sand with the bucket 33 is corrected.
  • the series of motions which are designated motions in the fifth embodiment, include an excavation motion of excavating earth and sand with the bucket 33 .
  • the height of the soil surface is detected by the LiDAR (height detector) 27 shown in FIG.
  • a tolerance defined by a plurality of boundary surfaces indicated by dashed lines is set for excavating earth and sand having a soil surface 82 indicated by dashed lines.
  • the plurality of boundary surfaces include a first boundary surface 73a, a second boundary surface 73b, a third boundary surface 73c, and a fourth boundary similar to the first to fifth boundary surfaces 73a to 73e shown in It includes a surface 73d and a fifth boundary surface 73e.
  • the starting point A of the excavation operation is the intersection of the trajectory 71 of the movement of the tip of the bucket 33 by the excavation operation and the soil surface 82, and in the example shown in FIG. It is located on the front side of the surface 73 a , that is, outside the allowable range, and is located at the same height as the soil surface 82 . That is, at the starting point A, the tip of the bucket 33 exceeds the allowable range.
  • correction for moving the starting point A to a position on the second boundary surface 73b, which is the front boundary surface of the allowable range, in the same manner as in the first embodiment, in order to keep the tip of the bucket 33 within the allowable range. is performed, the trajectory 71 of the tip of the bucket 33 is changed to a trajectory 72, and the portion of the trajectory 71 that exceeded the allowable range as shown by the broken line is the second boundary as shown by the solid line. It becomes a surface along the surface 73b, and the start point X after correction is positioned on the second boundary surface 73b.
  • correction of the digging motion involves changing the trajectory of the tip of the bucket 33, thereby changing the ground angle ⁇ of the bucket 33 at least during the beginning portion of the digging motion.
  • the ground angle ⁇ is the angle formed by the upper surface 33a of the bucket 33 with respect to the vertical plane, as shown in FIG. Therefore, the ground angle ⁇ is 0° when the upper surface 33a faces the vertical direction.
  • the control unit 11 which is the correcting means according to the fifth embodiment, corrects the excavation operation based on the set angle ⁇ s, which is the ground angle ⁇ of the bucket 33 set in advance. to set the ground angle ⁇ c of the bucket 33 after correction.
  • the set angle ⁇ s that is, the ground angle of the bucket 33 set in advance is the ground angle set by teaching, numerical input, or the like.
  • the control unit 11 adjusts the ground angle ⁇ of the bucket 33 when the bucket 33 penetrates into earth and sand that is an excavation object (work object) by the excavation operation before correction.
  • the ground angle ⁇ of the bucket 33 when the bucket 33 is penetrated is set.
  • the ground angle ⁇ of the bucket 33 when the bucket 33 penetrates earth and sand is the ground angle of the bucket 33 at the start points A and X of the excavation operation before and after correction.
  • the control unit 11 determines the ground angle ⁇ of the bucket 33 when the bucket 33 is extracted from the earth and sand, and the ground angle ⁇ of the bucket 33 when the bucket 33 is extracted from the earth and sand by the excavation operation before correction.
  • Set to ⁇ The ground angle ⁇ of the bucket 33 when the bucket 33 is pulled out of the earth and sand is the ground angle ⁇ of the bucket 33 at the end points B and Y of the excavation operation before and after the correction. In the example shown in FIG. 18, the end points B and Y before the correction and after the correction match each other.
  • the control unit 11 further controls the ground angles ⁇ a and ⁇ b of the bucket 33 at the start point A and the end point B of the excavation operation before correction, and the excavation operation before correction.
  • the ground angle ⁇ of the bucket 33 in the corrected excavation operation is set based on the path lengths of the trajectories 71 and 72 of the tip of the bucket 33 in each of the corrected excavation operations.
  • the entire excavation operation that is, the entire range between the start point X and the end point Y, is targeted. Part of the range between and Y may be of interest.
  • FIG. 20A shows a trajectory 71 of the tip of the bucket 33 in the excavation motion before correction
  • FIG. 20B shows a trajectory 72 of the tip of the bucket 33 in the excavation motion after correction
  • the ground angle ⁇ a of the bucket 33 at the start point A of the excavation motion before correction and the ground angle ⁇ x of the bucket 33 at the start point X of the excavation motion after correction are equal to each other.
  • the ground angle ⁇ b of the bucket 33 and the ground angle ⁇ y of the bucket 33 at the end point Y of the excavation operation after correction are also equal to each other.
  • the path length Lab of the locus 71 of the tip of the bucket 33 before correction is changed to the path length Lxy of the locus 72 of the tip of the bucket 33 after correction.
  • the control unit 11 adjusts the ground angle ⁇ z of the bucket 33 at any position between the start point X and the end point Y on the trajectory 72 from the start point A on the trajectory 71 before correction to the above It is obtained by the following formula (1) based on the path length Lac to an arbitrary position.
  • an arbitrary position on the locus 72 corresponds to an arbitrary position between the start point A and the end point B on the locus 71 .
  • ⁇ z ⁇ x+( ⁇ y ⁇ x) ⁇ (Lac/Lab) ⁇ Lxy (1)
  • the ground angle ⁇ z of the bucket 33 based on the above equation (1) is set so that when the ground angle ⁇ of the bucket 33 before correction is appropriate, the ground angle of the bucket 33 after correction is also appropriate. enable. This suppresses an increase in excavation resistance due to a change in the trajectory of the tip of the bucket 33 due to the correction of the excavation operation, and enables the earth and sand to be excavated appropriately.
  • the above formula (2) includes the horizontal distances Dab, Dxy, and Dac.
  • the horizontal distance Dab is the horizontal distance between the start point A and the end point B in the excavation operation before correction
  • the horizontal distance Dxy is the start point X and the end point in the excavation operation after correction
  • Y and the horizontal distance Dac is the horizontal distance between the start point A and the arbitrary position on the trajectory 71 .
  • the setting of the ground angle ⁇ z of the bucket 33 based on the formula (2) also enables the ground angle of the bucket 33 after correction to be appropriate when the ground angle of the bucket 33 before correction is appropriate. .
  • the distance from the start point X to the above-mentioned is set based on the above formula (1) or the formula (2), while the ground angle from the via point D to the end point Y is the ground angle before correction. may be set. Further, the ground angle ⁇ from the start point X to the waypoint D may be maintained at the ground angle ⁇ x at the start point X.
  • FIG. 21 shows a case where earth and sand having a soil surface 82 indicated by a dotted line is excavated by the work machine 401, and the allowable range is set similarly to the first to fifth boundary surfaces 73a to 73e shown in FIG.
  • a fourth boundary surface 73d which is a vertical surface closer to the work machine 401, is further away from the work machine 401 than the end point B of the excavation operation included in the specified operation. position, in other words, the end point B is positioned behind the fourth boundary surface 73d (on the left side in FIG. 21), that is, outside the allowable range.
  • the end point B is positioned at the same height as the soil surface 82 . In this case, when the excavation operation is performed to move the tip of the bucket 33 along the trajectory having the end point B, that is, the trajectory 71 including the portion indicated by the broken line in FIG. exceeds the allowable range.
  • the end point B is changed to the end point Y located on the fourth boundary surface 73d as in the first embodiment, and the trajectory 71 is changed as indicated by the solid line.
  • the ground angle of the bucket 33 changes at least in a portion including the end point Y in the excavation operation. Even in this correction, the starting point A before the correction and the starting point X after the correction are the same.
  • FIG. 22 shows a third boundary surface 73c which is the lower boundary surface among the first to fifth boundary surfaces 73a to 73e that define the allowable range in the same manner as the first to fifth boundary surfaces 73a to 73e shown in FIG. is above the lowest point on the trajectory 71 of the movement of the tip of the bucket 33 in the excavating motion included in the specified motion, in other words, the lowest point exceeds the third boundary surface 73c If it is located outside (below) it, it indicates . In this case, when the excavation operation is performed along the locus 71 including the lowest point as indicated by the dashed line, the tip of the bucket 33 exceeds the allowable range at the lowest point and the area before and after the lowest point.
  • the lowest point is moved upward to a point on the third boundary surface 73c, and the portions before and after the lowest point are moved along the third boundary surface 73c.
  • the bucket 33 is not ground-to-ground in a portion including at least the lowest point (horizontal portion along the third boundary surface 73c) of the excavation operation.
  • the angle ⁇ changes. Such a change in the ground angle .theta. increases the excavation resistance and may prevent good excavation of earth and sand.
  • the control unit 11 which is a correction means, adjusts the ground angle of the bucket 33 at the lowest point on the locus 72 so that the bottom surface 33b (see FIG. 19) of the bucket 33 becomes horizontal. set to an angle less than the ground angle.
  • the lowest points on the locus 72 are all points on the locus 72 between the two waypoints E and F shown in FIG.
  • the two waypoints E and F are the intersections of the locus 71 before correction and the third boundary surface 73c, and the portion between the two waypoints E and F is along the third boundary surface 73c. It is the part that extends horizontally across the
  • the ground angle ⁇ of the bucket 33 at the lowest point on the locus 72 is set to an angle equal to or less than the ground angle at which the bottom surface 33b is horizontal. Allows it to be mined.
  • a work machine that can perform automatic operation within the allowable range without increasing the burden on the worker.
  • the work machine includes a lower traveling body, an upper revolving body, a working device, and a controller.
  • the upper revolving body is rotatably mounted on the lower traveling body.
  • the working device is attached to the upper revolving body so as to be able to perform a working operation.
  • the controller controls the driving of the upper rotating body and the attachment so as to cause the upper rotating body and the attachment to perform a predetermined operation.
  • the controller is configured to correct the specified motion so that the working device does not exceed a preset allowable range when a restriction target portion of the working device exceeds a preset allowable range during the specified motion.
  • the controller corrects the specified motion to prevent the restricted target portion from exceeding the allowable range when the restricted target portion exceeds or is likely to exceed the allowable range during the specified motion. , the operator does not need to reset the designated operation by teaching or the like, thereby reducing the burden on the operator.
  • the allowable range may be determined in advance and stored in the controller, or the controller may be configured to set the allowable range. In the latter case, it is preferable that the controller is configured to set the allowable range based on a plurality of possible positions of the specific portion of the working device. This makes it possible to easily set the allowable range by locating the specific parts at the plurality of positions. For example, even in a site where the allowable range cannot be clearly determined, the allowable range can be easily set. Moreover, the allowable range can be flexibly set even in a site where the environment around the work machine changes.
  • the controller is configured to set the allowable range based on information about the surrounding conditions of the work site. This reduces the operator's burden of performing an operation for setting the allowable range, and enables the allowable range to be easily set.
  • the controller is preferably configured to set the allowable range based on the ambient conditions managed by a management device that monitors the ambient conditions of the work site. This enables the allowable range to be easily set by effectively using the information managed by the management device.
  • the work machine further includes an acquisition device that acquires information about the surrounding conditions of the work site, and the controller is configured to set the allowable range based on the surrounding conditions acquired by the acquisition device. good too. This makes it possible to set the allowable range according to the change even though the surrounding situation changes from moment to moment.
  • the controller causes the upper rotating body and the working device to perform the designated operation by controlling driving of the upper rotating body and the working device such that the restriction target portion passes through a plurality of target points in order.
  • the restriction target portion of the working device may exceed the allowable range between two target points selected from the plurality of target points in the specified motion before the correction, the two targets It is preferable that a waypoint is set between the points and within the allowable range, and the specified motion is corrected so that the restriction target part passes through the waypoint.
  • the controller controls the distance between the two target points and By setting the waypoint located within the allowable range and correcting the specified motion so that the restriction target part passes through the waypoint, the restriction target part is prevented from exceeding the allowable range. can.
  • the controller can easily set the waypoint by setting the waypoint on the line L1 connecting the two target points.
  • the controller may be configured to set the waypoint on a straight line passing through the downstream target point.
  • the downstream target point is a target point on the downstream side of the designated motion before the correction among the two target points, and the straight line indicates that the restriction target portion is the target point on the downstream side due to the specified motion before the correction. It is a straight line that is inclined with respect to the horizontal plane at an angle formed by the horizontal plane passing through the point and the direction of movement of the working device. Setting the waypoints on such a straight line enables the working device to preferably perform the designated operation at the downstream target point.
  • the straight line is a straight line that is inclined with respect to the horizontal plane at an angle formed by the horizontal plane when the working device performs a predetermined work operation and the movement direction of the working device, more specifically, the moving direction of the restriction target portion. There may be. Setting the waypoints on such a straight line enables the working device to preferably perform the predetermined work at the downstream target point.
  • the work machine is configured to control the height of the surface of the excavation target object. and the controller determines that at least one of the start point and the end point of the excavation motion before the correction is at a height equivalent to the height of the surface and is within the allowable range. If the end point is located outside the excavation motion, the end point in the excavation motion after the correction is horizontally moved within the allowable range at a height equivalent to the height of the surface. It is preferably configured to allow Such a correction that horizontally moves the range in which the excavation operation is performed makes it possible to maintain the movement of the bucket before the correction and ensure a smooth excavation operation.
  • the controller increases the excavation depth so as to compensate for the decreased amount of excavation. It is preferably arranged to compensate for motion.
  • the correction compensates for the decreased excavation amount by increasing the excavation depth, that is, the depth at which the object is excavated by the bucket, thereby suppressing a decrease in work efficiency due to the correction. .
  • the controller is configured to correct the trajectory of the bucket in a direction to smooth the trajectory as the excavation depth is increased.
  • the correction can suppress obstruction of the smooth movement of the bucket due to, for example, the occurrence of steps in the trajectory of the bucket due to the increase in the excavation depth.
  • the controller is configured to set the ground angle of the bucket in the excavation operation after the correction based on a preset angle of the bucket. This enables good excavation by suppressing an increase in excavation resistance due to a change in the ground angle of the bucket, regardless of the change in the trajectory of the tip of the bucket due to the correction of the excavation operation.
  • the controller adjusts the ground angle of the bucket when it penetrates the excavation object in the excavation operation after the correction to the ground angle of the bucket when it penetrates the excavation object in the excavation operation before the correction.
  • the controller adjusts the ground angle of the bucket when it is extracted from the excavation object in the excavation operation after the correction to the ground angle of the bucket when it is extracted from the excavation object in the excavation operation before the correction.
  • the controller controls the angle of the bucket with respect to the ground at each of the start and end points of the excavation motion before the correction, and the trajectory of the tip of the bucket in each of the excavation motion before the correction and the excavation motion after the correction. It is preferable that the ground angle of the bucket in at least part of the excavation operation after the correction is set based on the path length and the path length. By setting the ground angle of the bucket in this way, when the ground angle of the bucket before the correction is appropriate, the bucket ground angle after the correction can also be appropriate. To suppress an increase in excavation resistance caused by a change in the trajectory of the tip of the bucket due to operation correction, and to perform good excavation.
  • the controller controls the angle of the bucket with respect to the ground at each of the start point and end point of the excavation operation before correction, and the start point and end point of each of the excavation operation before correction and the excavation operation after correction. It is preferable that the ground angle of the bucket in at least a part of the excavation operation after the correction is set based on the horizontal distance between the points. By setting the ground angle of the bucket in this way, when the ground angle of the bucket before the correction is appropriate, the ground angle of the bucket after the correction can also be appropriate. It is possible to perform good excavation by suppressing an increase in excavation resistance caused by a change in the trajectory of the tip of the bucket due to the correction of the excavation operation.
  • the controller is configured to set the ground angle of the bucket at the lowest point of the trajectory of the tip of the bucket to an angle equal to or less than the ground angle at which the bottom surface of the bucket is horizontal. . This makes it possible to suppress the excavation resistance at the lowest point and perform good excavation.
  • the controller is configured to cause a notification device to notify the correction of the specified motion.
  • the notification can inform the operator who manages the work machine of the correction of the specified motion.
  • the controller is configured to stop the operations of the upper rotating body and the working device when it is determined that it is difficult to cause the upper rotating body and the working device to perform the specified motion after correction. It is preferable to be A case where it is difficult to cause the upper revolving body and the work device to perform the specified motion after the correction is, for example, a case where the specified motion after the correction exceeds the motion range of the upper revolving body or the work device. . In such a case, stopping the operations of the upper revolving body and the working device can prevent the upper revolving body and the working device from performing unreasonable movements.
  • the work machine further includes a position detection device that detects the coordinates of the position of at least one of the lower traveling body, the upper revolving body, and the work device in a coordinate system of the work site, and the controller detects the coordinates of the work site.
  • the system is configured to set the allowable range and update the allowable range based on changes in the coordinates of the position detected by the position detection device. Such an update is performed by the operator as the work machine moves, even though the relative positional relationship of the allowable range with respect to the position of the work machine in the coordinate system of the work site changes as the work machine moves. It is possible to appropriately determine the positional relationship between the restriction target portion and the allowable range without resetting the allowable range, thereby reducing the burden on the operator.
  • the restriction target part of the working device is preferably, for example, the tip of the working device.
  • the restriction target portion may be a portion other than the distal end of the working device.
  • the controller can prevent the restriction target portion of the working device from exceeding the allowable range in the specified motion by correcting the specified motion.
  • the controller is configured to display information about the specified motion and information about the result of the correction on the motion information display device.
  • the work that has seen the display on the movement information display device can refer to the information about the specified movement and the information about the result of the correction, so that the upper revolving body and the work device can be corrected. This makes it possible, for example, to change the correction conditions or reset the specified motion when there is a problem with the motion after the correction.
  • the controller may be configured to display information about the allowable range and information about the relative positions of the upper rotating body and the working device with respect to the allowable range on a position information display device. ,preferable. This makes it possible for a worker who sees the display on the position information display device to grasp the relative positions of the upper rotating body and the working device with respect to the allowable range, thereby causing problems with the relative positions. It is possible to take measures such as moving the working machine at times.

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)

Abstract

提供されるのは、作業者の負担を軽減しながら自動運転を行うことが可能な作業機械(1)である。作業機械(1)は、上部旋回体(22)および作業装置(30)が指定動作を行うように上部旋回体(22)および作業装置(30)の駆動を制御するコントローラを備える。コントローラは、指定動作が行われたときに作業装置(30)の制限対象部位が予め設定された許容範囲を超える場合に、制限対象部位が許容範囲を超えないように指定動作を補正する。

Description

作業機械
 本発明は、自動運転されることが可能な作業機械に関する。
 特許文献1には、自動運転されることが可能な建設機械が開示されている。当該建設機械は、ティーチング(教示操作)により教示された動作を自動で行うことと、前記ティーチングにより教示された前記動作に関する位置が許容範囲にあるか否かを当該動作の実行の前に判定することと、前記位置が前記許容範囲にない場合に再度のティーチングを促すことと、が可能である。
 しかしながら、前記再度のティーチングの要求は、当該ティーチングを行う作業者の負担を大きくする。
特開2000-291077号公報
 本発明の目的は、作業者の負担を大きくすることなく許容範囲内での自動運転を行うことが可能な作業機械を提供することである。
 提供されるのは、下部走行体と、上部旋回体と、作業装置と、コントローラと、を備える作業機械である。前記上部旋回体は、前記下部走行体に旋回可能に搭載される。前記作業装置は、作業動作を行うことが可能となるように前記上部旋回体に取り付けられる。前記コントローラは、前記上部旋回体および前記作業装置に予め指定された指定動作を行わせるように前記上部旋回体および前記作業装置の駆動を制御する。前記コントローラは、前記上部旋回体及び前記作業装置が前記指定動作を行うときに前記作業装置の制限対象部位が予め設定された許容範囲を超える場合または超える可能性がある場合に当該制限対象部位が当該許容範囲を超えないように前記指定動作を補正するように構成されている。
本発明の第1実施形態に係る作業機械の側面図である。 前記作業機械および携帯端末の回路図である。 前記作業機械において指定動作に伴うバケットの先端の軌跡を示す平面図である。 前記指定動作における前記バケットの前記先端の軌跡を示す側面図である。 前記作業機械において許容範囲を決めるための第1の位置を示す側面図である。 前記許容範囲を決めるための第2の位置を示す側面図である。 前記許容範囲を決めるための第3の位置を示す側面図である。 前記許容範囲を決めるための第4の位置を示す側面図である。 前記第1~第4の位置に基づいて決定される前記許容範囲を示す側面図である。 前記許容範囲が更新される前の当該許容範囲を示す図である。 前記許容範囲が更新された後の当該許容範囲を示す側面図である。 ダンプカーの荷台及びその上方に設定される許容範囲の下側境界面を示す側面図である。 第3実施形態に係る作業機械の掘削動作の開始点と終了点との間に2つの経由点が設定される例を示す側面図である。 前記開始点と前記終了点との間に経由点が設定される例を示す側面図である。 第4実施形態に係る作業機械において第1実施形態に係る掘削動作の補正と同様の補正が行われた例を示す側面図である。 前記第4実施形態に係る掘削動作の補正の一例を示す側面図である。 前記第4実施形態に係る掘削動作の補正の他の例を示す側面図である。 図14に示される補正により減少した掘削量を示す側面図である。 前記減少した掘削量を補償するための掘削深さの変更を示す側面図である。 前記第4実施形態に係るコントロールユニットにより実行される処理を示すフローチャートである。 第5実施形態に係る作業機械において行われる掘削動作の補正を示す側面図である。 図18に示される前記作業機械のバケット及びその周辺部分の側面図である。 図18に示される前記補正が行われる前の掘削動作による前記バケットの先端の軌跡を示す側面図である。 図18に示される前記補正が行われた後の掘削動作によるバケットの先端の軌跡を示す図である。 第5実施形態に係る作業機械において前記掘削動作の終了点を含む部分が補正された例を示す側面図である。 第5実施形態に係る作業機械において前記掘削動作における最下点を含む部分が補正された例を示す図である。
 以下、本発明の好適な実施の形態について、図面を参照しつつ説明する。
 図1は、本発明の実施形態に係る作業機械1の側面図である。前記作業機械1は、油圧ショベルであり、下部走行体21及び上部旋回体22を含む機械本体25と、アタッチメント30と、作業駆動装置40と、を備える。
 前記下部走行体21は、一対のクローラを含み、当該一対のクローラが動くことにより地面上を走行することが可能である。前記上部旋回体22は、前記下部走行体21に旋回装置24を介して旋回可能に取り付けられる。前記旋回装置24は、前記上部旋回体22を旋回させる旋回駆動装置である。前記上部旋回体22は、その前部に位置するキャブ(運転室)23を含む。
 前記アタッチメント30は、作業装置であり、上下方向の回動を含む作業動作を行うことが可能となるように前記上部旋回体22に取り付けられる。前記アタッチメント30は、ブーム31と、アーム32と、バケット33と、を含む。前記ブーム31は、上下方向に回動可能(起伏可能)となるように前記上部旋回体22に取り付けられる基端部と、その反対側の先端部と、を有する。前記アーム32は、前記ブーム31に対して上下方向に回動可能となるように当該ブーム31の前記先端部に取り付けられる基端部と、その反対側の先端部とを有する。前記バケット33は、前記アタッチメント30の先端部である先端アタッチメントであり、前記アーム32に対して前後方向に回動可能となるように当該アーム32の前記先端部に取り付けられる。前記バケット33は、土砂をはじめとする掘削対象物の掘削、均し、すくい、などを行うことが可能な形状を有する。前記掘削対象物は、土砂に限定されず、石でもよく、廃棄物(産業廃棄物など)でもよい。また、本発明に係る作業機械は掘削機械に限られず、よって、その作業対象物は掘削対象物に限られない。例えば、本発明に係る作業装置の先端を構成する先端アタッチメントは、前記バケット33に限られず、把持動作をするグラップルや吸着をするリフティングマグネット等であってもよい。
 前記作業駆動装置40は、前記アタッチメント30を油圧で動かして前記作業動作を行わせる。前記作業駆動装置40は、この実施の形態では、それぞれが伸縮可能な複数の油圧シリンダを含み、当該複数の油圧シリンダは、ブームシリンダ41と、アームシリンダ42と、バケットシリンダ43と、を含む。
 前記ブームシリンダ41は、前記上部旋回体22に対して前記ブーム31を回動させる。前記ブームシリンダ41は、前記上部旋回体22に回動可能に連結される基端部と、前記ブーム31に回動可能に連結される先端部と、を有する。
 前記アームシリンダ42は、前記ブーム31に対して前記アーム32を回動させる。前記アームシリンダ42は、前記ブーム31に回動可能に連結される基端部と、前記アーム32に回動可能に連結される先端部と、を有する。
 前記バケットシリンダ43は、前記アーム32に対してバケット33を回動させる。前記バケットシリンダ43は、前記アーム32に回動可能に連結される基端部と、リンク部材34に回動可能に連結される先端部と、を有する。前記リンク部材34は、前記バケット33に回動可能に連結され、前記バケットシリンダ43と前記バケット33とを相互に連結する。
 前記作業機械1は、旋回角度検出器である旋回角度センサ52と、作業姿勢検出器60と、をさらに備える。
 前記旋回角度センサ52は、前記下部走行体21に対する前記上部旋回体22の旋回角度を検出する。前記旋回角度センサ52は、例えば、エンコーダ、レゾルバ、又は、ジャイロセンサである。本実施形態では、前記上部旋回体22の前方が前記下部走行体21の前方と一致するときの当該上部旋回体22の旋回角度が0°である。
 前記作業姿勢検出器60は、前記作業装置である前記アタッチメント30の姿勢である作業姿勢を検出する。前記作業姿勢検出器60は、この実施の形態では、ブーム傾斜角センサ61と、アーム傾斜角センサ62と、バケット傾斜角センサ63と、を含む。
 前記ブーム傾斜角センサ61は、前記ブーム31に取り付けられ、前記ブーム31の姿勢を検出する。前記ブーム傾斜角センサ61は、水平線に対するブーム31の傾斜角度を取得する。前記ブーム傾斜角センサ61は、例えば、傾斜(加速度)センサである。前記姿勢検出器60は、前記ブーム傾斜角センサ61に代えて、ブームフットピンを中心とするブーム31の回転角度を検出する回転角度センサまたは前記ブームシリンダ41のストロークを検出するストロークセンサを含んでもよい。
 前記アーム傾斜角センサ62は、前記アーム32に取り付けられ、前記アーム32の姿勢を検出する。前記アーム傾斜角センサ62は、水平線に対する前記アーム32の傾斜角度を取得する。前記アーム傾斜角センサ62は、例えば、傾斜(加速度)センサである。前記作業姿勢検出器60は、前記アーム傾斜角センサ62に代えて、アーム連結ピンを中心とするアーム32の回転角度を検出する回転角度センサまたは前記アームシリンダ42のストロークを検出するストロークセンサを含んでもよい。
 前記バケット傾斜角センサ63は、前記リンク部材34に取り付けられ、前記バケット33の姿勢を検出する。前記バケット傾斜角センサ63は、水平線に対する前記バケット33の傾斜角度を取得する。前記バケット傾斜角センサは、例えば、傾斜(加速度)センサである。前記作業姿勢検出器60は、前記バケット傾斜角センサ63に代えて、バケット連結ピンを中心とするバケット33の回転角度を検出する回転角度センサまたは前記バケットシリンダ43のストロークを検出するストロークセンサを含んでもよい。
 前記作業機械1は、GNSS(Global Navigation Satellite System)センサ26をさらに備える。前記GNSSセンサ26は、GPSセンサなどであり、前記上部旋回体22に設けられ、作業現場内における前記上部旋回体22の位置の座標を検出する。前記GNSSセンサ26は、前記下部走行体21や前記アタッチメント30に設けられていてもよい。前記GNSSセンサ26は、測位センサであり、グローバル座標系における作業機械1(上部旋回体22)の位置の座標を取得する。前記位置検出装置は、前記GNSSセンサ26に限定されず、トータルステーションなどの測距センサであってもよい。
 前記作業機械1は、LiDAR(Light Detection and RangingまたはLaser Imaging Detection and Ranging)27をさらに備える。前記LiRAR27は、前記上部旋回体22に設けられているが、前記アタッチメント30(例えばブーム31)に設けられていてもよい。前記LiDAR27は、作業現場の周囲状況を取得する取得装置である。具体的には、前記LiDAR27は、当該LiDAR27が取り付けられている位置から作業現場内の物体(ダンプカーや障害物)までの距離を示す点群データを取得する。前記取得装置は、前記LiDAR27に限られず、ステレオカメラやTOF(Time Of Flight)センサであってもよい。
 前記作業機械1は、図1及び図2に示される携帯端末3と相互に通信可能である。前記携帯端末3は、作業現場にいる作業者により所持されて操作される端末であり、例えばタブレット端末である。前記携帯端末3を操作する作業者は、例えば、前記作業機械1を管理する者である。前記携帯端末3は、スマートフォン等であってもよい。
 図2は、前記作業機械1および前記携帯端末3の回路図である。図2に示すように、前記作業機械1は、コントロールユニット11と、作業機械側通信装置12と、記憶装置13と、を備える。前記携帯端末3は、携帯端末側コントロールユニット15と、携帯端末側通信装置16と、ディスプレイ17と、を含む。
 前記コントロールユニット11には、旋回角度情報と、作業姿勢情報と、が入力される。前記旋回角度情報は、前記旋回角度センサ52により取得される情報、すなわち、前記下部走行体21に対する前記上部旋回体22の旋回角度(姿勢)に関する情報、である。前記作業姿勢情報は、前記アタッチメント30の作業姿勢に関する情報であり、前記ブーム傾斜角センサ61により取得された、前記ブーム31の姿勢に関する情報と、前記アーム傾斜角センサ62により取得された、前記アーム32の姿勢に関する情報と、前記バケット傾斜角センサ63により取得された、前記バケット33の姿勢に関する情報と、を含む。
 前記コントロールユニット11には、前記GNSSセンサ26により検出される、前記作業現場内における上部旋回体22の位置の座標が入力される。また、前記コントロールユニット11には、前記LiDAR27により取得された、前記作業現場の周囲状況に関する情報が入力される。
 前記コントロールユニット11は、前記作業機械1の動作を自動制御する。具体的に、前記コントロールユニット11は、予め指定された指定動作、この実施の形態では、土砂の掘削から排土までの一連の動作、を前記上部旋回体22および前記アタッチメント30に行わせるように前記上部旋回体22および前記アタッチメント30の駆動を制御する制御手段として機能することが可能である。前記作業機械1はこのようにして自動運転されることが可能である。具体的に、前記コントロールユニット11は、前記旋回角度センサ52および前記作業姿勢検出器60によりそれぞれ検出される情報に基づいて、前記旋回装置24および前記作業駆動装置40を自動的に動作させる。
 前記記憶装置13は、前記指定動作を記憶する。前記指定動作は、この実施の形態では一連の動作を含み、作業者によるティーチングにより指定される。前記指定動作により、前記アタッチメント30の先端部位、この実施の形態では前記バケット33の先端、が所定の軌跡を描く。
 前記作業機械側通信装置12は、前記携帯端末3の前記携帯端末側通信装置16と通信可能である。
 図3及び図4は、それぞれ、前記一連の動作における前記アタッチメント30の先端(この実施の形態では前記バケット33の先端)の軌跡を示す平面図及び側面図である。前記バケット33の先端は、図3及び図4に示される点Aから点Bを経由して点Cまで前記上部旋回体22とともに旋回する。その後、前記バケット33の先端は、前記点Cから点Dを経由して点Eまで前記上部旋回体22に向かって移動する。図3及び図4では、ティーチングにより指定された前記バケット33の先端の軌跡が点線で示されている。このように、前記コントロールユニット11は、前記バケット33の先端が複数の目標点である前記点A~点Eを順番に通るように上部旋回体22およびアタッチメント30の駆動を制御して前記上部旋回体22および前記アタッチメント30に前記一連の動作を行わせている。
 図4に示すように、前記点B点および前記点Dは、前記上部旋回体22の旋回中心軸20から前記下部走行体21の左方(図4の左方;X方向)に距離Lx(例えば6000mm)だけ離れた位置に設定されている。前記点Cは、前記上部旋回体22の前記旋回中心軸20から前記X方向に前記距離Lxよりも大きな距離(例えば7000mm)だけ離れた位置に設定されている。
 上記のように、ティーチングにより前記一連の動作が指定される一方、作業現場には前記指定動作を行う前記アタッチメント30と干渉する障害物などが存在する場合がある。この実施の形態に係る前記コントロールユニット11は、前記障害物等と前記アタッチメント30との干渉を防ぐため、当該アタッチメント30の動作について許容範囲を設定する設定手段としても機能する。例えば、前記コントロールユニット11は、作業現場における前記障害物等の情報に基づいて前記許容範囲を設定する。図3及び図4では前記許容範囲の前側境界面73が一点鎖線で示されている。前記許容範囲は、前記作業機械1を基準とする座標系、例えば前記上部旋回体22の旋回中心を原点とする機械座標系、において設定されてもよいし、作業現場を基準とする座標系、例えばグローバル座標系、において設定されてもよい。
 図3及び図4に示される例では、前記上部旋回体22の旋回中心軸20から前記X方向(下部走行体21の左方向)に前記距離Lx(例えば6000mm)だけ離れた位置よりも内側(前記旋回中心軸20に近い側;図3及び図4では一点鎖線で示される前記前側境界面73の右側)の範囲が前記許容範囲に設定される。前記点Cは前記許容範囲から外れている。
 前記コントロールユニット11は、前記アタッチメント30が前記指定動作すなわち前記一連の動作を行ったときに前記アタッチメント30の制限対象部位、この実施の形態では前記バケット33の先端、が前記許容範囲を超える(図4に示される例では前記前側境界面73よりも前側にはみ出る)場合に、当該バケット33の先端が前記許容範囲を超えない(前記前側境界面73の内側に収まる)ように、前記指定動作を補正する。本実施形態において、前記アタッチメント30のうち前記許容範囲からの逸脱が禁止される部位である制限対象部位は、前記バケット33の先端であるが、当該制限対象部位は当該バケット33の先端に限定されず、任意に設定されることが可能である。
 前記コントロールユニット11は、例えば、前記点B、前記点C、および、前記点Dのそれぞれの位置を前記旋回中心軸20からの前記X方向の距離が前記距離Lxよりも小さい距離(例えば5900mm)となる位置に変更する。このような指定動作の補正により、前記点Bから前記点Cを経由して前記点Dに至るまでの前記バケット33の先端の軌跡71は、図3及び図4に実線で示されるような軌跡72、すなわち、図3及び図4に一点鎖線で示される前記前側境界面73上またはそれよりも後側(図3及び図4では右側)の位置で当該前側境界面73に沿う軌跡、に変更される。このようにして、前記前側境界面73の外側に前記バケット33の先端が逸脱することが制限される。このことは、前記バケット33の先端が前記許容範囲を超えることを防ぐために作業者がティーチングなどによって前記指定動作を再指定する手間をなくし、これにより、作業者の負担を軽減する。
 前記コントロールユニット11は、前記指定動作の少なくとも一部において前記バケット33の先端以外の前記アタッチメント30の部分が前記許容範囲を超える場合にも、当該部分が前記許容範囲を超えないように前記指定動作を補正してもよい。つまり、前記アタッチメント30の前記制限対象部位は、前記バケット33の先端以外で適当に設定された部位であってもよい。例えば、前記アーム32に対する前記バケット33の回動角度によっては、当該アーム32の先端が前記上部旋回体22から最も遠い部分になる場合がある。また、前記ブーム31に対する前記アーム32の回動角度によっては、当該ブーム31の先端が前記上部旋回体22から最も遠い部分になる場合がある。このようにして前記アーム32の先端または前記ブーム31の先端が前記許容範囲を超える場合にも当該先端が前記許容範囲を超えないように前記指定動作を補正することが、当該先端が当該許容範囲を超えることが防がれるのを可能にする。
 次に、前記コントロールユニット11による前記許容範囲の設定の一例を説明する。この例では、前記アタッチメント30の制限対象部位である前記バケット33の先端が位置することが可能な複数の位置に基づいて、前記許容範囲が設定される。この設定は、前記許容範囲を明確に決められないような現場や、前記作業機械1の周辺の環境が変化するような現場において有効である。前記アタッチメント30の前記制限対象部位は、前記バケット33の先端に限定されず、例えば前記アーム32の先端であってもよい。
 前記例では、まず、オペレータの操作等によってバケット33の先端が図5Aに示される第1の位置に位置決めされ、この第1の位置で指定操作等が行われることにより当該第1の位置が前記コントロールユニット11に格納される。前記第1の位置は、設定されるべき許容範囲の上端を規定する。同様に、前記バケット33の先端が図5Bに示される第2の位置に位置決めされて当該第2の位置が前記コントロールユニット11に格納される。前記第2の位置は、前記許容範囲の下端を規定する。同様に、前記バケット33の先端が図5Cに示される第3の位置に位置決めされて当該第3の位置が前記コントロールユニット11に格納される。前記第3の位置は、前記許容範囲の前端を規定する。同様に、前記バケット33の先端が図5Dに示される第4の位置に位置決めされて当該第4の位置が前記コントロールユニット11に格納される。前記第4の位置は前記許容範囲の後端を規定する。このようにして指定された前記第1~第4の位置に基づき、前記コントロールユニット11は図5Dに示されるような許容範囲Raを設定する。このような前記許容範囲Raの設定は、前記作業機械1を基準とする座標系(機械座標系)において行われてもよいし、作業現場を基準とする座標系(例えば、グローバル座標系)において行われてもよい。
 このように、前記バケット33の先端が位置することが可能な複数の位置にそれぞれ当該バケット33の先端を位置させることで、例えば制限範囲を明確に決められないような現場においても、前記許容範囲Raを容易に設定することができる。また、前記作業機械1の周辺の環境が変化するような現場においても、前記許容範囲Raを柔軟に設定することができる。
 図5Dに示される前記許容範囲Raは前記作業機械1の前方に設定されているが、前記作業機械1の前方だけでなく、前記作業機械1の後方にも、例えば図6に示されるような許容範囲Rbが設定されてよい。前記作業機械1の前方に設定された前記許容範囲Raは、前記上部旋回体22の旋回角度が0°を挟んで-90°~90°の範囲にあるときに適用され、前記作業機械1の後方に設定された前記許容範囲Rbは、前記上部旋回体22の旋回角度が180°(-180°)を挟んで-90°~90°の範囲にあるときに適用される。図6に示される前記許容範囲Rbは、前記作業機械1の後方にある障害物を避けるために前記上部旋回体22よりも上側にのみ設定されているが、これに限定されない。
 図2に示される前記コントロールユニット11は、当該コントロールユニット11自身が前記指定動作すなわち前記一連の動作を補正することを前記携帯端末3に送信し、当該携帯端末3の前記携帯端末側コントロールユニット15は、当該補正についての報知を行う。このようにして前記コントロールユニット11及び前記携帯端末側コントロールユニット15は報知手段を構成する。具体的に、前記携帯端末側コントロールユニット15は、前記携帯端末3の前記ディスプレイ17に前記補正についての報知のための表示を行わせること、及び、前記携帯端末3のスピーカから前記補正についての報知のための音を出力させること、の少なくとも一方を行う。当該報知は、前記指定動作が補正されることを前記作業機械1を管理する作業者に知らせることができる。
 前記コントロールユニット11により補正された後の前記指定動作を当該コントロールユニット11が前記上部旋回体22および前記アタッチメント30に行わせるのが困難になる場合がある。例えば、前記指定動作の補正が前記ブームシリンダ41のフルストロークでの伸長を生じさせると、これ以上ブーム31を上側に回動させることができなくなる。このような場合に、前記コントロールユニット11は、前記上部旋回体22およびアタッチメント30の動作を停止させる停止制御手段として機能するように構成されることが、好ましい。これにより、前記上部旋回体22および前記アタッチメント30が無理な動作を行うのを抑制することができる。
 前記許容範囲は、前記作業機械1を基準とする座標系(機械座標系)において設定されている場合、前記作業機械1の前記下部走行体21の走行方向への移動に追随して移動する。一方、前記許容範囲が作業現場を基準とする座標系(例えば、グローバル座標系)において設定されている場合、前記走行方向への前記作業機械1の移動に伴って当該作業機械1に対する前記許容範囲の相対位置が変化する。
 前記コントロールユニット11は、前記作業現場を基準とする座標系に前記許容範囲が設定されている場合に、前記GNSSセンサ26により検出される前記上部旋回体22の位置すなわち前記座標系における位置に基づいて、前記作業機械1の移動に伴い前記許容範囲を更新する。例えば、上述のように図4に示される許容範囲すなわち前記旋回中心軸20から下部走行体21の左方(X方向)に距離Lx(例えば6000mm)だけ離れた位置までの許容範囲が前記作業現場を基準とする座標系において設定されている場合に、図8に示すように、前記作業機械1が前記X方向に所定距離(例えば1000mm)だけ移動した場合、前記コントロールユニット11は前記旋回中心軸20から前記許容範囲の外側端(図7では左端)までの距離を更新前の前記距離Lxよりも小さい距離Lxr(例えば5000mm)まで縮小するように前記許容範囲を更新する。
 このような前記作業機械1の移動に伴う前記許容範囲の更新は、前記作業現場を基準とする座標系での前記作業機械1の移動にかかわらず前記アタッチメント30などと前記許容範囲との相対位置関係が適正に判定されることを可能にする。このことは、前記作業機械1の移動後に作業者が改めて前記許容範囲を再設定する必要をなくし、作業者の負担を軽減する。
 図2に示される前記携帯端末3の前記携帯端末側通信装置16は、前記作業機械1の前記作業機械側通信装置12と通信可能である。前記携帯端末3の前記携帯端末側コントロールユニット15は、前記携帯端末側通信装置16を通じて前記作業機械1から軌跡情報及び許容範囲情報を取得する。前記軌跡情報は、前記指定動作に伴って前記バケット33の先端が描く前記軌跡71についての情報、および、前記指定動作の補正によって変化した後の前記バケット33の先端の前記軌跡72についての情報を含む。前記許容範囲情報は、前記のようにして設定された前記許容範囲についての情報、および、当該許容範囲に対する前記上部旋回体22および前記アタッチメント30の相対位置についての情報を含む。
 前記コントロールユニット11および前記携帯端末側コントロールユニット15は、前記指定動作についての情報と、当該指定動作の前記コントロールユニット11による補正の結果についての情報と、を動作情報表示装置であるディスプレイ17に表示させる動作表示制御手段として機能する。具体的には、図3及び図4に点線及び実線でそれぞれ示される軌跡、すなわち、補正される前の前記指定動作に伴って前記バケット33の先端が描く軌跡71と、補正された後の指定動作に伴って前記バケット33の先端が描く軌跡72と、が前記ディスプレイ17に表示される。当該ディスプレイ17による表示は、作業者が前記補正の前後における前記軌跡71,72を比較して前記上部旋回体22および前記アタッチメント30の補正後の動きを的確に把握すること、さらには、当該補正後の動きに問題がある場合に前記補正の条件の変更または前記指定動作の再設定を行うこと、を可能にする。
 また、前記コントロールユニット11および前記携帯端末側コントロールユニット15は、設定された前記許容範囲と、当該許容範囲に対する前記上部旋回体22および前記アタッチメント30の相対位置と、を位置情報表示装置であるディスプレイ17に表示させる。例えば、図3及び図4に示すように、前記許容範囲の前側境界面73と、前記上部旋回体22および前記アタッチメント30をそれぞれ示す図形と、が前記ディスプレイ17に表示される。当該ディスプレイ17により提供される表示は、前記許容範囲(の例えば前記前側境界面73)に対する前記上部旋回体22および前記アタッチメント30の相対位置を作業者が容易に把握することを可能にし、さらには、当該相対位置に問題がある場合に前記作業機械1を移動させるなどの対処をすることを可能にする。
 次に、第2実施形態の作業機械101について、図面を参照しつつ説明する。なお、第1実施形態と共通する構成およびそれにより奏される効果については説明を省略し、主に、第1実施形態と異なる点について説明する。なお、第1実施形態と同じ部材については、第1実施形態と同じ符号を付している。
 前記第1実施形態では、図5に示したように、前記アタッチメント30の制限対象部位である前記バケット33の先端が位置することが可能な複数の位置に基づいて前記許容範囲が設定されるのに対し、第2実施形態に係る設定手段であるコントロールユニット11は、図2に示される管理装置4から入力される周囲状況に関する情報に基づいて許容範囲を設定する。前記管理装置4は、作業現場の周囲状況を管理するものであり、例えば管理サーバである。前記管理装置4は、作業現場における障害物や通路などの位置に関する情報を管理する。
 図2に示される前記作業機械101の作業機械側通信装置12は、前記管理装置4と通信可能である。前記コントロールユニット11は、前記管理装置4が管理する作業現場の周囲状況を当該管理装置4から取得する。前記管理装置4が管理する情報を用いることで、例えば前記作業機械101の操作者が許容範囲を設定するための操作をする必要がなくなる。よって、前記許容範囲が容易に設定されることが可能である。
 具体的に、第2実施形態に係る前記作業機械101の設定手段である前記コントロールユニット11は、図2に示されるLiDAR27により取得される作業現場の周囲状況に基づいて前記許容範囲を設定する。
 前記許容範囲の設定の例が図9を参照しながら説明される。図9は、ダンプカー5の荷台6及びその周辺を示す側面図であり、前記荷台6に土砂を排土する作業を例示する。前記許容範囲の設定は、前記荷台6に積載された土砂をバケット33で均す作業についても適用されることができる。
 前記荷台6に積載される土砂の量は、当該荷台6への排土作業の回数とともに増加する。これにより、前記LiDAR27によって取得される前記荷台6の周辺の周囲状況は、時々刻々と変化する。
 前記排土作業について指定された動作に伴い、前記バケット33の先端は図9に点線で示される軌跡71を描きながら、図中左側から右側に移動する。
 前記コントロールユニット11は、前記LiDAR27が取得した作業現場の周囲状況に基づいて、前記荷台6に積載された土砂の上方に許容範囲を設定する。図9において、前記許容範囲の下側境界面73が一点鎖線で示される。前記下側境界面73よりも前記荷台6に近い側(図9では下側)が前記許容範囲の外側であり、前記下側境界面73よりも前記荷台6から遠い側(図9では上側)が前記許容範囲である。前記コントロールユニット11は、前記荷台6に積載された土砂の量の変化に応じて前記許容範囲(の前記下側境界面73)を時々刻々と変化させる。このように、取得される周囲状況に基づいて当該周囲状況の変化に応じた適正な許容範囲が設定されることが可能である。
 図9に示されるような形状で土砂が前記荷台6に積載されている場合、前記バケット33の先端は、図9に点線で示される軌跡71に沿って前記荷台6の前側(図9では右側)に移動すると前記土砂に衝突するおそれがある。このような衝突を防ぐため、補正手段である前記コントロールユニット11は、前記バケット33の先端が図9に実線で示される軌跡72を描くように前記指定動作を補正する。
 次に、第3実施形態に係る作業機械201について図10及び図11を参照しつつ説明する。なお、第1実施形態と共通する構成およびそれにより奏される効果については説明を省略し、主に、第1実施形態と異なる点について説明する。なお、第1実施形態と同じ部材については、第1実施形態と同じ符号を付している。
 この第3実施形態では、指定動作中にバケット33の先端が許容範囲を超える可能性がある場合に当該指定動作の補正が行われる。この第3実施形態では、図10に示すように、一点鎖線で示される前記許容範囲の前側境界面(図10では左側の境界面)73に近い位置に目標点である点A及び点Bが設定されている。前記点Bは前記点Aの下方に位置しかつ前記点Aよりも前記許容範囲の前記前側境界面73に近い。また、前記点Aと前記点Bとの間隔は、図4に示される前記第1実施形態での点Aと点Bとの間隔よりも大きい。
 前記作業機械201の制御手段であるコントロールユニット11は、前記バケット33の先端が前記点A及び前記点Bをこの順に通るように前記上部旋回体22および前記アタッチメント30の駆動を制御することにより当該上部旋回体22および当該アタッチメント30に前記指定動作を行わせる。前記点Aと前記点Bとの間における前記バケット33の先端の経路は決まっておらず、よって、前記点Aと前記点Bとの間では任意の経路を取り得る。そのため、経路によっては、点線で示される軌跡71のように前記バケット33の先端が前記許容範囲を超える(図10及び図11では前記前側境界面73よりも左側にはみ出る)可能性がある。
 前記コントロールユニット11は、このように補正前の指定動作中に前記点Aと前記点Bとの間において前記バケット33の先端が前記許容範囲を超える可能性がある場合に、前記点Aと前記点Bとの間でかつ前記許容範囲内の位置(図10及び図11では前記前側境界面73よりも右側の位置)に少なくとも一つの経由点を設定する。前記少なくとも一つの経由点は、図10に示される例では、2つの経由点C1,C2を含む。しかし、前記少なくとも一つの経由点は、1または3以上の経由点を含んでもよい。
 前記コントロールユニット11は、図10に示される例では、前記点Aと前記点Bとを結ぶ線L1上に前記2つの経由点C1,C2を設定する。前記線L1は直線であっても曲線であってもよい。図10に例示される前記線L1は、前記作業機械201の前記上部旋回体22の側方から見て直線であり、かつ、前記上部旋回体22の旋回軸に沿う方向に見ても(作業機械201の上方から見ても)直線である。前記2つの経由点C1,C2は、前記上部旋回体22の前後方向であるX方向に等間隔に設定されてもよいし、前記上部旋回体22の上下方向であるZ方向に等間隔に設定されてもよいし、前記線L1そのものを等分する位置にそれぞれ設定されてもよい。前記のように前記点Aと前記点B点とを結ぶ直線である前記線L1上に前記2つの経由点C1,C2を設定することは、当該設定のための演算動作を簡易にすることができる。
 前記コントロールユニット11は、前記バケット33の先端が前記経由点C1,C2を通るように前記指定動作を補正する補正手段として機能する。当該補正は、前記点A及び前記点Bが前記許容範囲の前記前側境界面73)に近い場合であっても前記バケット33の先端が前記許容範囲を超えること、つまり前記前側境界面73を超えること、を確実に防ぐ。
 図11は、前記コントロールユニット11による前記経由点の設定の第2の例を示す。この第2の例において、前記コントロールユニット11は、2つの目標点A及び点Bの間でかつ許容範囲内(前側境界面73よりも内側、図11では右側)の位置に経由点Cを設定する。前記点Bは、補正前の指定動作の最終点であり、よって前記2つの目標点A,Bのうちの下流側目標点である。前記経由点Cは、前記点Bを通る直線L2上に設定される。前記直線L2は、補正前の前記指定動作によって前記バケット33の先端が前記点Bを通る際の水平面と、前記アタッチメント30の動作方向すなわち前記バケット33の先端の移動方向と、がなす角度で水平面に対して傾斜している。本実施形態において、前記点Bにおける動作は掘削動作である。前記のような前記経由点Cの設定は、前記点Bにおいて前記アタッチメント30に前記指定動作による作業(掘削作業)を好適に行わせることを可能にする。
 前記経由点Cは、図11に示すように前記上部旋回体22の側方から見て前記点A点の直下に位置し、前記上部旋回体22の旋回中心軸に沿う方向に見て(前記作業機械201を上方から見て)前記点Aと前記点Bとの間に位置している。
 前記直線L2は、前記点Bにおいて前記アタッチメント30が所定の作業を行う際の水平面と前記アタッチメント30の動作方向、詳しくは制限対象部位(この実施の形態ではバケット33の先端)の移動方向、とがなす角度で水平面に対して傾斜していてもよい。本実施形態において、前記点Bにおける前記所定の作業は掘削作業である。この場合にも、前記点Bにおいて前記アタッチメント30に前記所定の作業(掘削作業)を好適に行わせることができる。
 次に、第4実施形態に係る作業機械301について、図12~図17を参照しつつ説明する。なお、第1実施形態と共通する構成およびそれにより奏される効果については説明を省略し、主に、第1実施形態と異なる点について説明する。なお、第1実施形態と同じ部材については、第1実施形態と同じ符号を付している。
 本第4実施形態に係る指定動作は、前記作業機械301のバケット33で掘削対象物である土砂を掘削する掘削動作であり、当該掘削動作が補正される。前記掘削対象物は土砂に限定されず、石や廃棄物などであってもよい。
 前記掘削動作は、図12において破線で囲われた掘削範囲(図12では矩形状の範囲)80の土砂を掘削することを目的とし、前記掘削範囲80は前記作業機械301の下部走行体21の前方(図12では右方)に設定されている。この第4実施形態に係る許容範囲は図12において一点鎖線で示される複数の境界面によって画定され、当該複数の境界面は、第1境界面73a、第2境界面73b、第3境界面73c、第4境界面73d及び第5境界面73eを含む。前記第2境界面73bは、前記作業機械301から前記下部走行体21の前方に離れた位置に設定された垂直面であり、前記第1境界面73aは前記第2境界面73bの上端からさらに前記作業機械401から遠ざかる方向に延びる水平面である。前記開始点Aは、前記掘削動作の端点であって、土面の高さと同等の高さでかつ前記第2境界面73bよりも前側(つまり許容範囲の外側)に位置している。前記第3境界面73cは、前記掘削範囲80の底面に沿う水平面であって前記第2及び第4境界面73b,73dとそれぞれつながる前端及び後端を有する。前記第4境界面73dは、前記作業機械301の下部走行体21の前端よりも前側の位置で土砂を垂直に横切る垂直面であって前記第3境界面73cの前記後端につながる。前記第5境界面73eは、前記作業機械301が載る地面に沿う水平面であって前記第4境界面73dの上端につながる。
 前記のように許容範囲が設定されている場合、バケット33の先端が図12に破線で示される軌跡71に沿うように掘削動作を行うと、掘削動作の開始点Aにおいて前記バケット33の先端が許容範囲を超える。より具体的には、当該バケット33の先端が前記第2境界面(前側境界面)73bよりも前側(図12では右側)にはみ出る。このような前記許容範囲からの前記バケット33の先端の逸脱を防ぐべく、例えば前記第1実施形態と同様にして前記開始点Aを前記第2境界面73b上の位置に変更する補正を行うと、前記バケット33の先端は実線で示す軌跡72を描く。この軌跡72では、土砂に前記バケット33が貫入される方向である貫入方向がほぼ垂直となり、当該軌跡72に前記バケット33の先端を追従させることは難しい。
 このような不都合を回避すべく、この第4の実施の形態に係る補正手段であるコントロールユニット11は、図13に実線で示すように、補正後の掘削動作における開始点Xが許容範囲内で土面の高さと同じ高さに位置するように、掘削動作の範囲全体を前記作業機械301に近づく向き(図13では左向き)にシフトする。前記度面の高さは、例えば図1に示されるLiDAR(高さ検出装置)27によって取得されることが可能である。このように、掘削動作の範囲全体を水平方向にシフトする補正は、円滑な掘削動作を維持しながら前記バケット33の先端が前記許容範囲から逸脱するのを防ぐことを可能にする。
 図13に示される補正では、補正前の掘削動作の開始点Aから補正後の掘削動作の開始点Xまでの水平方向の移動距離Laと、補正前の掘削動作の終了点Bから補正後の掘削動作の終了点Yまでの水平方向の移動距離Lbと、は互いに等しい。
 図13に示される例とは逆に、掘削動作の終了点Bが図14に示されるように前記許容範囲から後方に逸脱する場合、具体的には当該終了点Bが前記許容範囲の後側垂直境界面である前記第4境界面73dの外側(図14では左側)であって例えば土面の高さと同じ高さに位置する場合、前記掘削動作の範囲全体を前記作業機械301から離れる水平方向であって上部旋回体22の前方にシフトさせるのがよい。
 図14に示される例では、補正前の掘削動作の前記終了点Bから前記第4境界面73d上での同じ高さにおける点Cまでの水平距離Lbが、当該補正前の掘削動作の開始点Aから第2境界面(前側の境界面)73b上での同じ高さにおける点Dまでの水平距離Laよりも大きいため、仮に前記水平距離Lcだけ記掘削動作の範囲全体を上部旋回体22の前方向(図14では右方向)にシフトさせると、補正後の掘削動作の開始点Xが前記許容範囲を超える、つまり当該開始点が前記第2境界面73bの外側(図14では右側)にはみ出る、ことになる。そこで、この例では、前記補正後の掘削動作の開始点Xが前記許容範囲を超えないように、前記掘削動作の範囲全体が前記距離Lcではなくそれよりも小さい前記距離Laだけシフトされる。従って、補正後の掘削動作の開始点Xは、前記第2境界面73b上の点に変更される。一方、前記距離Laの分だけの前記掘削動作の範囲のシフトのみではそのシフトの前の終了点Bに対応する点B′は前記第4境界面73dにまで至ることができず、依然として前記許容範囲の外側(前記第4境界面73dよりも後側)に位置するので、当該終了点Bを前記第4境界面73d上の点Yまで変更すべく、バケット33の先端の軌跡を図14に示される軌跡74に変更するように補正が行われる。前記軌跡74のうち前記第2境界面73b上の開始点Xから前記第3境界面74d上の経由点Eに至るまでの部分の形状は補正前の軌跡71と同等であるが、当該経由点Eから前記終了点Yまでは前記バケット33の先端がほぼ垂直に上昇するような軌跡である。従って、前記経由点Eは、前記許容範囲を画定する境界面のうち前記作業機械301に近い側の垂直方向の境界面つまり前記第4境界面73dと、補正前のバケット33の軌跡71をそのまま前記距離Laだけ前方にシフトすることにより得られる軌跡72との交点である。
 前記のように変更された後の前記軌跡74では、当該軌跡74における前記終了点Yが前記変更の前の軌跡72における終了点B′よりも前側に位置するため、当該変更前の軌跡72に比べて土砂の掘削量が図15に斜線で示される領域の面積S1の分だけ、つまり前記点Y、前記点B′及び前記点Eを頂点とする側面視略三角形の領域分だけ、減少する。このように、前記軌跡72から前記軌跡74への変更が掘削量の減少を伴う場合、前記コントロールユニット11は、その減少する掘削量を補償するように掘削深さを大きくするための更なる軌跡の変更をするように構成されていることが、好ましい。
 図16は、当該更なる軌跡の変更の具体例を示す。この例では、図15に示される前記軌跡74がそれよりも下方の軌跡75に変更される。具体的に、前記軌跡74上の最下点Dから前記経由点Eまでの部分が下方にシフトされる。前記最下点Dは、前記軌跡74に含まれる点のうち最も下側に位置する点である。前記軌跡74が複数の最下点を含む場合、当該複数の最下点の中から任意の最下点が選択される。図16に示される例では、前記最下点Dがその直下方の点(変更後最下点)Fに変更され、前記経由点Eがその直下方の点(前記第4境界面73d上の変更後経由点)Gに変更される。前記軌跡75は、前記軌跡74のうち図16に示される最終共通点H、前記最下点D及び前記経由点Eを結ぶ曲線部分を前記最終共通点H、前記変更後最下点F及び前記変更後経由点Gを結ぶ曲線部分に変更したものであり、前記最終共通点Hは前記軌跡75のうち前記軌跡74と共通する部分の最も下流側の点である。このような修正は、当該修正前の前記曲線部分(点H,D,Eを結ぶ曲線部分)と修正後の前記曲線部分(点H,F,Gを結ぶ曲線部分)との間に挟まれた領域の面積(図16において斜線で示された領域の面積S2)の分だけ掘削量を補うことを可能にする。この面積S2が前記面積S1(終了点を前記点B′から前記点Yに変更することにより減少する掘削量に相当する面積)と同等になるように前記変更後最下点F及び前記変更後経由点Gが設定された場合には、図15に示される補正により減少する掘削量が図16に示される更なる補正によって完全に補償されることになる。
 前記最終共通点Hは、前記最下点D及び前記経由点Eを前記変更後最下点F及び前記変更後経由点Gに変更することに伴う当該補正後の軌跡75の段差を減らして前記バケット33の滑らかな動きを確保するように、設定される。図16に示される例では、前記軌跡74において前記最下点Dよりも距離Lhだけ上流側の位置に前記最終共通点Hが設定され、当該最終共通点Hと前記変更後最下点Fとを直線で結ぶことにより前記更なる補正後の軌跡75が特定される。当該直線の傾きと前記最終共通点Hでの前記軌跡74の接線の傾きとの差を小さくする、好ましくは両傾きを等しくする、ように前記最終共通点Hを設定することが、前記軌跡75を滑らかにすることを可能にする。
 図12~図16に示される例では、前記変更後最下点Fは前記許容範囲の下側境界面である前記第2境界面73bと同等の高さまたはこれよりも上側の位置に設定される必要がある。従って、前記最下点Dから前記変更後最下点Fへの下向きの変更による前記掘削量の補償は前記第3境界面73cよりも内側の前記許容範囲内で行われる。
 図17は、前記第4実施形態に係る補正をするために前記コントロールユニット11により行われる処理を示すフローチャートである。
 まず、前記コントロールユニット11は、前記補正前の掘削動作の2つの端点(開始点A及び終了点B)の少なくとも一方が前記許容範囲の外にあるか否か、より詳しくは当該許容範囲から水平方向に逸脱しているか否か、を判定する(ステップS1)。前記補正前の掘削動作の前記端点の少なくとも一方が前記許容範囲外にあると判定した場合にのみ(ステップS1でYES)、前記コントロールユニット11は、当該少なくとも一方の端点が前記許容範囲内に収まるように前記掘削動作の範囲全体を水平移動させる(ステップS2)。例えば、補正前の軌跡が図14に示されるように許容範囲から終了点Bが大きく逸脱する軌跡71である場合には、当該軌跡71の開始点Aが前記許容範囲から逸脱しない範囲内で(同図では水平距離Laだけ)水平方向に移動させて前記軌跡72にシフトする。前記補正前の掘削動作の端点がいずれも前記許容範囲内にあると判定した場合(ステップS1でNO)、前記掘削動作の範囲の水平移動は不要であるので前記ステップS2及びこれに関連する後述のステップS3~S6の処理が省略される。
 次に、前記コントロールユニット11は、前記のように水平移動した掘削動作の端点が依然として前記許容範囲の外にあるか否かを判定する(ステップS3)。例えば、図14に示される例では前記終了点Bを前記水平移動させた後の点B′が依然として許容範囲の外にあるか否かが判定される。
 前記端点が前記許容範囲の外側にあると判定した場合には(ステップS3でYES)、前記コントロールユニット11は、当該許容範囲内の外側にある端点を前記許容範囲内に収めるように前記軌跡を修正する(ステップS4)。例えば、図14に示されるように前記移動後の終了点B′が前記許容範囲の外側にある場合には、当該終了点B′を前記許容範囲の前記第4境界面73d上の点Yに変更すべく前記軌跡72を図14及び図15に示すように経由点Eから終了点Yまでほぼ垂直に上がるような軌跡74に変更する。
 次に、前記コントロールユニット11は、前記軌跡の修正に伴って掘削量が減少するか否かを判定する(ステップS5)。当該掘削量が減少すると判定した場合にのみ(ステップS5でYES)、前記コントロールユニット11は、その減少した掘削量を補償するように軌跡をさらに修正する(ステップS6)。例えば、図15及び図16に示されるような面積S1の分だけ掘削量が減少する場合、前記コントロールユニット11は、図16に示すように、バケット33の先端の軌跡を最下点D及び経由点Eを通る軌跡74から変更後最下点F及び変更後経由点Gを通る軌跡75へ下方に変更する。
 次に、前記コントロールユニット11は、前記バケット33の先端の軌跡の最下点が前記許容範囲の外にあるか否かを判定する(ステップS7)。ステップS7において、前記最下点が前記許容範囲の外であると判定した場合にのみ(ステップS7でYES)、コントロールユニット11は、前記最下点を修正する(ステップS8)。例えば、もし仮に図16に示される最下点Fが前記許容範囲の第3境界面73cよりも下側にあった場合には、当該最下点Fが当該許容範囲内に収まるように当該最下点Fを上向きに修正する。
 前記コントロールユニット11は、これまで説明したステップS1~S8の処理を経て最終的に決定された指定動作である掘削動作をアタッチメント30に行わせるように、当該アタッチメント30の駆動を制御する(ステップS9)。
 次に、第5実施形態に係る作業機械401について図18~図22を参照しつつ説明する。なお、第1実施形態と共通する構成およびそれにより奏される効果については説明を省略し、主に、第1実施形態と異なる点について説明する。なお、第1実施形態と同じ部材については、第1実施形態と同じ符号を付している。
 この第5実施形態では、前記第4実施形態と同様に、前記バケット33で土砂を掘削する掘削動作が補正される。つまり、この第5実施形態における指定動作である一連の動作は、バケット33で土砂を掘削する掘削動作を含む。この第5実施形態においても、図1に示される前記LiDAR(高さ検出装置)27によって土面の高さが検出される。
 図18では、破線で示された土面82を有する土砂を掘削するために、一点鎖線で示される複数の境界面によって画定された許容範囲が設定される。前記複数の境界面は、図12~図16に示される前記第1~第5境界面73a~73eと同様の第1境界面73a、第2境界面73b、第3境界面73c、第4境界面73d及び第5境界面73eを含む。前記掘削動作の開始点Aは、当該掘削動作による前記バケット33の先端の移動の軌跡71と前記土面82との交点であり、図18に示される例では前側境界面である前記第1境界面73aよりも前側つまり前記許容範囲の外側に位置し、かつ、前記土面82の高さと同等の高さに位置している。つまり、前記開始点Aにおいて前記バケット33の先端は前記許容範囲を超える。
 前記バケット33の先端を前記許容範囲内に収まるべく、前記第1実施形態と同様にして前記開始点Aを前記許容範囲の前側境界面である前記第2境界面73b上の位置まで移動させる補正が行われると、前記バケット33の先端の軌跡71は軌跡72に変更され、前記軌跡71のうち破線で示されるように前記許容範囲を超えていた部分は実線で示されるように前記第2境界面73bに沿う面となり、補正後の開始点Xは前記第2境界面73b上に位置する。このように、前記掘削動作の補正は前記バケット33の先端の軌跡の変更を伴い、これにより、前記掘削動作の少なくとも開始部分における前記バケット33の対地角度θを変える。前記対地角度θは、図19に示すように、鉛直面に対してバケット33の上面33aがなす角度である。従って、前記上面33aが鉛直方向を向くときの前記対地角度θは0°である。
 土中における前記バケット33の対地角度θの増加は掘削抵抗を増やし、土砂の良好な掘削を阻む。これを防ぐため、本第5実施形態に係る補正手段であるコントロールユニット11は、前記掘削動作を補正する場合に、事前に設定された前記バケット33の前記対地角度θである設定角度θsに基づいて、補正後におけるバケット33の対地角度θcを設定する。前記設定角度θs、すなわち、事前に設定されたバケット33の対地角度は、ティーチングや数値入力などによって設定された対地角度である。
 具体的には、前記コントロールユニット11は、掘削対象物(作業対象物)である土砂に前記バケット33が貫入されるときの当該バケット33の対地角度θを、補正前の掘削動作により土砂に前記バケット33が貫入されるときの当該バケット33の対地角度θに設定する。土砂に前記バケット33が貫入されるときの当該バケット33の対地角度θは、補正前及び補正後のそれぞれの掘削動作の開始点A,Xにおける前記バケット33の対地角度である。このように補正後の掘削動作における貫入時の前記バケット33の対地角度θを補正前の掘削動作における前記バケット33の対地角度θと等しくすることが、地面にバケット33が確実に貫入されることを可能にする。
 同様に、前記コントロールユニット11は、土砂から前記バケット33を抜き出すときの当該バケット33の対地角度θを、補正前の掘削動作により土砂から前記バケット33が抜き出されるときの当該バケット33の対地角度θに設定する。土砂から前記バケット33が抜き出されるときの前記バケット33の対地角度θは、補正前及び補正後のそれぞれの掘削動作の終了点B,Yにおける前記バケット33の対地角度θである。図18に示される例では、前記補正前及び前記補正後の前記終了点B,Yは互いに合致している。このように、補正後の掘削動作において土砂から抜き出されるときの前記バケット33の対地角度θを補正前の掘削動作における前記バケット33の対地角度θと等しくすることは、前記バケット33から土砂がこぼれるのを抑制することを可能にする。
 前記コントロールユニット11は、さらに、前記掘削動作の少なくとも一部において、補正前の掘削動作の開始点Aおよび終了点Bの各々における前記バケット33の対地角度θa,θbと、補正前の掘削動作と補正後の掘削動作の各々における前記バケット33の先端の軌跡71,72の経路長と、に基づいて、補正後の掘削動作における前記バケット33の対地角度θを設定する。本実施形態では、掘削動作の全て、つまり、前記開始点Xと前記終了点Yとの間の範囲の全てが対象であるが、掘削動作の一部、つまり、前記開始点Xと前記終了点Yとの間の範囲の一部が対象であってもよい。
 図20Aは、補正前の掘削動作による前記バケット33の先端の軌跡71を示し、図20Bは、補正後の掘削動作によるバケット33の先端の軌跡72を示す。補正前の掘削動作の開始点Aにおける前記バケット33の対地角度θaと補正後の掘削動作の開始点Xにおける前記バケット33の対地角度θxとは互いに等しく、補正前の掘削動作の終了点Bにおける前記バケット33の対地角度θbと補正後の掘削動作の終了点Yにおける前記バケット33の対地角度θyも互いに等しい。補正前の前記バケット33の先端の前記軌跡71の経路長Labは、補正後の前記バケット33の先端の軌跡72の経路長Lxyに変更される。前記コントロールユニット11は、前記軌跡72上における前記開始点Xと前記終了点Yとの間の任意の位置における前記バケット33の対地角度θzを、前記補正前の軌跡71における前記開始点Aから前記任意の位置までの経路長Lacに基づいて以下の式(1)により求める。ここで、前記軌跡72上の任意の位置は、前記軌跡71上における前記開始点Aと前記終了点Bとの間の任意の位置に対応している。
 θz=θx+(θy-θx)×(Lac/Lab)×Lxy ・・・(1)
 上記の式(1)に基づく前記バケット33の対地角度θzの設定は、補正前の前記バケット33の対地角度θが適切であるときに補正後の前記バケット33の対地角度も適切になることを可能にする。このことは、前記掘削動作の補正による前記バケット33の先端の軌跡の変化による掘削抵抗の増大を抑えて土砂が好適に掘削されることを可能にする。
 前記式(1)に代えて下記の式(2)を用いて、前記開始点Xと前記終了点Yとの間の任意の軌跡72上の位置における前記バケット33の対地角度θzが求められてもよい。
 θz=θx+(θy-θx)×(Dac/Dab)×Dxy ・・・(2)
 前記式(2)は、水平距離Dab,Dxy,Dacを含む。前記水平距離Dabは、補正前の掘削動作における前記開始点Aと前記終了点Bとの間の水平距離であり、前記水平距離Dxyは、補正後の掘削動作における前記開始点Xと前記終了点Yとの間の水平距離であり、前記水平距離Dacは、前記軌跡71上における前記開始点Aと前記任意の位置との間の水平距離である。
 前記式(2)に基づく前記バケット33の対地角度θzの設定も、補正前の前記バケット33の対地角度が適切であるときに補正後のバケット33の対地角度も適切になることを可能にする。
 図18に示すように、前記許容範囲の前側境界面である第2境界面73b上で前記補正後の開始点Xの直下の位置に経由点Dが設定される場合、前記開始点Xから前記経由点Dまでの前記対地角度θは前記式(1)または前記式(2)に基づいて設定される一方、前記経由点Dから前記終了点Yまでの前記対地角度は補正前の対地角度に設定されてもよい。また、前記開始点Xから前記経由点Dまでの前記対地角度θは前記開始点Xにおける対地角度θxに維持されてもよい。
 図21は、点線で示される土面82をする土砂が前記作業機械401により掘削される場合であって、図18に示される前記第1~第5境界面73a~73eと同様に許容範囲を画定する第1~第5境界面73a~73eのうち前記作業機械401に近い垂直面である第4境界面73dが指定動作に含まれる掘削動作の終了点Bよりも前記作業機械401から離れた位置にある場合、換言すれば、前記終了点Bが前記第4境界面73dを超えてその後側(図21では左側)つまり許容範囲の外側に位置する場合を示す。前記終了点Bは、前記土面82の高さと同等の高さに位置している。この場合、前記終了点Bを有する軌跡すなわち図21において破線で示される部分を含む軌跡71に沿ってバケット33の先端を動かす前記掘削動作を行うと、少なくとも当該終了点Bにおいて前記バケット33の先端が前記許容範囲を超える。
 前記終了点Bを前記許容範囲内に収めるべく当該終了点Bを前記第1実施形態と同じく前記第4境界面73d上に位置する終了点Yに変更して前記軌跡71を実線で示されるように前記第4境界面73dに沿う軌跡72に変更するような前記掘削動作の補正をすると、前記掘削動作のうち少なくとも前記終了点Yを含む部分において前記バケット33の対地角度が変わる。この補正でも当該補正前の開始点Aと当該補正後の開始点Xとは同じである。
 この補正についても、図18及び図20を用いて説明した方法と同等の方法で前記バケット33の対地角度θが設定されることにより、掘削抵抗の増大の抑制が可能である。
 図22は、図18に示される第1~第5境界面73a~73eと同様に許容範囲を画定する第1~第5境界面73a~73eのうち下側境界面である第3境界面73cが指定動作に含まれる掘削動作でのバケット33の先端の移動の軌跡71上の最下点よりも上側に位置する場合、換言すれば、前記最下点が前記第3境界面73cを超えてその外側(下側)に位置する場合、を示す。この場合、破線で示されるように前記最下点を含む前記軌跡71で掘削動作を行うと、当該最下点及びその前後の領域で前記バケット33の先端が前記許容範囲を超える。
 前記最下点を前記許容範囲内に収めるべく当該最下点を前記第3境界面73c上の点まで上方に変更して当該最下点の前後の部分が前記第3境界面73cに沿って水平に延びる軌跡72に変更するような前記掘削動作の補正を行うと、当該掘削動作のうち少なくとも前記最下点を含む部分(前記第3境界面73cに沿う水平部分)において前記バケット33の対地角度θが変わる。このような対地角度θの変化は、掘削抵抗を増やして土砂の良好な掘削を阻むおそれがある。
 前記掘削抵抗の増大を抑えるべく、補正手段であるコントロールユニット11は、前記軌跡72上の最下点における前記バケット33の対地角度を、当該バケット33の底面33b(図19参照)が水平となるような対地角度以下の角度に設定する。前記軌跡72上の最下点は、当該軌跡72において図22に示される2つの経由点E,Fの間の部分における全ての点である。前記2つの経由点E,Fは、前記補正前の軌跡71と前記第3境界面73cとの交点であり、前記2つの経由点E,Fの間の部分は前記第3境界面73cに沿って水平に延びる部分である。
 前記軌跡72上の前記最下点における前記バケット33の対地角度θを前記底面33bが水平となる対地角度以下の角度に設定することは、前記最下点における掘削抵抗を抑えて土砂が良好に掘削されることを可能にする。
 以上説明される実施形態は具体例に過ぎず、本発明を限定するものではない。開示された具体的構成は、適宜設計変更可能である。また、発明の実施の形態について記載された作用及び効果は、本発明から生じる最も好適な作用及び効果を列挙したに過ぎず、本発明による作用及び効果を限定する趣旨ではない。
 以上のように、作業者の負担を大きくすることなく許容範囲内での自動運転を行うことが可能な作業機械が提供される。前記作業機械は、下部走行体と、上部旋回体と、作業装置と、コントローラと、を備える。前記上部旋回体は、前記下部走行体に旋回可能に搭載される。前記作業装置は、作業動作を行うことが可能となるように前記上部旋回体に取り付けられる。前記コントローラは、前記上部旋回体および前記アタッチメントに予め指定された指定動作を行わせるように前記上部旋回体および前記アタッチメントの駆動を制御する。前記コントローラは、前記指定動作中に前記作業装置の制限対象部位が予め設定された許容範囲を超える場合に当該作業装置が当該許容範囲を超えないように前記指定動作を補正するように構成されている。
 前記コントローラは、前記指定動作中に前記制限対象部位が前記許容範囲を超える場合または超える可能性がある場合に前記指定動作を補正して前記制限対象部位が前記許容範囲を超えるのを防ぐことにより、作業者がティーチングなどによって前記指定動作を再設定する必要をなくし、これにより、作業者の負担を軽減させることができる。
 前記許容範囲は、予め定められて前記コントローラに格納されたものであってもよいし、前記コントローラが前記許容範囲を設定するように構成されていてもよい。後者の場合、前記コントローラは、前記作業装置の特定部位が位置することが可能な複数の位置に基づいて前記許容範囲を設定するように構成されていることが、好ましい。このことは、前記複数の位置に前記特定部位を位置させることで前記許容範囲を容易に設定することを可能にする。例えば、前記許容範囲を明確に決められないような現場においても、当該許容範囲を容易に設定することができる。また、前記作業機械の周辺の環境が変化するような現場においても、前記許容範囲を柔軟に設定することができる。
 前記コントローラは、作業現場の周囲状況に関する情報に基づいて前記許容範囲を設定するように構成されていることが、好ましい。このことは、操作者が前記許容範囲を設定するための操作をすることによる当該作業者の負担を軽減し、前記許容範囲が容易に設定されることを可能にする。
 前記コントローラは、例えば、前記作業現場の周囲状況を監視する管理装置により管理される当該周囲状況に基づいて前記許容範囲を設定するように構成されるのが、よい。このことは、前記管理装置により管理される情報を有効に利用して前記許容範囲が容易に設定されることを可能にする。
 あるいは、前記作業機械が前記作業現場の周囲状況に関する情報を取得する取得装置をさらに備え、前記コントローラは、前記取得装置が取得した前記周囲状況に基づいて前記許容範囲を設定するように構成されてもよい。このことは、前記周囲状況が時々刻々と変化するにもかかわらず、その変化に応じた前記許容範囲を設定することを可能にする。
 前記コントローラは、前記制限対象部位が複数の目標点を順番に通るように前記上部旋回体および前記作業装置の駆動を制御することにより前記上部旋回体および前記作業装置に前記指定動作を行わせる場合、前記補正前の前記指定動作における前記複数の目標点の中から選ばれる2つの目標点間において前記作業装置の前記制限対象部位が前記許容範囲を超える可能性がある場合に、前記2つの目標点の間でかつ前記許容範囲内の位置に経由点を設定し、前記制限対象部位が前記経由点を通るように前記指定動作を補正するように構成されていることが、好ましい。前記目標点同士の間隔が大きくて当該目標点どうしの間に前記制限対象部位が前記許容範囲を超える区間が存在する可能性がある場合でも、前記コントローラは、前記2つの目標点の間でかつ前記許容範囲内に位置する前記経由点を設定して前記制限対象部位が前記経由点を通るように前記指定動作を補正することにより、前記制限対象部位が前記許容範囲を超えるのを防ぐことができる。
 前記コントローラは、例えば、前記2つの目標点を結ぶ線L1上に前記経由点を設定することにより、当該経由点を簡易に設定することができる。
 前記コントローラは、あるいは、下流側目標点を通る直線上に前記経由点を設定するように構成されてもよい。前記下流側目標点は、前記2つの目標点のうち前記補正前の前記指定動作の下流側の目標点であり、前記直線は、前記補正前の指定動作によって前記制限対象部位が前記下流側目標点を通る時の水平面と前記作業装置の動作の方向とがなす角度で前記水平面に対して傾斜する直線である。このような直線上での前記経由点の設定は、前記下流側目標点において前記作業装置が前記指定動作による作業を好適に行うことを可能にする。
 前記直線は、あるいは、前記作業装置が所定の作業動作を行うときの水平面と前記作業装置の動作方向、詳しくは前記制限対象部位の移動方向、とがなす角度で水平面に対して傾斜する直線であってもよい。このような直線上での前記経由点の設定は、前記下流側目標点において前記作業装置に前記所定の作業を好適に行わせることを可能にする。
 前記作業装置がバケットを含み、当該バケットが前記制限対象部位を含み、前記指定動作が前記バケットで掘削対象物を掘削する掘削動作を含む場合、前記作業機械は、前記掘削対象物の表面の高さを検出する高さ検出装置をさらに備え、前記コントローラは、前記補正前の前記掘削動作の開始点及び終了点のうちの少なくとも一方が前記表面の高さと同等の高さにありかつ前記許容範囲外に位置する端点である場合に前記補正後の前記掘削動作における前記端点が前記許容範囲内で前記表面の高さと同等の高さに位置するように、前記掘削動作が行われる範囲を水平移動させるように構成されていることが、好ましい。このように前記掘削動作が行われる範囲を水平移動させるような補正は、当該補正前の前記バケットの動きを維持して円滑な掘削動作を担保することを可能にする。
 この態様では、前記コントローラは、前記掘削動作の範囲の水平移動に伴って前記掘削動作による掘削量が減少する場合に当該減少する掘削量を補償するように掘削深さを大きくするように前記掘削動作を補正するように構成されることが、好ましい。当該補正は、前記掘削深さすなわち前記バケットにより前記掘削対象物が掘削される深さを大きくして前記減少する掘削量を補償することにより、当該補正による作業効率の低下を抑制することができる。
 さらに、前記コントローラは、前記掘削深さを大きくするのに伴い前記バケットの軌跡を滑らかにする方向に当該軌跡を修正するように構成されていることが、好ましい。前記修正は、例えば前記掘削深さの増加によって前記バケットの軌跡に段差が生じるなどして当該バケットの滑らかな動きが阻害されるのを抑制することができる。
 前記コントローラは、事前に設定されたバケットの対地角度である設定角度に基づいて、前記補正後における前記掘削動作での前記バケットの対地角度を設定するように構成されていることが、好ましい。このことは、前記掘削動作の補正による前記バケットの先端の軌跡の変化にかかわらず、前記バケットの対地角度の変化による掘削抵抗の増加を抑えて良好な掘削が行われることを可能にする。
 例えば、前記コントローラは、前記補正後の掘削動作において前記掘削対象物に貫入されるときの前記バケットの対地角度を、前記補正前の前記掘削動作により前記掘削対象物に貫入されるときの前記バケットの対地角度と同等の角度に設定するように構成されているのが、好ましい。このように前記補正後の前記掘削動作において前記バケットが前記掘削対象物に貫入されるときの対地角度として前記補正前の掘削動作による対地角度を適用することが、前記補正にかかわらず前記掘削対象物に前記バケットが確実に貫入されることを可能にする。
 また、前記コントローラは、前記補正後の前記掘削動作において前記掘削対象物から抜き出されるときの前記バケットの対地角度を、前記補正前の掘削動作において前記掘削対象物から抜き出されるときの前記バケットの対地角度と同等の角度に設定するように構成されていることが、好ましい。このように前記補正後の前記掘削動作において前記掘削対象物から抜き出される前記バケットの対地角度として前記補正前の掘削動作における対地角度と同等の角度を適用することは、前記バケットから前記掘削対象物がこぼれるのを抑制することを可能にする。
 前記コントローラは、前記補正前の前記掘削動作の開始点および終了点の各々における前記バケットの対地角度と、前記補正前の掘削動作と前記補正後の掘削動作の各々における前記バケットの先端の軌跡の経路長と、に基づいて、前記補正後の掘削動作の少なくとも一部におけるバケットの対地角度を設定するように構成されていることが、好ましい。このように前記バケットの対地角度を設定することは、前記補正前の前記バケットの対地角度が適切である場合に前記補正後のバケットの対地角度も適切にすることができ、これにより、前記掘削動作の補正による前記バケットの先端の軌跡の変化が掘削抵抗を増加させることを抑えて、良好な掘削が行われることを可能にする。
 また、前記コントローラは、前記補正前の掘削動作の開始点および終了点の各々における前記バケットの対地角度と、前記補正前の掘削動作と前記補正後の掘削動作の各々における前記開始点と前記終了点との間の水平方向の距離とに基づいて、前記補正後の前記掘削動作の少なくとも一部における前記バケットの対地角度を設定するように構成されていることが、好ましい。このように前記バケットの対地角度を設定することも、前記補正前の前記バケットの対地角度が適切である場合に、前記補正後の前記バケットの対地角度も適切にすることができ、これにより、前記掘削動作の補正による前記バケットの先端の軌跡の変化が掘削抵抗を増加させることを抑えて良好な掘削が行われることを可能にする。
 また、前記コントローラは、前記バケットの先端の軌跡の最下点における前記バケットの対地角度を、前記バケットの底面が水平となる対地角度以下の角度に設定するように構成されていることが、好ましい。このことは、前記最下点での掘削抵抗を抑えて良好な掘削が行われることを可能にする。
 前記コントローラは、前記指定動作の補正を報知器に報知させるように構成されていることが、好ましい。当該報知は、前記指定動作の補正を、前記作業機械を管理する作業者に知らせることができる。
 前記コントローラは、補正後の前記指定動作を前記上部旋回体および前記作業装置に行わせるのが困難であると判定した場合に前記上部旋回体および前記作業装置の動作を停止させるように構成されていることが、好ましい。前記補正後の指定動作を前記上部旋回体及び前記作業装置に行わせることが困難な場合は、例えば、当該補正後の指定動作が前記上部旋回体または前記作業装置の動作範囲を超える場合である。このような場合に前記上部旋回体および前記作業装置の動作を停止させることは、前記上部旋回体および前記作業装置が無理な動作を行うのを抑制することができる。
 前記作業機械は、作業現場の座標系における前記下部走行体、前記上部旋回体および前記作業装置の少なくとも一つの位置の座標を検出する位置検出装置をさらに備え、前記コントローラは、前記作業現場の座標系において前記許容範囲を設定し、かつ、前記位置検出装置により検出された前記位置の座標の変化に基づいて前記許容範囲を更新するように構成されていることが、好ましい。このような更新は、作業機械の動きに伴って作業現場の座標系における作業機械の位置に対する前記許容範囲の相対位置関係が変化するにもかかわらず、当該作業機械の動きに伴って作業者が前記許容範囲を再設定することなく前記制限対象部位と前記許容範囲との位置関係が適正に判定されることを可能にし、これにより、作業者の負担を軽減させることができる。
 前記作業装置の制限対象部位は、例えば当該作業装置の先端が好ましい。当該制限対象部位は、あるいは、前記作業装置の先端以外の部位であってもよい。いずれの場合も、前記コントローラは、前記指定動作において前記作業装置の前記制限対象部位が前記許容範囲を超えることを前記指定動作の補正によって防ぐことができる。
 前記コントローラは、前記指定動作についての情報と、前記補正の結果についての情報と、を動作情報表示装置に表示させるように構成されていることが、好ましい。このことは、前記動作情報表示装置における表示を見た作業が前記指定動作についての情報及び前記補正の結果についての情報とを併せて参照することにより、前記上部旋回体および前記作業装置の補正後の動きを把握することを可能にし、これにより、例えば、前記補正後の動きに問題があった場合に補正条件を変更したり前記指定動作を再設定したりすることを、可能にする。
 また、前記コントローラは、前記許容範囲についての情報と、前記許容範囲に対する前記上部旋回体および前記作業装置の相対位置についての情報と、を位置情報表示装置に表示させるように構成されていることが、好ましい。このことは、前記位置情報表示装置における表示を見た作業者が前記許容範囲に対する前記上部旋回体および前記作業装置の相対位置を把握することを可能にし、これにより、前記相対位置に問題があるときに前記作業機械を移動させるなどの対処をすることを可能にする。
 

Claims (25)

  1.  下部走行体と、
     前記下部走行体に旋回可能に搭載される上部旋回体と、
     作業動作を行うことが可能となるように前記上部旋回体に取り付けられる作業装置と、
     前記上部旋回体および前記作業装置に予め指定された指定動作を行わせるように、前記上部旋回体および前記作業装置の駆動を制御するコントローラと、を備え、
     前記コントローラは、前記指定動作中に前記作業装置の制限対象部位が予め設定された許容範囲を超える場合または超える可能性がある場合に当該制限対象部位が当該許容範囲を超えないように前記指定動作を補正するように構成されている、作業機械。
  2.  請求項1に記載の作業機械であって、前記コントローラは、前記許容範囲を設定するように構成されている、作業機械。
  3.  請求項2に記載の作業機械であって、前記コントローラは、前記作業装置の特定部位が位置することが可能な複数の位置に基づいて前記許容範囲を設定するように構成されている、作業機械。
  4.  請求項1に記載の作業機械であって、前記コントローラは、作業現場の周囲状況に関する情報に基づいて前記許容範囲を設定するように構成されている、作業機械。
  5.  請求項4に記載の作業機械であって、前記コントローラは、前記作業現場の周囲状況を管理する管理装置により管理される当該周囲状況に関する情報に基づいて前記許容範囲を設定するように構成されている、作業機械。
  6.  請求項4に記載の作業機械であって、前記作業現場の周囲状況に関する情報を取得する取得装置をさらに備え、前記コントローラは、前記取得装置により取得された前記周囲状況に関する情報に基づいて前記許容範囲を設定することを特徴とする請求項1に記載の作業機械。
  7.  請求項1~6のいずれか1項に記載の作業機械であって、前記コントローラは、前記制限対象部位が複数の目標点を順番に通るように前記上部旋回体および前記作業装置の駆動を制御することにより前記上部旋回体および前記作業装置に前記指定動作を行わせ、前記補正前の前記指定動作における前記複数の目標点の中から選ばれる2つの目標点間において前記作業装置の前記制限対象部位が前記許容範囲を超える可能性がある場合に、前記2つの目標点の間でかつ前記許容範囲内の位置に経由点を設定し、前記制限対象部位が前記経由点を通るように前記指定動作を補正するように構成されている、作業機械。
  8.  請求項7に記載の作業機械であって、前記コントローラは、前記2つの目標点を結ぶ線上に前記経由点を設定するように構成されている、作業機械。
  9.  請求項7に記載の作業機械であって、前記コントローラは、下流側目標点を通る直線上に前記経由点を設定するように構成され、前記下流側目標点は前記2つの目標点のうち前記補正前の前記指定動作の下流側の目標点であり、前記直線は、前記補正前の前記指定動作によって前記制限対象部位が下流側目標点を通るときの水平面と前記作業装置の動作の方向とがなす角度で前記水平面に対して傾斜する、作業機械。
  10.  請求項7に記載の作業機械であって、前記コントローラは、下流側目標点を通る直線上に前記経由点を設定するように構成され、前記下流側目標点は前記2つの目標点のうち前記補正前の前記指定動作の下流側の目標点であり、前記直線は、前記作業装置が所定の作業動作を行うときの水平面と前記制限対象部位の移動の方向とがなす角度で前記水平面に対して傾斜する、作業機械。
  11.  請求項1~4のいずれか1項に記載の作業機械であって、前記作業装置はバケットを含み、当該バケットは前記制限対象部位を含み、前記指定動作は前記バケットで掘削対象物を掘削する掘削動作を含み、前記作業機械は前記掘削対象物の表面の高さを検出する高さ検出装置をさらに備え、前記コントローラは、前記補正前の前記掘削動作の開始点及び終了点のうちの少なくとも一方が前記表面の高さと同等の高さにありかつ前記許容範囲外に位置する端点である場合に前記補正後の前記掘削動作における前記端点が前記許容範囲内で前記表面の高さと同等の高さに位置するように、前記掘削動作が行われる範囲を水平移動させるように構成されている、作業機械。
  12.  請求項11に記載の作業機械であって、前記コントローラは、前記掘削動作の範囲の水平移動に伴って前記掘削動作による掘削量が減少する場合に当該減少する掘削量を補償するように掘削深さを大きくするように前記掘削動作を補正するものであり、前記掘削深さは前記バケットにより前記掘削対象物が掘削される深さである、作業機械。
  13.  請求項12に記載の作業機械であって、前記コントローラは、前記掘削深さを大きくするのに伴い、前記バケットの軌跡を滑らかにする方向に当該軌跡を修正するように構成されている、作業機械。
  14.  請求項1~6のいずれかに記載の作業機械であって、前記作業機械はバケットを含み、前記指定動作は前記バケットで掘削対象物を掘削する掘削動作を含み、前記コントローラは、前記掘削動作の補正に伴い、事前に設定された前記バケットの対地角度である設定角度に基づいて、前記補正後における前記掘削動作における前記バケットの対地角度を設定するように構成されている、作業機械。
  15.  請求項14に記載の作業機械であって、前記コントローラは、前記補正後の前記掘削動作において前記掘削対象物に貫入されるときの前記バケットの対地角度を、前記補正前の前記掘削動作において前記掘削対象物に貫入されるときの前記バケットの対地角度と同等の角度に設定するように構成されている、作業機械。
  16.  請求項14に記載の作業機械であって、前記コントローラは、前記補正後の前記掘削動作において前記掘削対象物から抜き出されるときの前記バケットの対地角度を、前記補正前の前記掘削動作において前記掘削対象物から抜き出されるときの前記バケットの対地角度と同等の角度に設定するように構成されている、作業機械。
  17.  請求項14に記載の作業機械であって、前記コントローラは、前記補正前の前記掘削動作の開始点および終了点の各々における前記バケットの対地角度と、前記補正前の前記掘削動作と前記補正後の前記掘削動作の各々における前記バケットの先端の軌跡の経路長とに基づいて、前記補正後の前記掘削動作の少なくとも一部における前記バケットの対地角度を設定するように構成されている、作業機械。
  18.  請求項14に記載の作業機械であって、前記コントローラは、前記補正前の前記掘削動作の開始点および終了点の各々における前記バケットの対地角度と、前記補正前の前記掘削動作と前記補正後の前記掘削動作の各々における前記開始点と前記終了点との間の水平方向の距離とに基づいて、前記補正後の前記掘削動作の少なくとも一部における前記バケットの対地角度を設定するように構成されている、作業機械。
  19.  請求項14に記載の作業機械であって、前記コントローラは、前記バケットの先端の軌跡上の最下点における前記バケットの対地角度を、前記バケットの底面が水平となる対地角度以下の角度に設定するように構成されている、作業機械。
  20.  請求項1~6のいずれかに記載の作業機械であって、前記コントローラは、前記指定動作の補正を報知器に報知させるように構成されている、作業機械。
  21.  請求項1~6のいずれかに記載の作業機械であって、前記コントローラは、補正された前記指定動作を前記上部旋回体および前記作業装置に行わせるのが困難であると判定した場合に前記上部旋回体および前記作業装置の動作を停止させるように構成されている、作業機械。
  22.  請求項1~6のいずれかに記載の作業機械であって、作業現場の座標系における前記下部走行体、前記上部旋回体、および、前記作業装置の少なくとも一つの位置の座標を検出する位置検出装置をさらに備え、前記コントローラは、前記作業現場の座標系において前記許容範囲を設定し、かつ、前記位置検出装置により検出された前記座標系における前記位置の変化に基づいて前記座標系における前記許容範囲を変更するように構成されている、作業機械。
  23.  請求項1~6のいずれかに記載の作業機械であって、前記制限対象部位は、前記作業装置の先端である、作業機械。
  24.  請求項1~6のいずれかに記載の作業機械であって、前記コントローラは、前記指定動作についての情報と前記補正の結果についての情報とを動作情報表示装置に表示させるように構成されている、作業機械。
  25.  請求項1~6のいずれかに記載の作業機械であって、前記コントローラは、前記許容範囲と、前記許容範囲に対する前記上部旋回体および前記作業装置の相対位置についての情報と、を位置情報表示装置に表示させるように構成されている、作業機械。
PCT/JP2022/034600 2021-10-01 2022-09-15 作業機械 Ceased WO2023053992A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
EP22875863.7A EP4394131A4 (en) 2021-10-01 2022-09-15 Work machine
CN202280064461.8A CN117980566A (zh) 2021-10-01 2022-09-15 工程机械
US18/690,942 US20240376694A1 (en) 2021-10-01 2022-09-15 Work machine

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP2021-162858 2021-10-01
JP2021162858 2021-10-01
JP2022091808A JP2023053887A (ja) 2021-10-01 2022-06-06 作業機械
JP2022-091808 2022-06-06

Publications (1)

Publication Number Publication Date
WO2023053992A1 true WO2023053992A1 (ja) 2023-04-06

Family

ID=85782474

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/034600 Ceased WO2023053992A1 (ja) 2021-10-01 2022-09-15 作業機械

Country Status (3)

Country Link
US (1) US20240376694A1 (ja)
EP (1) EP4394131A4 (ja)
WO (1) WO2023053992A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024247545A1 (ja) * 2023-05-31 2024-12-05 株式会社小松製作所 制御装置および制御方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000291077A (ja) 1999-04-12 2000-10-17 Hitachi Constr Mach Co Ltd 自動運転建設機械
US20170191246A1 (en) * 2016-01-04 2017-07-06 Caterpillar Inc. Excavation system having inter-machine monitoring and control
WO2019189013A1 (ja) * 2018-03-26 2019-10-03 住友建機株式会社 ショベル
JP2019183382A (ja) * 2018-03-31 2019-10-24 住友建機株式会社 ショベル及びショベルの管理装置
JP2021025258A (ja) * 2019-08-01 2021-02-22 住友重機械工業株式会社 ショベル
JP2021152307A (ja) * 2020-03-24 2021-09-30 日立建機株式会社 作業機械

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE112016007279T5 (de) * 2016-11-28 2019-06-13 Komatsu Ltd. Arbeitsfahrzeug und Verfahren zum Steuern des Arbeitsfahrzeugs
CN111601934A (zh) * 2018-03-26 2020-08-28 住友建机株式会社 挖土机
JP7141899B2 (ja) * 2018-09-13 2022-09-26 日立建機株式会社 作業機械

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000291077A (ja) 1999-04-12 2000-10-17 Hitachi Constr Mach Co Ltd 自動運転建設機械
US20170191246A1 (en) * 2016-01-04 2017-07-06 Caterpillar Inc. Excavation system having inter-machine monitoring and control
WO2019189013A1 (ja) * 2018-03-26 2019-10-03 住友建機株式会社 ショベル
JP2019183382A (ja) * 2018-03-31 2019-10-24 住友建機株式会社 ショベル及びショベルの管理装置
JP2021025258A (ja) * 2019-08-01 2021-02-22 住友重機械工業株式会社 ショベル
JP2021152307A (ja) * 2020-03-24 2021-09-30 日立建機株式会社 作業機械

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP4394131A4

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024247545A1 (ja) * 2023-05-31 2024-12-05 株式会社小松製作所 制御装置および制御方法

Also Published As

Publication number Publication date
EP4394131A4 (en) 2025-01-15
US20240376694A1 (en) 2024-11-14
EP4394131A1 (en) 2024-07-03

Similar Documents

Publication Publication Date Title
AU2017218993B2 (en) Control system for a machine
CN112424427B (zh) 作业机械的控制装置及控制方法
CN107407074A (zh) 显示系统及工程机械
JP7491185B2 (ja) 経路設定システム
KR102782893B1 (ko) 자동 작업 시스템
CN114829710B (zh) 挖土机、远程操作支援装置
JP7615995B2 (ja) 軌道生成システム
WO2023074175A1 (ja) 作業機械
WO2023053992A1 (ja) 作業機械
CN116234960B (zh) 挖掘位置决定系统、挖掘控制系统及工程机械
WO2023053584A1 (ja) 軌道生成システムおよびこれを備えた作業機械
JP2025123500A (ja) 作業エリア設定システム
JP2025038550A (ja) 作業システム
CN117980566A (zh) 工程机械
JP2025065872A (ja) 目標経路設定システム、目標経路設定プログラム、および、目標経路設定方法
JP7585702B2 (ja) アタッチメントの目標軌跡変更システム
JP2023053887A (ja) 作業機械
EP4455409A1 (en) Work area setting system
JP7559691B2 (ja) 作業機械
WO2025192005A1 (ja) 作業機械制御装置、作業機械、外部装置、作業機械システムおよび作業性改善方法
WO2025204910A1 (ja) 走行計画設定システム
JP2024130147A (ja) 作業機械目標位置算出システム
JP2025125023A (ja) 表示システム、表示方法及び作業機械
JP2025153191A (ja) 自動運転制御システム
WO2025013421A1 (ja) 作業システム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22875863

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 18690942

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 202280064461.8

Country of ref document: CN

WWE Wipo information: entry into national phase

Ref document number: 2022875863

Country of ref document: EP

ENP Entry into the national phase

Ref document number: 2022875863

Country of ref document: EP

Effective date: 20240327

NENP Non-entry into the national phase

Ref country code: DE