Trajectory Generation System

Abstract

To provide a trajectory generation system capable of suppressing an action of an attachment from giving workers around a working machine a sense of unease when correcting a target trajectory of the attachment.SOLUTION: A target trajectory correction unit 43 sets a post-correction target trajectory TRb obtained by omission target points P between an omission start point Ps and an omission end point Pe from a plurality of target points P on a pre-correction target trajectory TRa. The target trajectory correction unit 43 sets the post-correction target trajectory TRb from the omission start point Ps to the omission end point Pe on the basis of at least one of a movement distance and a movement time required for a specific part 15e to reach the omission end point Pe.SELECTED DRAWING: Figure 3

Description

[Technical field]

[0001] The present invention relates to a trajectory generation system that generates a target trajectory for an attachment of a work machine. [Background technology]

[0002] For example, Patent Document 1 describes a technique for correcting a target point (in Patent Document 1, the release position) of an attachment of a work machine. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2000-64359 A Summary of the Invention [Problem to be solved by the invention]

[0004] The document describes correcting the position of one target point (the soil-releasing position in the document) in a series of operations of the attachment. However, the document does not describe how a series of operations of the attachment other than the target point is performed when the target point is corrected. Therefore, there is a risk that the operation of the attachment after the target point is corrected will cause uneasiness to workers around the work machine.

[0005] Therefore, an object of the present invention is to provide a trajectory generation system that can prevent the operation of the attachment from causing anxiety to workers around the work machine when the target trajectory of the attachment is corrected. [Means for solving the problem]

[0006] The trajectory generation system includes a machine body of a work machine, an attachment, a target trajectory setting unit, and a target trajectory correction unit. The attachment is attached to the machine body and performs work. The target trajectory setting unit sets a pre-correction target trajectory that is a target trajectory of a specific part of the attachment. The target trajectory correction unit corrects the pre-correction target trajectory. The target trajectory correction unit sets two points of a plurality of target points on the pre-correction target trajectory as an omitted start point and an omitted end point. The target trajectory correction unit sets a corrected target trajectory in which the target points between the omitted start point and the omitted end point are omitted from the plurality of target points on the pre-correction target trajectory. The target trajectory correction unit sets the corrected target trajectory from the omitted start point to the omitted end point based on at least one of a moving distance and a moving time of the specific part from the omitted start point to the omitted end point on the pre-correction target trajectory. Effect of the Invention

[0007] With the above configuration, when correcting the target trajectory of the attachment, it is possible to prevent the operation of the attachment from causing anxiety to workers around the work machine. [Brief description of the drawings]

[0008] [Figure 1] FIG. 2 is a side view of the work machine 10 and other components of the trajectory generation system 1. [Diagram 2] FIG. 1 is a block diagram of a trajectory generation system 1. [Diagram 3] 2 is a diagram showing a target trajectory TR of a specific portion 15e of the attachment 15 shown in FIG. [Figure 4] 4 is a diagram showing a target trajectory TR when the bucket 15d1 shown in FIG. 3 is used for excavation. FIG. [Diagram 5] 2 is a diagram showing the working machine 10 shown in FIG. 1 as viewed from above, illustrating a target trajectory TR of a specific portion 15e when an upper rotating body 13 rotates. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0009] The trajectory generation system 1 will be described with reference to FIGS.

[0010] The trajectory generation system 1 is a system that generates a target trajectory TR (see FIG. 3) for a specific part 15e of an attachment 15 of a work machine 10 shown in FIG 1. The trajectory generation system 1 includes the work machine 10, an attitude sensor 21, a situation detection unit 23 (see FIG. 2), a communication device 25, a mobile terminal 30, and a controller 40.

[0011] The work machine 10 is a machine that performs work, such as a construction machine that performs construction work, such as a shovel. The work machine 10 is configured so as to be automatically operated by a controller 40. The work machine 10 includes a machine body 10a, an attachment 15, an actuator 17, and a drive control unit 19 (see FIG. 2).

[0012] The machine body 10a is the main body of the work machine 10. The machine body 10a includes a lower traveling body 11 and an upper rotating body 13. The lower traveling body 11 allows the work machine 10 to travel. The lower traveling body 11 includes, for example, crawlers. The upper rotating body 13 is mounted on the lower traveling body 11 so as to be rotatable.

