Work System
The work system automates the transition from loading to leveling operations by defining a loading end position and optimizing the path, enhancing the efficiency of work machines during these transitions.
Patent Information
- Application Number
- JP2021187339
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-11-17
- Publication Date
- 2025-12-16
- Estimated Expiration
- 2041-11-17
AI Technical Summary
Existing work machines face inefficiencies when switching between loading and leveling operations, necessitating improved work efficiency during these transitions.
A work system with a controller that automates the transition from loading to leveling operations by defining a loading end position and initiating leveling from this position, optimizing the path to minimize unnecessary movements.
Enhances the efficiency of work machines by streamlining the change from loading to leveling operations, reducing unnecessary operations and improving overall work efficiency.
Smart Images

Figure 0007786145000001 
Figure 0007786145000002 
Figure 0007786145000003
Abstract
Description
[Technical Field]
[0001] The present invention relates to a work system configured to allow a work machine to perform a work operation. [Background technology]
[0002] For example, Patent Document 1 describes a construction machine that automatically operates to level work objects loaded into a container (called a loading platform in the document) (see paragraph
[0164] , Figure 11, etc. in the document). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Japanese Patent Publication No. 2021-025258 Summary of the Invention [Problem to be solved by the invention]
[0004] It is desirable for the work machine to work efficiently when switching between the work of loading work objects into a container and the work of leveling the work objects loaded in the container.
[0005] Therefore, an object of the present invention is to provide a work system that can improve the work efficiency of an automatically operated work machine when the work of the work machine changes from loading work to leveling work. [Means for solving the problem]
[0006] The work system includes a work machine with a bucket and a controller that automatically operates the work machine. The controller causes the work machine to perform a loading operation and a leveling operation. The loading operation is the operation of loading work objects into a container using the bucket. The leveling operation is the operation of leveling the work objects loaded into the container using the bucket after the loading operation is completed. The position where the bucket is positioned at the end of the loading operation is defined as the loading end position. The controller causes the work machine to start the leveling operation in a portion of the container on the loading end position side. [Effects of the Invention]
[0007] With the above configuration, it is possible to improve the work efficiency of the work machine when the work of the automatically operated work machine changes from loading work to leveling work. [Brief explanation of the drawings]
[0008] [Figure 1] 1 is a side view of a vehicle 10 and a work machine 20 of a work system 1. FIG. [Figure 2] 2 is a top view of a vehicle 10 and a work machine 20 arranged differently from the example shown in FIG. 1. FIG. [Figure 3] FIG. 2 is a block diagram of the work system 1 shown in FIG. [Figure 4] 4 is a flowchart of a process performed by the controller 50 shown in FIG. 3. [Figure 5] 3 is a top view of the container 13 shown in FIG. 2 and the target path P of the leveling operation. [Figure 6] FIG. 6 is a cross-sectional view taken along the line F6-F6 in FIG. 5. DETAILED DESCRIPTION OF THE INVENTION
[0009] The working system 1 will be described with reference to FIGS.
[0010] As shown in Fig. 1, the work system 1 is a system in which a work machine 20 performs work on a container 13. The work system 1 includes a vehicle 10, the work machine 20, a detection unit 30 shown in Fig. 3, an operation unit 41, and a controller 50.
[0011] 1, the vehicle 10 is a machine (transport vehicle) that transports an object (work target A) stored in a container 13. The vehicle 10 is, for example, a dump truck. The vehicle 10 includes a vehicle main body 11 and a container 13.
[0012] The vehicle body 11 supports the container 13. The vehicle body 11 is movable and may move on wheels or crawlers. The vehicle body 11 includes a vehicle cab 11a.
[0013] The container 13 accommodates the work object A. The container 13 is, for example, a box-shaped container without a lid. For example, the container 13 may be a loading platform of the vehicle 10, or may not be a loading platform of the vehicle 10. The container 13 may be placed on the ground. The container 13 may be a structure (side wall) surrounding a hole (e.g., a sand pit) formed in the ground. In this case, the container 13 may not have a bottom (a portion corresponding to the container floor surface 13a). The following mainly describes a case where the container 13 is a loading platform. The container 13 is arranged on the container rear side V2 (described below) of the vehicle cab 11a. The container 13 may be movable relative to the vehicle main body 11, or may be fixed to the vehicle main body 11. The following describes a case where the container 13 is arranged so that the container vertical surface 13b of the container 13 extends vertically. The container 13 has a container floor surface 13a and a container vertical surface 13b.
[0014] (Direction of container 13, etc.) For example, the vertical direction is defined as the up-down direction Z (upper side Z1, lower side Z2) (details will be described later). A specific direction of the container 13 that is perpendicular to the up-down direction Z is defined as the container front-rear direction V. One side of the container front-rear direction V is defined as the container front side V1, and the opposite side is defined as the container rear side V2. For example, as shown in FIG. 2, if the shape of the container 13 has a longitudinal direction, the container front-rear direction V is the longitudinal direction of the container 13. For example, if the shape of the container 13 as viewed from the upper side Z1 is rectangular, the container front-rear direction V is a direction along the sides of the rectangle. For example, if the container 13 is a loading platform, the container front side V1 is the side facing the vehicle driver's cab 11a from the container 13, and the container rear side V2 is the side facing the vehicle driver's cab 11a from the vehicle driver's cab 11a to the container 13. A direction perpendicular to both the vertical direction and the container front-rear direction V is defined as the container width direction W. One side of the container width direction W is defined as the container left side W1, and the opposite side is defined as the container right side W2. For example, the right side W2 of the container is the right side when viewed from the front side V1 of the container, and the left side W1 of the container is the left side when viewed from the front side V1 of the container. Note that the container front side V1 and the container rear side V2 in the following description may be reversed. The container right side W2 and the container left side W1 in the following description may be reversed.
[0015] As shown in FIG. 1, the container floor surface 13a is the bottom surface of the container 13. The container floor surface 13a is planar or approximately planar (the same applies to the rear gate plate surface 13b1, the side gate plate surface 13b2, and the gate surface 13b3). The container vertical surface 13b is provided to extend from the container floor surface 13a to the upper side Z1 and is provided to extend in the vertical direction Z. The container vertical surface 13b includes the rear gate plate surface 13b1, the side gate plate surface 13b2, and the gate surface 13b3. The rear gate plate surface 13b1 is the surface of the container rear side V2 of the container 13, and protrudes to the upper side Z1 from the container rear side V2 portion of the container floor surface 13a. As shown in Fig. 2, the side gate plate surfaces 13b2 are the outer (left and right) surfaces of the container 13 in the container width direction W, and protrude upward Z1 from the outer end of the container floor surface 13a in the container width direction W. As shown in Fig. 1, the gate surface 13b3 is the surface of the container front side V1 of the container 13, and protrudes upward Z1 from the container front side V1 portion of the container floor surface 13a. The gate surface 13b3 protrudes upward Z1 more than the side gate plate surfaces 13b2, and protrudes upward Z1 more than the rear gate plate surface 13b1.
[0016] The work machine 20 is a machine that performs work. The work machine 20 is a machine that performs loading work and leveling work, which will be described later. The work machine 20 is, for example, a construction machine that performs construction work, such as a shovel. The work machine 20 is configured to be capable of automatic operation. The work machine 20 may be operated by a worker (operator) in a cab 23a (described later), or may be remotely controlled. The work machine 20 comprises a lower traveling body 21, an upper rotating body 23, an attachment 25, and a drive control unit 27 (see Figure 3).
[0017] The undercarriage 21 allows the work machine 20 to travel. The undercarriage 21 may be equipped with crawlers or wheels.
[0018] The upper rotating body 23 is rotatably mounted on the lower traveling body 21. An attachment 25 is attached to the upper rotating body 23. The upper rotating body 23 is equipped with a cab 23a. The cab 23a is a section where an operator can operate the work machine 20.
[0019] (Direction of work machine 20, etc.) The direction in which the rotation axis of the upper rotating body 23 rotates relative to the lower running body 21 extends is defined as the up-down direction Z. The up-down direction Z is vertical or approximately vertical. In the up-down direction Z, the side (facing) from the lower running body 21 toward the upper rotating body 23 is defined as the upper side Z1, and the opposite side is defined as the lower side Z2. A direction perpendicular to the up-down direction Z, and as shown in FIG. 2, the side from which the attachment 25 protrudes relative to the upper rotating body 23 is defined as the rear side X1 of the machine in the longitudinal direction X of the machine, and the opposite side is defined as the front side X2 of the machine in the longitudinal direction X of the machine. The direction in which the upper rotating body 23 rotates relative to the lower running body 21 is defined as the machine rotation direction Sw.
[0020] As shown in FIG. 1, the attachment 25 is a part that performs work and includes, for example, a boom 25a, an arm 25b, and a bucket 25c. The boom 25a is attached to the upper rotating body 23 so that it can be raised and lowered (rotated in the vertical direction Z). The arm 25b is rotatably attached to the boom 25a. The tip of the arm 25b is referred to as an arm tip 25bt. The bucket 25c is configured to be capable of loading and leveling the work object A. The bucket 25c is provided at the tip of the attachment 25 and rotatably attached to the arm 25b. The bucket 25c includes a bucket opening surface 25c1 and a bucket tip back surface 25c2. The bucket opening surface 25c1 is the opening surface of the bucket 25c and is configured to allow the work object A to enter and exit. The bucket tip back surface 25c2 is configured to be capable of leveling the work object A. The bucket tip back surface 25c2 is flat or approximately flat. The bucket tip back surface 25c2 is provided on the tip side (the side farther from the arm 25b) of the bucket 25c. The bucket tip back surface 25c2 is the part that becomes the lower Z2 part of the bucket 25c when the bucket opening surface 25c1 is placed in the upper Z1 part of the bucket 25c. The tip of the bucket 25c is referred to as bucket tip portion 25ct.
[0021] The work object A is an object that is the target of work by the work machine 20. The work object A is captured by the bucket 25c and released from the bucket 25c. The work object A is leveled by the bucket 25c. The work object A is loaded into the container 13. The work object A may be soil, granules, chips, powder, or the like. For example, the work object A may be soil or sand, stone, wood, metal, or waste.
[0022] The drive control unit 27 (see FIG. 3) controls an actuator that drives the work machine 20. The drive control unit 27 controls a motor that rotates the upper rotating body 23 relative to the lower traveling body 21. The drive control unit 27 controls a cylinder that raises and lowers the boom 25a relative to the upper rotating body 23. The drive control unit 27 controls a cylinder that rotates the arm 25b relative to the boom 25a. The drive control unit 27 controls a cylinder that rotates the bucket 25c relative to the arm 25b.
[0023] The detection unit 30 (see FIG. 3) detects various states. The detection unit 30 shown in FIG. 3 outputs detection values to the controller 50. The detection unit 30 includes an attitude detection unit 31, an imaging device 32, a container detection unit 33, a work object detection unit 34, an in-bucket mass detection unit 35, and a sinking amount detection unit 36.
[0024] The attitude detection unit 31 detects the attitude of the work machine 20 shown in FIG. 1. The attitude detection unit 31 (see FIG. 3) may detect the position and orientation of the work machine 20 relative to the work site. The attitude detection unit 31 may detect the position and orientation of a reference part of the work machine 20 relative to the work site. The reference part of the work machine 20 may be, for example, a specific part of the upper rotating body 23 or the undercarriage 21, and may be, for example, the attachment part (boom foot) of the boom 25a to the upper rotating body 23. The attitude detection unit 31 may detect information (angle, angular velocity, angular acceleration, etc.) about the rotation of the upper rotating body 23 relative to the undercarriage 21. The attitude detection unit 31 may detect information (angle, angular velocity, angular acceleration, etc.) about the rotation of the boom 25a relative to the upper rotating body 23. The attitude detection unit 31 may detect information about the rotation of the arm 25b relative to the boom 25a. The attitude detection unit 31 may detect information about the rotation of the bucket 25c relative to the arm 25b.
[0025] This attitude detection unit 31 (see FIG. 3) may be equipped with a sensor that detects an angle (for example, a rotary encoder), a sensor that detects inclination relative to the horizontal direction, or a sensor that detects the stroke of a cylinder that drives the attachment 25. The attitude detection unit 31 may detect the attitude of the work machine 20 based on at least one of a two-dimensional image and an image having distance information (depth information) (distance image). In this case, at least one of the two-dimensional image and the distance image may be captured by an imaging device 32 (see FIG. 3).
[0026] This attitude detection unit 31 (see Figure 3) may be mounted on the work machine 20 or may be located outside the work machine 20 (for example, at the work site). The same applies to the detection units 30, operation unit 41, and controller 50 other than the attitude detection unit 31 shown in Figure 3, which may be mounted on the work machine 20 or located outside the work machine 20.
[0027] The imaging device 32 captures an image of an object to be imaged. The object to be imaged by the imaging device 32 may be the work machine 20 shown in FIG. 1, for example, the attachment 25, or for example, the bucket 25c. The object to be imaged by the imaging device 32 (see FIG. 3) may be the vehicle 10, for example, the container 13. The object to be imaged by the imaging device 32 may be the work object A. The imaging device 32 may detect two-dimensional information of the object to be imaged (for example, the position and shape in the image). The imaging device 32 may be equipped with a camera (monocular camera) that detects two-dimensional information. The imaging device 32 may detect three-dimensional information of the object to be imaged (for example, three-dimensional coordinates or three-dimensional shape), or may acquire a range image. The imaging device 32 may be equipped with a device that detects three-dimensional information using laser light, for example, a LIDAR (Light Detection and Ranging) sensor, or for example, a TOF (Time Of Flight) sensor. The imaging device 32 may be equipped with a device that detects three-dimensional information using radio waves (for example, a millimeter-wave radar). The imaging device 32 may include a stereo camera. The imaging device 32 may detect three-dimensional information of the imaging target based on a distance image and a two-dimensional image. Only one imaging device 32 may be provided, or multiple imaging devices may be provided.
[0028] The container detection unit 33 (see FIG. 3 ) detects information about the container 13. The container detection unit 33 may detect the position of the container 13, or may detect the shape of the container 13. The container detection unit 33 may detect the information about the container 13 based on an image (at least one of a two-dimensional image and a distance image (the same applies to "image" below)) (in this case, the container detection unit 33 may be the imaging device 32). The container detection unit 33 may detect the information about the container 13 based on teaching information. Detection of the information about the container 13 based on teaching information is performed, for example, as follows: a worker (operator) gets on the work machine 20 and operates the work machine 20, or the worker remotely operates the work machine 20. For example, the worker operates the work machine 20 to position a specific portion of the attachment 25 (e.g., bucket tip 25ct) at a specific portion of the container 13 (e.g., a corner of the container 13). The position (coordinates) where the specific part is located is then calculated based on the attitude of the work machine 20 detected by the attitude detection unit 31 (see FIG. 3). Information about the container 13 is then detected based on the position where the specific part is located. In this case, the container detection unit 33 may be the attitude detection unit 31.
[0029] The work object detection unit 34 (see FIG. 3) detects information about the work object A. The work object detection unit 34 detects information about the work object A inside the container 13, for example. The work object detection unit 34 may detect the position of the work object A, may detect the shape of the work object A, or may detect the height (position in the vertical direction Z) of the work object A. The work object detection unit 34 may detect information about the work object A based on an image. In this case, the work object detection unit 34 may be the imaging device 32 (see FIG. 3).
[0030] The in-bucket mass detection unit 35 (see FIG. 3 ) detects the mass of the work object A in the bucket 25c (captured by the bucket 25c). The in-bucket mass detection unit 35 detects the mass of the work object A that is about to be loaded into the container 13. For example, the in-bucket mass detection unit 35 may detect the mass of the work object A based on the load acting on the bucket 25c. In this case, for example, the in-bucket mass detection unit 35 may detect the load (hydraulic pressure) acting on a bucket cylinder (not shown) that rotates the bucket 25c relative to the arm 25b. In this case, the in-bucket mass detection unit 35 may include a hydraulic sensor. Furthermore, for example, the in-bucket mass detection unit 35 may detect the load acting on a link (not shown) that connects the arm 25b, the bucket 25c, and the bucket cylinder. In this case, the in-bucket mass detection unit 35 may include, for example, a load cell. The in-bucket mass detection unit 35 may calculate the mass of the work object A based on information on the density of the work object A and an image of the work object A in the bucket 25c (the in-bucket mass detection unit 35 may include an imaging device 32 (see Figure 3)).
[0031] The sinking amount detection unit 36 (see FIG. 3) detects the amount of sinking of the container 13 (here, the loading platform) relative to the ground. The sinking amount detection unit 36 detects the amount of sinking of the container 13 relative to the wheels of the vehicle 10. The sinking amount detection unit 36 may be, for example, a sensor provided on the suspension of the vehicle 10. The sinking amount detection unit 36 may detect the amount of sinking based on an image of the vehicle 10. In this case, the sinking amount detection unit 36 is also the container detection unit 33 and includes the imaging device 32.
[0032] The operation unit 41 (see FIG. 3) is used by the worker to input information. The operation unit 41 shown in FIG. 3 issues instructions to the controller 50 based on operations by the worker. When the operation unit 41 is provided on the work machine 20, the operation unit 41 may be, for example, a display or an operation lever provided in the operator's cab 23a (see FIG. 1). The operation unit 41 may be a tablet, a smartphone, or a personal computer. The operation unit 41 may also be provided on a server. The operation performed on the operation unit 41 may be, for example, an operation to specify a work mode, which will be described later, or an operation to set various setting values (adjustment values, threshold values, etc.).
[0033] The controller 50 is a computer that inputs and outputs signals, performs calculations (processing), stores information, and so on. For example, the functions of the controller 50 are realized by the calculation unit executing a program stored in the memory unit of the controller 50. For example, the detection results from the detection unit 30 are input to the controller 50. For example, the controller 50 controls the automatic operation of the work machine 20 (the controller 50 is an automatic operation controller). For example, the controller 50 outputs a command to operate the work machine 20. The controller 50 includes a loading mass estimator 51, a work plan setting unit 53, a work mode setting unit 55, and an automatic operation control unit 57.
[0034] The loaded mass integrating unit 51 calculates the integrated value of the mass of the work object A loaded into the container 13 shown in Fig. 1. The loaded mass integrating unit 51 (see Fig. 3) calculates the integrated value from the start of the loading operation (a state when there is no or almost no work object A in the container 13) to the present. The loaded mass integrating unit 51 integrates the mass of the work object A detected by the in-bucket mass detecting unit 35 (see Fig. 3) every time the work object A is loaded from the bucket 25c into the container 13.
[0035] The work plan setting unit 53 (see FIG. 3) sets a work plan for the work machine 20. The work plan is information related to the target of work for the work machine 20. The work plan may include information on a target range in which the bucket 25c will perform work (for example, a target capture range C (see FIG. 2) described below). The work plan may include information on a target path (for example, a target path P for leveling work (see FIG. 5)) for a specific portion of the attachment 25 (for example, the arm tip 25bt, for example, the bucket tip 25ct). The work plan may include information on the swing angle of the upper rotating body 23. The work plan may include information on the radius from the center of swing of the upper rotating body 23 relative to the lower traveling body 21 to the specific portion (information in the machine's fore-and-aft direction X). The work plan may include information on the height of the specific portion (position in the up-down direction Z) (for example, the height from the bottom of the upper rotating body 23 to the specific portion). At least a part of the work plan may be set in the work plan setting unit 53 by teaching, or may be set in the work plan setting unit 53 by a method other than teaching (for example, inputting numerical values).
[0036] The work mode setting unit 55 (see Figure 3) sets the work mode. The work mode is the type of work operation performed by the work machine 20. The work mode setting unit 55 selects and sets one work mode from multiple work modes. The work mode setting unit 55 changes the work mode. Various work modes can be set. The work modes include a loading mode and a leveling mode. The work modes may include work modes other than loading and leveling. Specifically, for example, the work modes may include a work mode for stirring or moving the work object A within a certain range.
[0037] The automatic driving control unit 57 (see Figure 3) automatically drives the work machine 20 so that the work machine 20 operates (automatically drives) in accordance with the work plan. The automatic driving control unit 57 shown in Figure 3 calculates commands (operation amounts) to be output to the drive control unit 27 so that the work machine 20 operates (automatically drives) in accordance with the work plan, and outputs these commands to the drive control unit 27. The automatic driving control unit 57 controls the operation of the work machine 20 based on the detection value of the attitude detection unit 31.
[0038] (Activation) The work system 1 is configured to operate as follows. An overview of the operation of the work system 1 is as follows: The controller 50 causes the work machine 20 to perform loading work and leveling work by automatic operation. Specifically, the work plan setting unit 53 sets work plans for loading work and leveling work. The work mode setting unit 55 sets (selects) the loading work mode or the leveling work mode. The automatic operation control unit 57 operates the work machine 20 in accordance with the work plan corresponding to the mode set in the work mode setting unit 55. As a result, the work machine 20 operates by automatic operation in accordance with the work plan.
[0039] (Arrangement of the work machine 20 relative to the container 13) The work machine 20 shown in Fig. 1 may be disposed in various relative positions with respect to the container 13. For example, the work machine 20 may be disposed so as to face the container 13 in the container front-rear direction V. In the example shown in Fig. 1, the work machine 20 is disposed on the container rear side V2 of the container 13. For example, as shown in Fig. 2, the work machine 20 may be disposed so as to face the container 13 in the container width direction W. In the example shown in Fig. 2, the work machine 20 is disposed on the container left side W1 of the container 13. The work machine 20 may be disposed so as to face the container 13 in the container width direction W of the container. Right side W2 The following mainly describes a case where the work machine 20 is arranged to face the container 13 in the container width direction W. The controller 50 will be described below with reference to FIG. 3, and steps S10 to S22 shown in FIG. 4 will be described with reference to FIG.
[0040] (Loading work) The controller 50 causes the work machine 20 shown in FIG. 2 to perform a loading operation by automatic operation (step S10 in FIG. 4). The loading operation is an operation in which a work object A is loaded into the container 13 using the bucket 25c. A specific example of the loading operation is as follows. The loading operation includes a plurality of work phases (work contents). For example, the work phases include a capture phase, a lifting and swinging phase, a release phase, and a return swing phase. The capture phase is a phase in which the bucket 25c captures the work object A within the target capture range C (e.g., excavates earth and sand). For example, the target capture range C is set to a location where the work object A has been collected (e.g., a pile of earth and sand, a sand pit, etc.). The lifting and swing phase is a phase in which the bucket 25c moves from the target capture range C toward the container 13 while having captured the work object A. In the lifting swing phase, the bucket 25c moves in the machine swing direction Sw and in the vertical direction Z (mainly upward Z1). In the release phase, the bucket 25c releases (e.g., dumps) the work object A directly above the container 13 (loading position E). In the return swing phase, the bucket 25c moves from a position directly above the container 13 toward the target capture range C. In the return swing phase, the bucket 25c moves in the machine swing direction Sw and in the vertical direction Z (mainly downward Z2). In loading operations, a series of work phases, including the capture phase, lifting swing phase, release phase, and return swing phase, are repeated.
[0041] (Loading position E) During loading, the position (loading position E) at which the workpiece A is loaded from the bucket 25c into the container 13 can be set in various ways. For example, the loading position E may be changed for each loading (each release phase), or may remain the same until a certain condition is met. [Example 1A] For example, the loading position E may be changed sequentially in a predetermined direction. [Example 1Aa] For example, the loading position E may be changed sequentially in the container fore-and-aft direction V (the longitudinal direction of the container 13). For example, the loading position E may be changed sequentially from the container front side V1 to the container rear side V2 (or vice versa). For example, the loading position E may be changed sequentially in the container width direction W. For example, the loading position E may be changed sequentially from the container right side W2 to the container left side W1 (or vice versa). For example, the loading position E may be changed sequentially in the machine swing direction Sw. For example, the loading position E may be changed sequentially in the machine fore-and-aft direction X. [Example 1Ab] For example, the loading position E may be changed sequentially from one end side to the other end side (the end opposite to the one end side) of the container 13. The loading position E does not have to be changed sequentially from one end side to the other end side of the container 13. [Example 1B] The loading position E does not have to be changed sequentially in a predetermined direction, but may be changed intermittently (to discontinuous positions).
[0042] (Loading operation completion conditions) Loading operation end conditions are set in advance (before determining whether loading operation has ended) in the controller 50 (more specifically, in the work mode setting unit 55 (see FIG. 3)). The loading operation end conditions are conditions that cause the work machine 20 to end loading operation. The loading operation end conditions are also conditions that cause the work machine 20 to start leveling operation (leveling operation start conditions). Various loading operation end conditions can be set. Only one loading operation end condition may be set, or multiple loading operation end conditions may be set (see FIG. 4). When multiple loading operation end conditions are set, the controller 50 may end loading operation when at least one loading operation end condition is satisfied, or may end loading operation when two or more (for example, all) loading operation end conditions are satisfied. Specific examples of loading operation end conditions are as follows:
[0043] (Operation of the operation unit 41, etc.) The loading operation end condition may include the output of a command to end the loading operation. The loading operation end condition may include the output of a command to start leveling operation. The loading operation end condition may include the output of a command to change the operation mode from a loading operation mode to a leveling operation mode. For example, the loading operation end condition may include the output of the above command from the operation unit 41 (see FIG. 3) (step S11 in FIG. 4). Note that the loading operation end condition may also include the output of a command to end the loading operation (a command not operated by the worker) from an element other than the operation unit 41.
[0044] (Number of loading operations, etc.) The loading operation termination condition may include the number of times that the container 13 has been loaded from the bucket 25c shown in FIG. 2 (the number of times the above-described "series of phases" has been performed) reaching a predetermined number (number of times threshold) (step S12 in FIG. 4). [Example 2A] The number of times threshold may be set manually by an operator. [Example 2Aa] For example, the number of times, which is the number of times threshold, may be set by the operation unit 41 (see FIG. 3). [Example 2Ab] For example, information for setting the number of times threshold may be set by the operation unit 41, and the controller 50 may calculate the number of times threshold based on the information set by the operation unit 41. Specifically, for example, the controller 50 may calculate the number of times threshold based on manually set information (such as dimensions) of the container 13. [Example 2B] The number of times threshold may be automatically set by the controller 50. For example, the controller 50 may calculate the number of times threshold based on information about the container 13 detected by the container detection unit 33 (see FIG. 3). [Example 2C] The number of times threshold may be an initial value or a fixed value preset in the controller 50.
[0045] Various setting values (threshold values, adjustment values, etc.) other than the number threshold value may also be set manually by an operator, may be calculated automatically by the controller 50, or may be values set in advance in the controller 50.
[0046] (Accumulated loading mass) The loading operation termination condition may include that the mass of the work object A loaded into the container 13 during the loading operation reaches a target value (cumulative loaded mass threshold) (step S13 in FIG. 4). More specifically, the loading operation termination condition may include that the value calculated by the loaded mass integrating unit 51 (see FIG. 3) reaches the cumulative loaded mass threshold (becomes equal to or greater than the cumulative loaded mass threshold).
[0047] (End of loading work) The controller 50 causes the work machine 20 to end the loading operation when a loading operation end condition is satisfied (step S15 in FIG. 4). More specifically, the controller 50 causes the work machine 20 to end the loading operation when the loading operation end condition is satisfied and the bucket 25c has completed releasing the work object A. For example, if the loading operation end condition is satisfied during the return swing phase, the capture phase, or the lift swing phase, the controller 50 causes the work machine 20 to perform the loading operation until the bucket 25c has completed releasing the work object A. Furthermore, if the loading operation end condition is satisfied during the release phase when the bucket 25c has not completed releasing the work object A, the controller 50 causes the work machine 20 to perform the loading operation until the bucket 25c has completed releasing the work object A. Specifically, for example, when the loading operation is to be ended, the automatic driving control unit 57 (see FIG. 3) outputs a command to end the loading operation to the drive control unit 27 (see FIG. 3). As a result, the work machine 20 ends the loading operation.
[0048] The position where the bucket 25c is positioned at the end of the loading operation is defined as the loading end position Ee. The loading end position Ee is the position of the bucket 25c when the bucket 25c releases the work object A at the end of the loading operation (before the leveling operation starts and at the very end). Note that in FIG. 2, the loading end position Ee is indicated by a dot. The same applies to each point on the target path P for the leveling operation shown in FIGS. 2 and 5. This dot indicates the position of a specific part of the attachment 25 (for example, the arm tip 25bt).
[0049] (Leveling work) After the loading operation is completed, the controller 50 causes the work machine 20 shown in FIG. 2 to start a leveling operation. The leveling operation is an operation in which the work object A loaded into the container 13 is leveled with the bucket 25c. The position of the bucket 25c when the leveling operation starts is defined as the leveling operation start position Ps. After the loading operation is completed, the controller 50 moves the bucket 25c from the loading end position Ee to the leveling operation start position Ps.
[0050] (Movement from loading end position Ee to leveling work start position Ps) At this time, it is preferable that the controller 50 moves the bucket 25c from the loading end position Ee to the leveling work start position Ps along a path that can suppress unnecessary operation of the attachment 25. For example, the path of the arm tip 25bt when the bucket 25c moves from the loading end position Ee to the leveling work start position Ps may be a straight line or a substantially straight line.
[0051] (Area of the smoothing work start position Ps) It is preferable to set the leveling work start position Ps so as to prevent unnecessary operation of the attachment 25. Specifically, the leveling work start position Ps is set to a portion of the container 13 on the loading end position Ee side. That is, the controller 50 causes the work machine 20 to start leveling work in a portion of the container 13 on the loading end position Ee side (see steps S20, S21, and S22 in FIG. 4). This makes it possible to reduce the travel distance of the bucket 25c from the loading end position Ee to the leveling work start position Ps, thereby shortening the work time.
[0052] The "side of the loading end position Ee" is a region that includes the loading end position Ee when the internal region of the container 13 as viewed from the upper side Z1 is divided into two equal regions in a "predetermined direction" (for example, a container front region Gv1 and a container rear region Gv2, which will be described later). The "predetermined direction" may be, for example, the container front-rear direction V or the container width direction W. The "predetermined direction" may be, for example, the machine rotation direction Sw or the machine front-rear direction X. When the loading end position Ee is located at the boundary between the two regions (for example, the container front region Gv1 and the container rear region Gv2, which will be described later), the leveling operation start position Ps may be in either of the two regions. In such a case, which region the leveling operation start position Ps should be in may be preset in the controller 50.
[0053] [Example 3A] For example, if the container 13 has a shape with a longitudinal direction when viewed from the top side Z1, the leveling operation start position Ps is determined as follows. The leveling operation start position Ps is set to a portion of the container 13 on the loading end position Ee side in the longitudinal direction (container front-rear direction V) of the container 13. That is, the controller 50 starts the leveling operation on the loading end position Ee side in the longitudinal direction (container front-rear direction V) of the container 13. Specifically, for example, when the interior area of the container 13 as viewed from the top side Z1 is divided into two equal areas in the container front-rear direction V, the area on the container front side V1 is set to the container front side area Gv1, and the area on the container rear side V2 is set to the container rear side area Gv2. If the loading end position Ee is the container front side area Gv1 (YES in step S20 of FIG. 4), the leveling operation start position Ps is also set to the container front side area Gv1 (step S21 of FIG. 4). If the loading end position Ee is in the container rear area Gv2 (NO in step S20 in FIG. 4), the leveling operation start position Ps is set to the container rear area Gv2 (step S22 in FIG. 4).
[0054] In the flowchart shown in Fig. 4, if the loading end position Ee is located at the boundary between the container front area Gv1 and the container rear area Gv2 shown in Fig. 2, the result in step S20 in Fig. 4 is NO. In this case, the leveling work start position Ps shown in Fig. 2 is set to the container rear area Gv2 (step S22 in Fig. 4). If the loading end position Ee is located at the boundary between the container front area Gv1 and the container rear area Gv2, the leveling work start position Ps may be set to the container front area Gv1.
[0055] [Example 3B] For example, the leveling work start position Ps may be set to a portion of the container 13 on the loading end position Ee side in the container width direction W (i.e., the short side direction). Specifically, for example, when the interior area of the container 13 as viewed from the top Z1 is divided into two equal parts in the container width direction W into two areas, the area on the left side W1 of the container is set to the container left side area Gw1, and the area on the right side W2 of the container is set to the container right side area Gw2. When the loading end position Ee is the container left side area Gw1, the leveling work start position Ps is set to the container left side area Gw1. When the loading end position Ee is the container right side area Gw2, the leveling work start position Ps is set to the container right side area Gw2.
[0056] It should be noted that the above [Example 3A] and [Example 3B] may be combined. Specifically, for example, when the loading end position Ee is in the container rear region Gv2 and the container left region Gw1, the leveling operation start position Ps may also be in the container rear region Gv2 and the container left region Gw1 (the same applies to other regions).
[0057] (Distance from the end of the container 13 to the work start position Ps) It is preferable that the position of the bucket 25c (more specifically, the target path P of the leveling work (see Figure 5)) be set so that contact between the container 13 (more specifically, the container vertical surface 13b) and the bucket 25c can be suppressed when the leveling work is performed.
[0058] It is preferable that the leveling start position Ps be set so that contact between the container 13 (container vertical surface 13b) and the bucket 25c can be prevented when the bucket 25c is positioned at the leveling start position Ps. The horizontal distance (horizontal distance) between the bucket 25c positioned at the leveling start position Ps and the container vertical surface 13b can be set in various ways. This horizontal distance may be set manually by the worker or automatically by the controller 50 (more specifically, the work plan setting unit 53 (see FIG. 3)) (see the explanation of the count threshold).
[0059] (Sequence of leveling work) After the leveling work is started at the leveling work start position Ps, the position where the bucket 25c performs the leveling work (leveling work position) can be set in various ways.
[0060] For example, the leveling work position may be changed in sequence in a predetermined direction (for example, the container front-rear direction V, the container width direction W, etc.). For example, the leveling work position may be changed in sequence from a portion on the loading end position Ee side within the container 13 to a portion on the opposite side of the loading end position Ee within the container 13. For example, the leveling work position may be changed in sequence from one end of the container 13 to the other end.
[0061] Specifically, for example, assume that the loading end position Ee is the container rear region Gv2. In this case, the leveling operation position may be changed sequentially from the container rear side V2 end of the container 13 to the container front side V1 end of the container 13. [Example 4A] In this case, the leveling operation may be performed over the entire (or substantially the entire) container width direction W at the container rear side V2 end of the container 13. Thereafter, the leveling operation may be performed over the entire (or substantially the entire) container width direction W at a position on the container front side V1 of the container 13, which is closer to the container rear side V2 end (see FIG. 5). In this way, the position where the leveling operation is performed over the entire (or substantially the entire) container width direction W may be changed sequentially to the container front side V1. [Example 4B] Alternatively, the leveling operation position may be changed sequentially from the container rear side V2 end of the container 13 to the container front side V1 end of the container 13, without being changed in the container width direction W. Thereafter, the smoothing operation position may be changed in the container front-rear direction V (from the container front side V1 to the container rear side V2, or vice versa) in a state where it has been changed in the container width direction W.
[0062] The leveling work position does not have to be changed sequentially in a predetermined direction (for example, the container front-rear direction V, the container width direction W, etc.). The leveling work position does not have to be changed sequentially from one end to the other end of the container 13. The leveling work position may be changed intermittently (to discontinuous positions) within the container 13.
[0063] (Press and smooth) For example, as the leveling operation, the controller 50 causes the bucket 25c to perform "push-leveling," which pushes the work object A shown in FIG. 1 downward Z2. "Push-leveling" means that a part of the bucket 25c (specifically, for example, the back surface 25c2 of the bucket tip) pushes the work object A in the container 13 downward Z2. For example, the controller 50 causes the bucket 25c to perform push-leveling multiple times while changing its position. As a result, the bucket 25c shown in FIG. 5 levels (flattens or makes approximately flat) the work object A in the push-leveling range Q.
[0064] The pushing and leveling range Q is the range of the workpiece A that the bucket 25c pushes and levels in one pushing and leveling operation when viewed from above Z1. The pushing and leveling range Q is the range of the workpiece A directly below the bucket 25c that is pushing and leveling. In other words, the pushing and leveling range Q is the range of the workpiece A that is below the bucket 25c Z2 and faces the bucket 25c in the up-and-down direction Z.
[0065] (Lap section Q1) When the bucket 25c presses and smoothes the workpiece A, a portion of the workpiece A is pushed out (protrudes) to the periphery of the pressing and smoothing area Q. More specifically, the surface of the upper side Z1 of the workpiece A around the pressing and smoothing area Q is higher than the surface of the upper side Z1 of the workpiece A within the pressing and smoothing area Q. At this time, it is preferable that the pressing and smoothing be performed so that the workpiece A pushed out to the periphery of the pressing and smoothing area Q can be smoothed. Specifically, for example, the controller 50 changes the pressing and smoothing area Q so that portions of adjacent pressing and smoothing areas Q overlap (so that overlapping lap portions Q1 are provided). The direction in which multiple pressing and smoothing areas Q are adjacent (the overlap direction) may be the container front-rear direction V, the container width direction W, the machine rotation direction Sw, the machine front-rear direction X, or a combination of these directions. In the example shown in FIG. 5, the directions in which multiple pressing and smoothing areas Q are adjacent are the container front-rear direction V and the container width direction W. More specifically, a part of the pressing and leveling range Qp1 when the bucket 25c is at position P1 (described later) and a part of the pressing and leveling range Qp2 when the bucket 25c is at position P2 (described later) overlap in the container width direction W. Furthermore, a part of the pressing and leveling range Qp1 and a part of the pressing and leveling range Qp3 when the bucket 25c is at position P3 (described later) overlap in the container front-rear direction V.
[0066] The width (amount of overlap) of the lap portion Ql may be set manually by the worker (for example, by operating the operation unit 41 (see FIG. 3)), or may be set automatically by the controller 50 (work plan setting unit 53 (see FIG. 3)). For example, the width of the lap portion Ql may be set based on the shape of the work object A (extruded work object A) surrounding the pressing and leveling area Q, detected by the work object detection unit 34 (see FIG. 3). Note that FIG. 6 illustrates a case where the lap portion Ql (see FIG. 5) is not provided.
[0067] (Container 13 sinks, pressing and leveling end position Pe) As shown in FIG. 1, if the container 13 is the loading platform of the vehicle 10, the container 13 is pushed by the bucket 25c via the work object A, and moves (sinks) downward Z2 relative to the ground. For example, if the work object A has been leveled and the bucket 25c further pushes down on the work object A, the work machine 20 will perform unnecessary pushing and leveling. Furthermore, if the bucket 25c pushes down the work object A too far, there is a risk of damaging the vehicle 10. Therefore, to prevent these problems, it is preferable to set a pushing and leveling end position Pe shown in FIG. 6. The "pushing and leveling end position Pe" is the position of the bucket 25c when one pushing and leveling operation is completed.
[0068] [Example 5A] The pushing-leveling end position Pe may be set based on the sinking amount of the container 13. More specifically, the controller 50 causes the bucket 25c to end one pushing-leveling operation when the sinking amount of the container 13 (here, the loading platform) detected by the sinking amount detection unit 36 (see FIG. 3) exceeds a predetermined amount (sinking amount threshold).
[0069] This [Example 5A] will be compared with a case in which the pushing-leveling end position Pe is set based on the load acting on the bucket 25c (see [Example 5B] described later). It is expected that the load acting on the bucket 25c will increase (change significantly) after the container 13 has sunk significantly. However, it is expected that by the time the load acting on the bucket 25c increases, the container 13 has already sunk significantly, and the bucket 25c has already pushed the work object A down too far. On the other hand, when the pushing-leveling end position Pe is set based on the amount of sinking of the container 13, it is possible to prevent the bucket 25c from pushing the work object A down too far.
[0070] [Example 5B] The pushing-leveling end position Pe may be set based on the load acting on the bucket 25c. The load acting on the bucket 25c may be detected by the bucket mass detection unit 35 (see FIG. 3). The load acting on the bucket 25c may be detected based on, for example, a load (e.g., hydraulic pressure) acting on a bucket cylinder (not shown) that rotates the bucket 25c relative to the arm 25b. The load acting on the bucket 25c may also be detected based on a load acting on a link (not shown) that connects the arm 25b, the bucket 25c, and the bucket cylinder.
[0071] [Example 5C] The pressing and leveling end position Pe may be set based on information (e.g., shape, etc.) of the workpiece A detected by the workpiece detection unit 34 (see FIG. 3). For example, the pressing and leveling end position Pe may be set based on the height (position in the vertical direction Z) of the face (surface) of the upper side Z1 of the workpiece A. [Example 5D] The pressing and leveling end position Pe may be set based on information (e.g., position, shape, etc.) of the container 13 detected by the container detection unit 33 (see FIG. 3). For example, the pressing and leveling end position Pe may be set based on the height of the container 13, or may be set based on the height of the container vertical surface 13b (e.g., the rear gate plate surface 13b1 or the side gate plate surface 13b2). The pressing and leveling end position Pe may be set based on the height of the container floor surface 13a. [Example 5E] The pressing and leveling end position Pe may be set manually by the worker (e.g., by operating the operation unit 41 (see FIG. 3)).
[0072] (Leveling, etc.) The leveling work does not have to be performed by pushing and leveling. For example, the leveling work may be an operation (horizontal leveling) in which the bucket 25c shown in Fig. 1 is in contact with the work object A and the bucket 25c is moved horizontally to level the work object A. The direction of movement of the bucket 25c in horizontal leveling may be the container front-rear direction V, the container width direction W, the machine rotation direction Sw (see Fig. 2), the machine front-rear direction X, or a combination of these directions.
[0073] (Example of coordinate calculation) A specific example of the position of the bucket 25c when the leveling work is pushing and leveling and the pushing and leveling range Q shown in FIG. 5 is changed from the rear side V2 of the container to the front side V1 of the container is as follows: The controller 50 (more specifically, the work plan setting unit 53 (see FIG. 3)) calculates a target path P of the bucket 25c. The target path P includes information on target positions and the order of the target positions. The target positions of the target path P include position P1, position P2, . . . position Pn. The order of position P1, position P2, . . . position Pn is the order of the target positions (the order in which the bucket 25c performs pushing and leveling). "Position Pn" is the last target position in the target path P, and in the example shown in FIG. 5, it is position P6. A raising position and a lowering position are set for each target position (P1, P2, . . . Pn). For example, as shown in FIG. 6, a raising position P1_1 and a lowering position P1_2 are set for position P1.
[0074] The raising position P1_1 is the position of the bucket 25c before the bucket 25c performs pushing and leveling (raising position before leveling), and the position of the bucket 25c after the bucket 25c performs pushing and leveling and then moves to the upper side Z1 (raising position after leveling). Note that the raising position before leveling and the raising position after leveling may be the same position or different positions. In the example shown in FIG. 6, the position of the bucket tip back surface 25c2 is shown for the raising position P1_1 (the same applies to the lowering position P1_2).
[0075] The lowering position P1_2 is the position of the bucket 25c when the bucket 25c is positioned at the lowest side Z2 during pushing and leveling at the position P1, and is the pushing and leveling end position Pe. As with the position P1, the raising position and the lowering position are also set for the target positions (P2, P3, . . . Pn) other than the position P1 shown in FIG.
[0076] For example, the controller 50 expresses each target position (P1, P2, . . . Pn) and the position of the container 13 using predetermined coordinates. These coordinates may include, for example, coordinates in the machine longitudinal direction X, the vertical direction Z, and the machine swing direction Sw (X coordinate, Z coordinate, and Sw coordinate). The reference (origin) of these coordinates may be, for example, the position of the attachment portion (boom foot pin) of the boom 25a to the upper swing structure 23 shown in FIG. 1, or the center of swing of the upper swing structure 23 relative to the lower traveling structure 21.
[0077] (input data) Input data is set in the controller 50 before the controller 50 sets (generates, calculates, and outputs) the target positions (P1, P2, . . . Pn) shown in FIG. 5 . The input data may include, for example, position information of the container 13. For example, the position information of the container 13 may include position information (specifically, three-dimensional coordinates) of the end points IA, IB, IC, and ID of the container 13. For example, the end point IA is the upper Z1 end of the intersection between the side gate plate surface 13b2 on the machine front side X2 and the rear gate plate surface 13b1. For example, the end point IB is the upper Z1 end of the intersection between the side gate plate surface 13b2 on the machine rear side X1 and the rear gate plate surface 13b1. For example, the end point IC is the intersection between the side gate plate surface 13b2 on the machine front side X2 and the gate surface 13b3, and is also the upper Z1 end of the side gate plate surface 13b2. For example, the end point ID is the portion where the side gate plate surface 13b2 on the machine rear side X1 intersects with the torii surface 13b3, and is also the upper Z1 end portion of the side gate plate surface 13b2. The input data may include each adjustment value described later.
[0078] (output data) The controller 50 sets a target path P for the leveling operation based on the input data. For example, the controller 50 sets the position and angle of a specific portion of the attachment 25 at each target position (P1, P2, . . . Pn). Specifically, for example, the controller 50 may calculate the angle of the machine swing direction Sw (swing angle) of the upper swing body 23 relative to the lower traveling body 21 shown in FIG. 2 at each target position. The controller 50 may calculate the position of a specific portion of the arm 25b (e.g., the arm tip 25bt) at each target position. The controller 50 may calculate the bucket angle Xi shown in FIG. 1 at each target position. The bucket angle Xi may be the angle of the bucket 25c relative to the vertical direction, the angle of the bucket 25c relative to the horizontal direction (ground angle), or the angle of the bucket 25c relative to the arm 25b. In the example shown in FIG. 1, the bucket angle Xi is the angle of the bucket tip back surface 25c2 relative to the vertical direction. For example, the controller 50 may calculate the position of a specific portion of the bucket 25c (such as the bucket tip 25ct) at each target position. For example, the controller 50 may calculate the coordinates of the bucket tip 25ct and convert these coordinates into the coordinates of the arm tip 25bt and the bucket angle Xi.
[0079] The controller 50 calculates the number of times n to perform pressing and leveling. The number of times n to perform pressing and leveling may be calculated based on the dimensions of the container 13 shown in FIG. 5. The number of times n to perform pressing and leveling may be calculated based on the dimensions of the bucket 25c. The number of times n to perform pressing and leveling may be calculated based on the amount of shift between adjacent pressing and leveling ranges Q. The amount of shift is, for example, the distance between certain points (e.g., central points) of adjacent pressing and leveling ranges Q in a predetermined shift direction. The predetermined shift direction may be the container front-rear direction V, the container width direction W, the machine rotation direction Sw, or the machine front-rear direction X. The amount of shift may be calculated based on manual operation by an operator (e.g., operation of the operation unit 41 (see FIG. 3)) or may be automatically calculated by the controller 50. For example, the amount of shift may be calculated based on information (e.g., dimensions) of the bucket 25c detected by the imaging device 32 (see FIG. 3). The number of times n of pressing and leveling is preferably calculated so that the bucket 25c does not come into contact with the container 13 (more specifically, the vertical surface 13b of the container).
[0080] Specifically, for example, when the number of times n of pressing and leveling is calculated based on the dimensions of the container 13 and the amount of shift in the machine rotation direction Sw (amount of shift rotation angle), the number of times n of pressing and leveling is calculated by the following formula. n = number of columns × (|IB_sw - ID_sw| - first adjustment value) / shift rotation angle
[0081] Here, the number of rows is the number of pressing-leveling ranges Q in the container width direction W (the number of pressing-leveling operations). In the example shown in FIG. 5, the number of rows is two (for example, two at positions P1 and P2). IB_sw is the angle (swing angle) of the upper swing body 23 in the machine swing direction Sw when it is assumed that the attachment 25 shown in FIG. 2 faces the end point IB (for example, when viewed from the upper side Z1, the center line of the attachment 25 extending in the machine front-rear direction X passes through the end point IB). ID_sw is the swing angle when it is assumed that the attachment 25 faces the end point ID. The first adjustment value is an adjustment value set so that the bucket 25c does not come into contact with the container 13. The offset swing angle amount is the amount of offset between adjacent pressing-leveling ranges Q in the machine swing direction Sw shown in FIG. 5.
[0082] (Coordinates of lifting position P1_1) The position (coordinates) of the lifting position P1_1 of the position P1 shown in FIG. 6 is calculated, for example, as follows. As described above, the lifting position P1_1 before leveling and the lifting position P1_1 after leveling may be the same position or different positions. Furthermore, the calculation method for the coordinates of the lifting position P1_1 may be the same or different between the lifting position P1_1 before leveling and the lifting position P1_1 after leveling. Below, the lifting position P1_1 and the lowering position P1_2 will be described with reference to FIG. 6.
[0083] The X coordinate of the arm tip 25bt shown in Figure 5 at the raised position P1_1 is defined as P1_1_x. For example, in the X coordinate, X1 toward the rear of the machine is defined as the positive direction, and X2 toward the front of the machine is defined as the negative direction. In this case, P1_1_x is calculated by the following formula. P1_1_x=IA_x+(|IA_x-IB_x|-second adjustment value) / (number of columns+1)
[0084] Here, IA_x is the X coordinate of the end point IA. IB_x is the X coordinate of the end point IB. The second adjustment value is an adjustment value that is set to prevent the bucket 25c from contacting the container 13. "Number of rows + 1" is 3 in the example shown in FIG. 5 (number of rows is 2).
[0085] 6 at the raised position P1_1 is defined as P1_1_z. For example, in the Z coordinate, the upper side Z1 is defined as the positive direction, and the lower side Z2 is defined as the negative direction.
[0086] [Example 6A] P1_1_z may be set based on the Z coordinate (P1_2_z) of the arm 25b at the lowering position P1_2. For example, P1_1_z of the raising position P1_1 before leveling may be calculated based on P1_2_z (described later) that is determined even without pressing and leveling. For example, P1_1_z of the raising position P1_1 after leveling may be calculated based on P1_2_z that is determined even without pressing and leveling, or may be calculated based on P1_2_z (described later) that is determined after pressing and leveling. Specifically, for example, P1_1_z is calculated by the following formula. P1_1_z = P1_2_z + third adjustment value
[0087] Here, the third adjustment value is the height of the raising position P1_1 relative to the lowering position P1_2. The third adjustment value may be set by manual operation by the worker (for example, by operating the operation unit 41 (see FIG. 3)), or may be automatically set by the controller 50. For example, the third adjustment value may be calculated based on the height of the work object A detected by the work object detection unit 34 (see FIG. 3).
[0088] [Example 6B] P1_1_z may be set without being based on P1_2_z. For example, P1_1_z may be set to a value such that the bucket 25c placed at the lifting position P1_1 is placed on the upper side Z1 of the work object A. In this case, P1_1_z may be calculated based on the height of the work object A detected by the work object detection unit 34 (see FIG. 3), for example.
[0089] The bucket angle Xi (P1_1_xi) at the raising position P1_1 (see FIG. 1 for the bucket angle Xi) is set to a size suitable for the bucket 25c to push and level the work object A. Specifically, for example, P1_1_xi is set to a size (specifically, 270 degrees, etc.) such that the bucket tip back surface 25c2 is parallel or approximately parallel to the horizontal direction.
[0090] The swing angle (P1_1_sw) at the raised position P1_1 of the upper swing body 23 shown in Fig. 2 is calculated, for example, by the following formula: In the machine swing direction Sw, the left side (left side of swing) when facing the rear side X1 of the machine is defined as the positive direction, and the left side of swing is defined as the negative direction. P1_1_sw=IB_sw-4th adjustment value
[0091] Here, the fourth adjustment value is an adjustment value (specifically, 5 degrees, etc.) that is set so that the bucket 25c does not come into contact with the container 13. Note that P1_1_sw may also be "IA_sw - fourth adjustment value." IA_sw is the rotation angle of the upper rotating body 23 when it is assumed that the attachment 25 is facing the end point IA.
[0092] The coordinates of the lifting positions at each target position (P2, P3, . . . Pn) other than the position P1 shown in FIG. 5 are calculated using the same calculation method (idea) as that for calculating the coordinates of the lifting position P1_1 at the position P1.
[0093] (Coordinates of lowering position P1_2) The position (coordinates) of lowering position P1_2 of position P1 is calculated, for example, as follows. The X coordinate (P1_2_x) of arm tip 25bt at lowering position P1_2 is set to the same value as the X coordinate (P1_1_x) of arm tip 25bt at raising position P1_1. The bucket angle Xi (see FIG. 1) and the swing angle of upper swing body 23 (see FIG. 2) at lowering position P1_2 are set to the same values as the bucket angle Xi and swing angle at raising position P1_1.
[0094] The Z coordinate (P1_2_z) of the arm tip 25bt shown in Fig. 6 at the lowered position P1_2 is calculated as follows: P1_2_z may be determined without pressing and leveling, or may be determined after pressing and leveling.
[0095] [Example 7A] For example, in the cases of [Example 7A1] and [Example 7A2] below, P1_2_z is determined even if pressing and leveling is not performed. [Example 7A1] P1_2_z may be set manually by the worker (for example, by operating the operation unit 41 (see FIG. 3), teaching, etc.). [Example 7A2] P1_2_z may be set based on information about the container 13. Specifically, for example, P1_2_z may be set based on the height of the container floor surface 13a. P1_2_z may be set based on the height of the side gate plate surface 13b2, the height of the rear gate plate surface 13b1, or the height of at least one of the end points IA, IB, IC, and ID. P1_2_z may be set based on information about the work object A before pressing and leveling (for example, shape, height, etc.). The information about the work object A before pressing and leveling is detected by the work object detection unit 34 (see FIG. 3).
[0096] [Example 7B] For example, P1_2_z may be the position where the sinking amount of the container 13 detected by the sinking amount detection unit 36 (see FIG. 3) exceeds a predetermined amount (sinking amount threshold). In this case, P1_2_z is determined after pressing and leveling is performed.
[0097] The coordinates of the lowering position at each target position (P2, P3, . . . Pn) other than the position P1 shown in FIG. 5 are calculated using the same calculation method (idea) as the calculation of the coordinates of the lowering position P1_2 at the position P1.
[0098] (Coordinates of position P2) Position P2 shown in FIG. 5 is set at a position shifted from position P1 by a predetermined amount in the container width direction W (the right side of the container in FIG. 5, W2) or the machine front-rear direction X (the machine rear side in FIG. 5, X1). For example, the Z coordinate and bucket angle Xi (see FIG. 1) of the arm tip 25bt at position P2 may be set to be the same as (or different from) the Z coordinate and bucket angle Xi of the arm tip 25bt at position P1. The X coordinate and pivot angle of the arm tip 25bt at position P2 may be set so that position P2 is shifted by a predetermined amount in the container width direction W relative to position P1. The X coordinate of the arm tip 25bt at position P2 may be set so that position P2 is shifted by a predetermined amount in the machine front-rear direction X relative to position P1. In this case, the pivot angle at position P2 may be equal to (or different from) the pivot angle at position P1.
[0099] (Coordinates of position P3) Position P3 is set at a position shifted from position P1 by a predetermined amount in the container front-rear direction V (container front side V1 in FIG. 5) or the machine swing direction Sw. Specifically, for example, the Z coordinate and bucket angle Xi (see FIG. 1) of the arm tip 25bt at position P3 may be set to be the same as (or different from) the Z coordinate and bucket angle Xi of the arm tip 25bt at position P1. The X coordinate of the arm tip 25bt at position P3 may be set so that the position of position P3 in the container width direction W and the position of position P1 in the container width direction W are the same (or approximately the same). The X coordinate of the arm tip 25bt at position P3 may be the same as the X coordinate of the arm tip 25bt at position P1. The swing angle (P3_sw) at position P3 is calculated, for example, by the following formula: P3_sw=P1_1_sw-shift turning angle amount =IB_sw-4th adjustment value-shifted turning angle amount
[0100] The positions of target positions other than positions P1, P2, and P3 (positions P4, P5, and P6) are calculated using the same calculation method (concept) as positions P1, P2, and P3. Note that the above coordinate calculation method is an example, and the coordinates may be calculated in various ways.
[0101] (Effects of the first invention) The effects of the work system 1 shown in Figure 1 are as follows. The work system 1 includes a work machine 20 with a bucket 25c, and a controller 50 (see Figure 3) that automatically drives the work machine 20. The controller 50 causes the work machine 20 to perform loading work and leveling work. The loading work is the work of loading work object A into the container 13 with the bucket 25c. The leveling work is the work of leveling the work object A loaded into the container 13 with the bucket 25c after the loading work is completed.
[0102] [Configuration 1] As shown in Figure 2, the position where bucket 25c is placed at the end of loading work is defined as loading end position Ee. At this time, controller 50 (see Figure 3) causes work machine 20 to start leveling work in the part of container 13 on the loading end position Ee side.
[0103] The above [Configuration 1] makes it possible to reduce the travel distance of the bucket 25c when the work of the automatically operated work machine 20 changes from loading work to leveling work. Therefore, compared to a case where leveling work is not started in the portion on the loading end position Ee side, the work efficiency of the automatically operated work machine 20 can be improved when the work of the automatically operated work machine 20 changes from loading work to leveling work.
[0104] (Effects of the second invention) [Configuration 2] The container 13 has a shape with a longitudinal direction when viewed from the top Z1. The controller 50 causes the work machine 20 to start leveling work on the loading end position Ee side in the longitudinal direction of the container 13 (the container front-rear direction V).
[0105] The above-described [Configuration 2] achieves the following effect. Consider the case where the leveling operation is started not from the loading end position Ee in the container front-rear direction V but from the loading end position Ee side in the container width direction W (the container left region Gw1 or the container right region Gw2). In this case, the movement distance of the bucket 25c from the loading end position Ee to the leveling operation start position Ps (the start position of the leveling operation) can be, at most, approximately the distance from one end to the other end of the container 13 in the container front-rear direction V. On the other hand, if the leveling operation is started from the loading end position Ee side in the container front-rear direction V (the container front region Gv1 or the container rear region Gv2), the following occurs. In this case, the movement distance of the bucket 25c from the loading end position Ee to the leveling operation start position Ps is, at most, approximately within the distance from one end to the other end of the container 13 in the container width direction W or within half the length of the container 13 in the container front-rear direction V. This makes it possible to further reduce the distance that the bucket 25c moves when the automatic operation of the work machine 20 changes from loading work to leveling work, thereby further improving the work efficiency of the automatic operation of the work machine 20.
[0106] (Effect of the third invention) [Configuration 3] The controller 50 (see FIG. 3) causes the work machine 20 to perform leveling work in sequence from the portion of the container 13 on the loading end position Ee side to the portion of the container 13 on the opposite side from the loading end position Ee side.
[0107] The above [Configuration 3] makes it possible to reduce the travel distance of the bucket 25c compared to when leveling work is performed at intermittent positions (discontinuous positions) within the container 13. This makes it possible to further improve the work efficiency of the automatic operation of the work machine 20.
[0108] (Effect of the fourth invention) As the leveling operation, the controller 50 (see FIG. 3) causes the bucket 25c to perform "pushing and leveling" multiple times, pushing the work object A toward the lower side Z2. As shown in FIG. 5, the range in which the bucket 25c pushes and levels the work object A in one "pushing and leveling" operation, as viewed from the upper side Z1, is defined as the pushing and leveling range Q.
[0109] [Configuration 4] The controller 50 (see Figure 3) causes the work machine 20 to perform leveling work while changing the pushing and leveling range Q so that parts of adjacent pushing and leveling ranges Q overlap (so that an overlap portion Ql is created).
[0110] With the above [Configuration 4], even if work object A is pushed out around bucket 25c by pushing and leveling, bucket 25c can level the pushed-out work object A. Therefore, work object A can be leveled more flatly than in the case where the above [Configuration 4] is not provided.
[0111] (Effect of the fifth invention) As shown in Fig. 3, the work system 1 includes a sinking amount detection unit 36. The sinking amount detection unit 36 detects the amount of sinking of the loading platform, which is the container 13 shown in Fig. 6, relative to the ground. The controller 50 (see Fig. 3) causes the bucket 25c to perform "push leveling," which pushes the work object A downward Z2, as the leveling work.
[0112] [Configuration 5] The controller 50 (see Figure 3) causes the bucket 25c to stop pushing and leveling when the amount of sinking of the container 13 (cargo platform) detected by the sinking amount detection unit 36 (see Figure 3) exceeds a predetermined amount (sinking amount threshold). (See pushing and leveling end position Pe.)
[0113] The above [Configuration 5] provides the following effects. When the container 13 (cargo bed) is significantly sunken, it is assumed that the work object A has already been leveled. If the bucket 25c further pushes down the work object A in this state, the work machine 20 will perform unnecessary work, and there is a risk of damage to the vehicle 10, including the container 13. Therefore, the above [Configuration 5] can prevent the bucket 25c from unnecessary pushing of the work object A. This can further improve the work efficiency of the work machine 20. The above [Configuration 5] can also prevent damage to the vehicle 10, including the container 13 (cargo bed).
[0114] (Variation) The above-described embodiment may be modified in various ways. For example, the number of components in the above-described embodiment may be changed, or some of the components may not be provided. For example, the connections of the components shown in FIG. 3 and the like may be changed. For example, what has been described as multiple different components or parts may be combined into a single component or part. For example, what has been described as a single component or part may be provided as multiple different components or parts. Specifically, for example, the components of the controller 50 (such as the work plan setting unit 53 and the automatic driving control unit 57) may be provided separately. For example, various parameters (such as setting values, thresholds, and ranges) may be preset in the controller 50 or may be directly set by an operator through manual operation (e.g., operation of the operation unit 41 or teaching). The various parameters may be calculated by the controller 50 based on information manually set by the operator, or may be calculated by the controller 50 based on information detected by the detection unit 30. For example, the various parameters may be fixed, may be manually changed, or may be automatically changed by the controller 50 in response to certain conditions. For example, some of the steps in the flowchart shown in FIG. 4 may not be performed. For example, each component may have only a part of each feature (function, arrangement, shape, manufacturing method, operation, etc.). [Explanation of symbols]
[0115] 1. Work System 13 Container 20 Work Machinery 25c bucket 36 Subsidence amount detection unit 50 Controllers A. Work object Ee Loading end position Ps Leveling work start position
Claims
1. a work machine having a bucket; a controller that automatically operates the work machine; Equipped with The controller a loading operation of loading a work object into a container using the bucket; a leveling operation of leveling the work objects loaded into the container with the bucket after the loading operation is completed; causing the work machine to perform the above; When the position where the bucket is placed at the end of the loading operation is defined as a loading end position, the controller causes the work machine to start the leveling operation in a loading end position area that is an area that includes the loading end position when the internal area of the container as viewed from above is divided into predetermined areas, The controller causes the bucket to perform a pushing and leveling operation to push the work object downward as the leveling operation. Working system.
2. The work system according to claim 1, The controller causes the bucket to perform the pushing and leveling process a plurality of times, When the range in which the bucket presses and levels the work object in one pressing and leveling operation as viewed from above is defined as the pressing and leveling range, the controller causes the work machine to perform the leveling work while changing the pushing and leveling ranges so that parts of adjacent pushing and leveling ranges overlap with each other. Working system.
3. 3. The work system according to claim 1 or 2, a sinking amount detection unit that detects the amount of sinking of the container bed relative to the ground, the controller causes the bucket to stop the pushing and leveling when the sinking amount of the loading platform detected by the sinking amount detection unit exceeds a predetermined amount. Working system.
4. a work machine having a bucket; a controller that automatically operates the work machine; Equipped with The controller a loading operation of loading a work object into a container using the bucket; a leveling operation of leveling the work objects loaded into the container with the bucket after the loading operation is completed; causing the work machine to perform the above; A loading operation completion condition, which is a condition for causing the work machine to complete the loading operation, is set in the controller, the loading operation termination condition includes at least one of the following: the number of times that loading from the bucket into the container has been performed during the loading operation has reached a predetermined number threshold; and the mass of the work object loaded into the container has reached a predetermined cumulative loaded mass threshold. When the position where the bucket is placed at the end of the loading operation is defined as a loading end position, the controller causes the work machine to start the leveling operation in a loading end position area that is an area including the loading end position when the internal area of the container as viewed from above is divided into predetermined areas. Working system.
5. The work system according to any one of claims 1 to 4, The container has a shape having a longitudinal direction when viewed from above, The loading end position area is an area that includes the loading end position when the internal area of the container as viewed from above is divided into predetermined areas in the longitudinal direction of the container. Working system.
6. The work system according to any one of claims 1 to 5, the controller causes the work machine to perform the leveling operation sequentially from the loading end position area to an area in the interior area of the container that is different from the loading end position area. Working system.
Citation Information
Patent Citations
Autonomous excavation and truck loading system
JP2000136549A
Load measurement system of work machine
JP2019056246A
shovel
JP2021025258A
Image display device for backhoe
WO2013099491A1
Shovel
WO2019049701A1