[0013] The attachment 15 is a part that performs work, and is attached to the machine body 10a (more specifically, the upper rotating body 13). The attachment 15 includes, for example, a boom 15b, an arm 15c, and a tip attachment 15d. The boom 15b is attached to the upper rotating body 13 so as to be able to rise and fall (to be able to rotate up and down). The arm 15c is attached rotatably to the boom 15b. The tip attachment 15d is provided at the tip of the attachment 15, and is attached rotatably to the arm 15c. The tip attachment 15d may be, for example, a bucket 15d1 that excavates (scoops up) soil, a device that holds objects (such as a grapple), or a device that crushes, excavates, or the like (such as a breaker). A specific part of the attachment 15 is referred to as a specific part 15e. The specific part 15e is a part that is moved along a target trajectory TR (see FIG. 3). In the example shown in Figures 1, 3, and 5, the specific portion 15e is the tip of the tip attachment 15d (more specifically, bucket 15d1), and in the example shown in Figure 4, it is the base end of the bucket 15d1 (the connection portion between the arm 15c and the tip attachment 15d shown in Figure 1).

[0014] The actuator 17 operates the work machine 10. The actuator 17 includes a swing motor 17a, a boom cylinder 17b, an arm cylinder 17c, and a tip attachment cylinder 17d. The swing motor 17a swings the upper swing body 13 relative to the lower traveling body 11. The swing motor 17a may be a hydraulic motor or an electric motor. The boom cylinder 17b raises and lowers the boom 15b relative to the upper swing body 13. The boom cylinder 17b is, for example, a hydraulic telescopic cylinder (hydraulic cylinder) (the same applies to the arm cylinder 17c and the tip attachment cylinder 17d). The arm cylinder 17c rotates the arm 15c relative to the boom 15b. The tip attachment cylinder 17d rotates the tip attachment 15d relative to the arm 15c. In addition, when the end attachment 15d itself is drivable, for example as a device for clamping an object, a cylinder or a motor for driving the end attachment 15d may be provided.

[0015] The drive control unit 19 (see FIG. 2) controls the actuator 17. The drive control unit 19 may include a hydraulic circuit or an electric circuit.

[0016] The attitude sensor 21 detects the attitude of the work machine 10. The attitude sensor 21 may include a sensor that detects an angle (e.g., a rotary encoder, etc.), may include a sensor that detects an inclination relative to a horizontal plane, or may include a sensor that detects the stroke of a hydraulic cylinder that drives the attachment 15. The attitude sensor 21 may detect the attitude of the work machine 10 based on at least one of a two-dimensional image and a distance image. In this case, the two-dimensional image or the distance image may be captured by an imaging device 23b (see FIG. 2, described later). The attitude sensor 21 may be mounted on the work machine 10, or may be disposed outside the work machine 10 (e.g., at a work site) (the same applies to the situation detection unit 23, the communication device 25, and the controller 40). For example, the attitude sensor 21 includes a swing angle sensor 21a, a boom angle sensor 21b, an arm angle sensor 21c, a tip attachment angle sensor 21d, and a reference position sensor 21e.

[0017] The slewing angle sensor 21a detects the slewing angle of the upper slewing body 13 relative to the lower traveling body 11. The boom angle sensor 21b detects the rotation angle of the boom 15b relative to the upper slewing body 13. The arm angle sensor 21c detects the rotation angle of the arm 15c relative to the boom 15b. The tip attachment angle sensor 21d detects the rotation angle of the tip attachment 15d relative to the arm 15c. The reference position sensor 21e detects the position and orientation of the work machine 10 relative to the work site. The reference position sensor 21e may perform detection by a positioning system. The positioning system may be a satellite positioning system, for example, a global navigation satellite system (GNSS). In this case, the reference position sensor 21e may include a GNSS antenna 21e1, etc. The positioning system may be one using a total station, etc.

[0018] The situation detection unit 23 (see FIG. 2) (bucket situation detection unit) detects the situation of the work machine 10. The situation detection unit 23 may detect the situation of the work machine 10 itself (machine situation, work situation, etc.), or may detect the situation around the work machine 10. For example, as shown in FIG. 2, the situation detection unit 23 includes a load detection unit 23a and an imaging device 23b.

[0019] The load detection unit 23a detects a load acting on the work machine 10 shown in FIG. 1. The load detection unit 23a (see FIG. 2) may detect a load acting on the attachment 15. The load detection unit 23a may detect a load acting on the actuator 17. The load detection unit 23a may detect a load acting on the attachment 15 by detecting a load acting on the actuator 17. Specifically, for example, the load detection unit 23a may detect a load acting on the tip attachment 15d (e.g., bucket 15d1). For example, the load detection unit 23a may detect a load (e.g., hydraulic pressure) acting on the tip attachment cylinder 17d (e.g., bucket cylinder).

[0020] The imaging device 23b (see FIG. 2) captures an image of an object to be imaged. The above-mentioned "image-captured object" may be the work machine 10 or an object in the vicinity of the work machine 10. The imaging device 23b may detect two-dimensional information (e.g., position, shape) of the image-captured object. The imaging device 23b may detect three-dimensional information of the image-captured object, and may obtain an image (distance image) having distance information (depth information). The imaging device 23b may detect three-dimensional information of the image-captured object based on the distance image and the two-dimensional image. The imaging device 23b may be equipped with a camera (monocular camera) that detects two-dimensional information. The imaging device 23b may be equipped with a device that detects three-dimensional information using laser light, and may be equipped with, for example, a LIDAR (Light Detection and Ranging), or may be equipped with, for example, a TOF (Time Of Flight) sensor. The imaging device 23b may be equipped with a device that detects three-dimensional information using radio waves (e.g., a millimeter wave radar, etc.). The imaging device 23b may be equipped with a stereo camera. Specifically, for example, when the end attachment 15d is a bucket 15d1, the imaging device 23b may detect the amount of soil in the bucket 15d1.

[0021] The communication device 25 performs communication. For example, the communication device 25 may perform communication between the controller 40 and the mobile terminal 30. For example, the communication device 25 may perform communication between the controllers 40 arranged outside and inside the work machine 10. The communication by the communication device 25 may include at least any one of wireless communication, wired communication, and optical communication.

[0022] The mobile terminal 30 is a device (computer) used by a worker. The mobile terminal 30 may be, for example, a tablet or a smartphone. As shown in FIG. 2, the mobile terminal 30 includes an operation unit 31 and a display unit 33.

[0023] The operation unit 31 is operated by an operator. For example, an operation for making settings related to automatic operation of the work machine 10 (see FIG. 1) may be performed on the operation unit 31. An operation for setting a target trajectory TR (see FIG. 3, described later) and issuing correction instructions may be performed on the operation unit 31.

[0024] The display unit 33 performs display. The display unit 33 displays information related to the target trajectory TR (see FIG. 3). For example, the display unit 33 performs display related to the corrected target trajectory TRb (see FIG. 3) (described later). Note that the device in which the display unit 33 is provided (e.g., the mobile terminal 30) and the device in which the operation unit 31 is provided may be integrated or separate.

[0025] The controller 40 is a computer that performs input and output of signals, calculations (processing), storage of information, etc. For example, the functions of the controller 40 are realized by executing a program stored in the storage unit of the controller 40 in the calculation unit. For example, the controller 40 acquires information on the attitude of the work machine 10 (see FIG. 1) detected by the attitude sensor 21. For example, the controller 40 controls the drive control unit 19 to perform automatic operation of the work machine 10. The controller 40 sets and corrects the target trajectory TR (see FIG. 3). The controller 40 may be provided separately from the mobile terminal 30, or may be provided in the mobile terminal 30. The controller 40 includes a target trajectory setting unit 41, a target trajectory correction unit 43, and an operation control unit 45.

[0026] The target trajectory setting unit 41 sets a target trajectory TR shown in FIG. 3. As described later, the target trajectory TR is corrected, and the target trajectory setting unit 41 (see FIG. 2) sets a pre-correction target trajectory TRa, which is the target trajectory TR before correction. The target trajectory TR is a trajectory targeted for the specific part 15e. More specifically, an ordered set of a plurality of target points P (e.g., three-dimensional coordinates) of the specific part 15e of the attachment 15 is called a "target route." In the example shown in FIG. 3, each position and order from the target point P1 to the target point P12 is the target route. The target route to which a time parameter is added is called a target trajectory TR. Specifically, this "time parameter" is, for example, the movement time (time between two points) of the specific part 15e between two target points P that are consecutive in order.

[0027] This target trajectory setting unit 41 (see FIG. 2) may set the pre-correction target trajectory TRa based on teaching, or may set the pre-correction target trajectory TRa based on a method other than teaching (for example, input of coordinates by the operation unit 31 (see FIG. 2)). The above-mentioned "teaching" is performed as follows. An operator gets on the work machine 10 shown in FIG. 1 and operates the work machine 10, or remotely operates the work machine 10. The operator then operates the work machine 10 to move the specific portion 15e along a target route that is desired to be set as the target trajectory TR shown in FIG. 3 at a speed at which a time parameter that is desired to be set as the target trajectory TR is set. The target trajectory setting unit 41 (see FIG. 2) then sets the trajectory along which the specific portion 15e has moved as the pre-correction target trajectory TRa.

[0028] The target trajectory correction unit 43 (see FIG. 2) corrects the pre-correction target trajectory TRa. The target trajectory correction unit 43 sets a post-correction target trajectory TRb by omitting some of the target points P of the pre-correction target trajectory TRa (details will be described later).

[0029] The operation control unit 45 (see FIG. 2) automatically drives the work machine 10 (see FIG. 1). The operation control unit 45 (see FIG. 2) controls the work machine 10 so that the specific part 15e of the attachment 15 moves according to the target trajectory TR. More specifically, the operation control unit 45 (see FIG. 2) controls the work machine 10 (see FIG. 1) so that the specific part 15e moves according to the target route (coordinates and order of each target point P) set as the target trajectory TR and time parameters (e.g., travel time between each target point P). The operation control unit 45 (see FIG. 2) controls the operation (posture) of the work machine 10 by outputting commands to the drive control unit 19 (see FIG. 2).

[0030] (Timing for correcting the target trajectory TR) The target trajectory correction unit 43 shown in FIG. 2 may correct the target trajectory TR (see FIG. 3) based on the judgment of the controller 40 (automatically). For example, the target trajectory correction unit 43 may correct the target trajectory TR based on the detection result of the situation detection unit 23 input to the controller 40. More specifically, the target trajectory correction unit 43 may correct the target trajectory TR (see FIG. 3) based on at least one of the situation of the work machine 10 (see FIG. 1) itself and the situation around the work machine 10 (specific examples will be described later). The target trajectory correction unit 43 may correct the target trajectory TR when there is a command (input) other than from the controller 40. For example, the target trajectory correction unit 43 may correct the target trajectory TR in response to manual operation of the operation unit 31 by the operator (for example, tablet operation).

[0031] (Correction contents of target trajectory TR) The outline of the correction of the target trajectory TR (more specifically, the pre-correction target trajectory TRa) shown in FIG. 3 by the target trajectory correction unit 43 is as follows. The target trajectory correction unit 43 will be described below with reference to FIG. 2. The target trajectory correction unit 43 sets a target path of the post-correction target trajectory TRb by omitting some of the multiple target points P of the pre-correction target trajectory TRa shown in FIG. 3. Then, the target trajectory correction unit 43 determines the time parameters of the post-correction target trajectory TRb based on the information of the pre-correction target trajectory TRa (taking the pre-correction target trajectory TRa into consideration). The details of the correction of the target trajectory TR by the target trajectory correction unit 43 are as follows.

[0032] (Setting the target route) The target trajectory correction unit 43 sets two points (two different points) of the multiple target points P on the pre-correction target trajectory TRa as an omitted start point Ps and an omitted end point Pe. The omitted end point Pe is placed after the omitted start point Ps. Then, the target trajectory correction unit 43 sets a corrected target trajectory TRb by omitting the target points P between the omitted start point Ps and the omitted end point Pe (target points P5 to P10 in the example shown in FIG. 3) from the multiple target points P on the pre-correction target trajectory TRa. How the omitted start point Ps and the omitted end point Pe are determined will be described later.

[0033] (Setting time parameters) The target trajectory correction unit 43 sets the corrected target trajectory TRb so that the sense of speed felt by the worker when the specific part 15e moves according to the pre-correction target trajectory TRa is approximately the same as when the specific part 15e moves according to the corrected target trajectory TRb. This prevents the worker from feeling uneasy when the specific part 15e moves according to the corrected target trajectory TRb. For example, the attachment 15 is prevented from moving suddenly when the specific part 15e moves according to the corrected target trajectory TRb.

[0034] Specifically, the target trajectory correction unit 43 sets a corrected target trajectory TRb from the skipped start point Ps to the skipped end point Pe based on at least one of the moving distance and moving time of the specific part 15e from the skipped start point Ps to the skipped end point Pe in the pre-correction target trajectory TRa. More specifically, the target trajectory correction unit 43 sets a corrected target trajectory TRb (hereinafter also referred to as a post-correction target trajectory TRnew) from the skipped start point Ps to the skipped end point Pe as in the following setting examples 1 and 2.

[0035] (Example 1) The target trajectory correction unit 43 may set the post-abstract target trajectory TRnew (post-correction target trajectory TRb) so that the movement time of the specific part 15e from the omitted start point Ps to the omitted end point Pe is equal before and after the correction. In this case, the target trajectory correction unit 43 sets the post-abstract target trajectory TRnew so that the following post-correction movement time Tnew is equal to the pre-correction movement time T. The post-correction movement time Tnew is the movement time of the specific part 15e from the omitted start point Ps to the omitted end point Pe in the post-correction target trajectory TRb (i.e., in the post-abstract target trajectory TRnew). The pre-correction movement time T is the movement time of the specific part 15e from the omitted start point Ps to the omitted end point Pe in the pre-correction target trajectory TRa. In this case, since the pre-correction movement time T and the post-correction movement time Tnew are equal, the sense of speed felt by the operator when the specific part 15e moves from the omitted start point Ps to the omitted end point Pe is about the same before and after the correction. This prevents the worker from feeling uneasy when he or she sees the specific portion 15e moving along the corrected target trajectory TRb.

[0036] 3, the target point P4 is the skipped start point Ps, and the target point P11 is the skipped end point Pe. In this example, the pre-correction moving time T is 7 seconds. At this time, the target trajectory correction unit 43 sets the post-abstract target trajectory TRnew so that the post-correction moving time Tnew is 7 seconds.

[0037] (Example 2) The target trajectory correction unit 43 may set the post-abbreviation target trajectory TRnew so that the average speed (average value of the magnitude of the moving speed) of the specific part 15e from the omit start point Ps to the omit end point Pe is equal before and after the correction. In this case, the target trajectory correction unit 43 sets the post-abbreviation target trajectory TRnew so that the following post-abbreviation average speed Vnew is equal to the pre-abbreviation average speed V. The pre-abbreviation average speed V is the average speed of the specific part 15e from the omit start point Ps to the omit end point Pe in the pre-abbreviation target trajectory TRa. The post-abbreviation average speed Vnew is the average speed of the specific part 15e from the omit start point Ps to the omit end point Pe in the post-abbreviation target trajectory TRb (i.e., in the post-abbreviation target trajectory TRnew). In this case, since the pre-abbreviation average speed V and the post-abbreviation average speed Vnew are equal, the sense of speed felt by the operator when the specific part 15e moves from the omit start point Ps to the omit end point Pe is about the same before and after the correction. Therefore, the worker is prevented from feeling uneasy when he sees the specific part 15e moving along the corrected target trajectory TRb. Also, the time taken for the specific part 15e to move from the omitted start point Ps to the omitted end point Pe is shorter after the correction than before the correction. Therefore, the attachment 15 can be moved efficiently, and the work efficiency by the attachment 15 is improved.

[0038] Specifically, for example, in the example shown in FIG. 3, the pre-correction moving time T is 7 seconds. Also, the moving distance along the target route from the target point P4 to the target point P11 of the pre-correction target trajectory TRa is L (L4+L5+...+L9+L10 shown in FIG. 3). At this time, the pre-correction average speed V is expressed as V=L / T. When T is 7 seconds, V=L / 7. Also, the moving distance (straight-line distance) from the target point P4 to the target point P11 of the post-correction target trajectory TRb (i.e., the omitted target trajectory TRnew) is Lnew. At this time, the post-correction average speed Vnew is Vnew=Lnew / Tnew. Since the post-correction average speed Vnew and the pre-correction average speed V are equal (because L / T=Lnew / Tnew), the post-correction moving time Tnew is expressed as Tnew=T×Lnew / L. When T is 7 seconds, Tnew=7×Lnew / L.

[0039] The target trajectory correction unit 43 may set the corrected target trajectory TRb in various ways. For example, the target trajectory correction unit 43 may set the corrected target trajectory TRb based on both the pre-correction moving time T and the pre-correction average speed V. The target trajectory correction unit 43 may set the corrected target trajectory TRb based on a value obtained by adding, subtracting, multiplying, or dividing the pre-correction moving time T or the pre-correction average speed V by a correction value.

[0040] (Example of setting the omitted start point Ps and the omitted end point Pe) The target trajectory correction unit 43 sets the skip start point Ps and the skip end point Pe, for example, as follows.

[0041] (Example 3) The target trajectory correction unit 43 may set at least one of the skipped start point Ps and the skipped end point Pe based on the status (machine status, work status, etc.) of the work machine 10 (see FIG. 1) itself detected by the status detection unit 23 (see FIG. 2). A specific example of this case is as follows.

[0042] (Example of setting example 3: omission of excavation operation) For example, as shown in FIG. 4, when the bucket 15d1 performs an operation of digging soil (digging operation), some of the target points P of the pre-correction target trajectory TRa may be omitted.

[0043] (Example of setting the omission start point Ps) The target trajectory correction unit 43 may set the position of the specific part 15e when the amount of soil in the bucket 15d1 exceeds a predetermined soil amount threshold (condition A) as the skip start point Ps. The target trajectory correction unit 43 may set the position of the specific part 15e when the load acting on the bucket 15d1 exceeds a predetermined load threshold (condition B) as the skip start point Ps. By setting the position of the specific part 15e when the above condition A is satisfied as the skip start point Ps, the bucket 15d1 is prevented from excavating too much soil, and the efficiency of the excavation work can be improved (similar to condition B). If the bucket 15d1 excavates too much soil, soil may not enter the bucket 15d1 even if the bucket 15d1 performs an excavation operation, and the excavation operation may become a wasteful movement. Also, if the bucket 15d1 excavates too much soil, soil may fall from the bucket 15d1, resulting in a wasteful movement of the excavation operation. The amount of soil in the bucket 15d1 and the load acting on the bucket 15d1 are detected by the above-mentioned condition detection unit 23 (see FIG. 2). The condition detection unit 23 may detect only one of the amount of soil in the bucket 15d1 and the load acting on the bucket 15d1. In the example shown in FIG. 4, the specific portion 15e is the base end portion of the bucket 15d1.

[0044] (Example of setting the omitted end point Pe) The target trajectory correction unit 43 sets the end point of the excavation operation by the bucket 15d1 as the omitted end point Pe. This excavation operation includes an operation in which the bucket 15d1 rotates toward the upper rotating body 13 side (excavation side) with respect to the arm 15c (see FIG. 1) while the tip of the bucket 15d1 moves downward toward the ground (below the ground surface G) and toward the upper rotating body 13 (see FIG. 1). This excavation operation may also include an operation in which the bucket 15d1, which has excavated the soil, moves (lifts) above the ground surface G in a posture (angle) capable of holding the soil. The end point of such a series of excavation operations by the bucket 15d1 is set as the omitted end point Pe. The operation next to the end of the excavation operation by the bucket 15d1 is, for example, an operation (lifting and rotating) including the rotation of the upper rotating body 13 (see FIG. 1). Note that a point before the end point of the series of excavation operations by the bucket 15d1 may be set as the omitted end point Pe.

[0045] (Example 4) The target trajectory correction unit 43 may set at least one of the skipped start point Ps and the skipped end point Pe based on the situation around the work machine 10 (see FIG. 1) detected by the situation detection unit 23 (see FIG. 2). A specific example of this case is as follows.

[0046] (Example of setting 4: Omission of turning motion) 5, when the upper rotating body 13 performs an operation of rotating (rotating operation) relative to the lower traveling body 11, a part of the target point P of the pre-correction target trajectory TRa may be omitted. The target trajectory correction unit 43 omits the path of the pre-correction target trajectory TRa and sets the corrected target trajectory TRb so that the specific portion 15e follows a path that is shorter than before the correction (so as not to take a detour). In this example, the target trajectory correction unit 43 sets the omitted start point Ps and the omitted end point Pe as follows.

[0047] For example, when the specific part 15e moves according to the pre-correction target trajectory TRa, it is assumed that the attachment 15 may enter an intrusion-prohibited area. In this case, the target trajectory correction unit 43 sets a skip start point Ps and a skip end point Pe so that the attachment 15 does not enter the intrusion-prohibited area. The above-mentioned "intrusion-prohibited area" is, for example, an area where an obstacle (terrain, a vehicle such as a dump truck, etc.) exists.

[0048] (Example 5) The target trajectory correction unit 43 may set at least one of the skip start point Ps and the skip end point Pe based on information specified by the operation unit 31 (see FIG. 2). More specifically, the operator specifies a target point P to be set as the skip start point Ps from among the target points P of the pre-correction target trajectory TRa by the operation unit 31. Then, the target trajectory correction unit 43 may set the target point P specified by the operation unit 31 as the skip start point Ps. The same applies to the skip end point Pe.

[0049] (display) The display unit 33 (see FIG. 2) displays information on the corrected target trajectory TRb set by the target trajectory correction unit 43. Specifically, for example, the display unit 33 may display a figure (for example, see FIGS. 3 to 5) representing the corrected target trajectory TRb. The display unit 33 may display a moving image showing how the attachment 15 including the specific part 15e moves according to the corrected target trajectory TRb.

[0050] (Effects of the first invention) As shown in Fig. 1, the trajectory generation system 1 includes a machine body 10a of a work machine 10, an attachment 15, a target trajectory setting unit 41 (see Fig. 2), and a target trajectory correction unit 43 (see Fig. 2). The attachment 15 is attached to the machine body 10a and performs work. The target trajectory setting unit 41 (see Fig. 2) sets a pre-correction target trajectory TRa (see Fig. 3), which is a target trajectory for a specific portion 15e of the attachment 15. The target trajectory correction unit 43 (see Fig. 2) corrects the pre-correction target trajectory TRa (see Fig. 3).

[0051] [Configuration 1] The target trajectory correction unit 43 (see FIG. 2) sets two points of the multiple target points P on the pre-correction target trajectory TRa shown in FIG. 3 as an omitted start point Ps and an omitted end point Pe. The target trajectory correction unit 43 (see FIG. 2) sets a corrected target trajectory TRb by omitting the target points P between the omitted start point Ps and the omitted end point Pe from the multiple target points P on the pre-correction target trajectory TRa. The target trajectory correction unit 43 sets the corrected target trajectory TRb from the omitted start point Ps to the omitted end point Pe based on at least one of the moving distance and moving time of the specific part 15e from the omitted start point Ps to the omitted end point Pe on the pre-correction target trajectory TRa.

[0052] The above [Configuration 1] provides the following effects. A corrected target trajectory TRb (target trajectory TRnew) from the omitted start point Ps to the omitted end point Pe is set, taking into consideration at least one of the moving distance and moving time of the specific part 15e from the omitted start point Ps to the omitted end point Pe in the pre-correction target trajectory TRa. Thus, compared to a case in which neither the moving distance nor the moving time of the specific part 15e from the omitted start point Ps to the omitted end point Pe in the pre-correction target trajectory TRa is taken into consideration, the following effects are provided. The corrected target trajectory TRb can be set so that the movement of the specific part 15e moving according to the corrected target trajectory TRb is close to the movement of the specific part 15e moving according to the pre-correction target trajectory TRa. Thus, the corrected target trajectory TRb can be set so that the sense of speed felt by the operator when the specific part 15e moves from the omitted start point Ps to the omitted end point Pe is approximately the same before and after the correction of the target trajectory TR. As a result, when correcting the target trajectory TR of the attachment 15, the trajectory generation system 1 (see FIG. 1) can suppress the movement of the attachment 15 from causing anxiety to the workers around the work machine 10.

[0053] (Effects of the second invention) [Configuration 2] The target trajectory correction unit 43 (see FIG. 2) sets the corrected target trajectory TRb shown in FIG. 3 so that the corrected moving time Tnew described below is equal to the pre-correction moving time T. The corrected moving time Tnew is the moving time of the specific part 15e (in the pre-correction target trajectory TRnew) from the omitted start point Ps to the omitted end point Pe in the pre-correction target trajectory TRb. The pre-correction moving time T is the moving time of the specific part 15e from the omitted start point Ps to the omitted end point Pe in the pre-correction target trajectory TRa.

[0054] By the above [Configuration 2], the sense of speed felt by the operator when the specific part 15e moves from the omitted start point Ps to the omitted end point Pe can be made to be approximately the same before and after the correction of the target trajectory TR. Therefore, the trajectory generation system 1 shown in Fig. 1 can suppress a sense of anxiety felt by the operator around the work machine 10.

[0055] (Effects of the third invention) [Configuration 3] The target trajectory correction unit 43 (see FIG. 2) sets the corrected target trajectory TRb shown in FIG. 3 so that the corrected average speed Vnew described below is equal to the pre-correction average speed V. The corrected average speed Vnew is the average speed of the specific portion 15e (in the pre-correction target trajectory TRnew) from the omitted start point Ps to the omitted end point Pe in the corrected target trajectory TRb. The pre-correction average speed V is the average speed of the specific portion 15e from the omitted start point Ps to the omitted end point Pe in the pre-correction target trajectory TRa.

[0056] By the above [Configuration 3], the sense of speed felt by the operator when the specific part 15e moves from the omitted start point Ps to the omitted end point Pe can be made to be approximately the same before and after the correction of the target trajectory TR. Therefore, the trajectory generation system 1 shown in FIG. 1 can suppress a sense of unease felt by the operator around the work machine 10. In addition, the movement time of the specific part 15e from the omitted start point Ps to the omitted end point Pe shown in FIG. 3 can be made shorter on the corrected target trajectory TRb than on the pre-correction target trajectory TRa. Therefore, the specific part 15e (the attachment 15) can be moved efficiently, and the work efficiency by the attachment 15 can be improved.

[0057] (Effect of the fourth invention) The trajectory generation system 1 (see FIG. 1) includes a bucket 15d1 shown in FIG. 4 and a situation detection unit 23 (bucket situation detection unit) (see FIG. 2). The bucket 15d1 constitutes the attachment 15 and excavates soil. The situation detection unit 23 (see FIG. 2) detects a situation related to the bucket 15d1.

[0058] [Configuration 4] The target trajectory correction unit 43 (see FIG. 2) sets the position of the specific portion 15e when at least one of the following conditions [Condition 4A] and [Condition 4B] is satisfied as the skip start point Ps. [Condition 4A] The situation detection unit 23 (see FIG. 2) detects that the amount of soil in the bucket 15d1 has exceeded a predetermined soil amount threshold. [Condition 4B] The situation detection unit 23 (see FIG. 2) detects that the load acting on the bucket 15d1 has exceeded a predetermined load threshold.

[0059] The above [Configuration 4] can prevent the bucket 15d1 from digging too much soil. Note that the above [Configuration 4] includes the situation detection unit 23 detecting only one of the amount of soil in the bucket 15d1 and the load acting on the bucket 15d1, and the target trajectory correction unit 43 determining only one of [Condition 4A] and [Condition 4B].

[0060] (Effect of the fifth aspect of the invention) [Configuration 5] As shown in FIG. 2, the trajectory generation system 1 includes a display unit 33 that displays information on the corrected target trajectory TRb (see FIG. 3) set by the target trajectory correction unit 43.

[0061] With the above [Configuration 5], it is possible to inform an operator viewing the display on the display unit 33 (see FIG. 2) of information on the corrected target trajectory TRb without actually moving the specific part 15e according to the corrected target trajectory TRb shown in FIG. 3 (in advance).

[0062] (Modification) The above embodiment may be modified in various ways. For example, the connections of the components shown in FIG. 2 and the like may be changed. For example, the values ​​of thresholds (e.g., soil volume threshold, load threshold) may be constant, may be changed by manual operation, or may be automatically changed according to some conditions. For example, the number of components may be changed, or some of the components may not be provided. For example, the components may be fixed or connected directly or indirectly. For example, what has been described as multiple different members or parts may be treated as one member or part. For example, what has been described as one member or part may be provided as multiple different members or parts. For example, each component may have only a part of each feature (function, arrangement, shape, operation, etc.). [Explanation of symbols]

[0063] 1 Trajectory Generation System 10. Working Machinery 10a Machine body 15 Attachment 15d1 Bucket 15e Specific parts 23 Status detection unit (bucket status detection unit) 33 Display section 41 Target trajectory setting section 43 Target trajectory correction section P target point Pe omission end point Ps omitted starting point TRa target trajectory before correction TRb corrected target trajectory

Claims

1. A machine body of a work machine; An attachment that is attached to the machine body and performs work; a target trajectory setting unit that sets a pre-correction target trajectory, which is a target trajectory of a specific portion of the attachment; a target trajectory correction unit that corrects the pre-correction target trajectory; Equipped with The target trajectory correction unit Two points among the plurality of target points on the pre-correction target trajectory are set as an omitted start point and an omitted end point; A corrected target trajectory is set by omitting the target points between the omitted start point and the omitted end point from the plurality of target points on the pre-correction target trajectory; setting the corrected target trajectory from the omitted start point to the omitted end point based on at least one of a moving time and an average speed of the specific part from the omitted start point to the omitted end point on the pre-correction target trajectory; Trajectory generation system.

2. 2. The trajectory generation system according to claim 1, the target trajectory correction unit sets the corrected target trajectory such that a moving time of the specific part from the omitted start point to the omitted end point on the corrected target trajectory is equal to a moving time of the specific part from the omitted start point to the omitted end point on the pre-correction target trajectory. Trajectory generation system.

3. 2. The trajectory generation system according to claim 1, the target trajectory correction unit sets the corrected target trajectory such that an average speed of the specific part from the omitted start point to the omitted end point on the corrected target trajectory is equal to an average speed of the specific part from the omitted start point to the omitted end point on the pre-correction target trajectory. Trajectory generation system.

4. The trajectory generation system according to any one of claims 1 to 3, A bucket constituting the attachment and excavating soil; a bucket status detection unit that detects a status related to the bucket; Equipped with the target trajectory correction unit sets, as the omission start point, the position of the specific portion when at least one of the following conditions is satisfied: the bucket status detection unit detects that the amount of soil in the bucket has exceeded a predetermined soil volume threshold; and the bucket status detection unit detects that the load acting on the bucket has exceeded a predetermined load threshold. Trajectory generation system.

5. The trajectory generation system according to any one of claims 1 to 4, a display unit that displays information on the corrected target trajectory set by the target trajectory correction unit, Trajectory generation system.

Images