The present invention relates to a trajectory generating system that generates a target trajectory of an attachment of a work machine and a work machine including the same.
For example, Patent Literature 1 discloses a technique that corrects a target point (soil release position) of an attachment of a work machine.
An object of the present invention is to provide a trajectory generating system that can prevent a movement of an attachment from giving a feeling of anxiety to a worker around a work machine in a case where a target trajectory of the attachment is corrected, and the work machine including the system.
The present invention provides a trajectory generating system. The trajectory generating system is used in the work machine including a machine body and an attachment. The trajectory generating system includes a target trajectory setting unit and a target trajectory correcting unit. The attachment is mounted on the machine body. The target trajectory setting unit sets a reference target trajectory that is a target for a movement of a specific portion of the attachment, the reference target trajectory including a reference target path including a plurality of target points and time information that is information about a time for the movement of the specific portion along the plurality of target points. The target trajectory correcting unit corrects the reference target trajectory. In a case where a predetermined path correcting condition is satisfied, the target trajectory correcting unit specifies at least one pre-correction modification point among the plurality of target points on the reference target trajectory, and sets a post-correction modification point obtained by modifying a position of the pre-correction modification point, thus setting a corrected target path including the post-correction modification point. In addition, in a case where a predetermined time correcting condition is satisfied, the target trajectory correcting unit sets the time information in the target path based on at least one of information about a speed of the attachment on the reference target trajectory and information about a preset upper limit of the speed of the attachment.
The present invention provides the work machine including a machine body, an attachment that is attached to the machine body and performs work, and the trajectory generating system according to any one of the above descriptions.
A trajectory generating system 1 according to one embodiment of the present invention will be described with reference to
The trajectory gencrating system 1 is a system that generates a target trajectory TR (see
The work machine 10 is a machine that performs work, for example, a construction machine such as an excavator that performs construction work. The work machine 10 is configured to be automatically driven by the controller 40. The work machine 10 includes a machine body 10a, the attachment 15, an actuator 17, and a drive control unit 19 (see
The machine body 10a is a main portion of the work machine 10. The machine body 10a includes a lower travelling body 11 and an upper slewing body 13. The lower travelling body 11 can travel on a traveling surface such as a ground surface. The lower travelling body 11 includes, for example, a crawler. The upper slewing body 13 is mounted on the lower travelling body 11 so as to be able to slew about a slewing center shaft extending in an up-down direction.
The attachment 15 is a portion for performing work, and is attached to the machine body 10a (more specifically, the upper slewing body 13). The attachment 15 includes a boom 15b, an arm 15c, and a distal end attachment 15d. The boom 15b is mounted on the upper slewing body 13 so as to be able to be raised and lowered (rotatable in an up-down direction Z). The arm 15c is rotatably mounted on the boom 15b. The distal end attachment 15d is provided at a distal end of the attachment 15 and is rotatably mounted on the arm 15c. The distal end attachment 15d may be a bucket that excavates (scoops), for example, earth, a device (a grapple or the like) that pinches an object, or a device (a breaker or the like) that crushes or excavates an object. A specific portion of the attachment 15 is referred to as a specific portion 15e. The specific portion 15e is a portion that moves along the target trajectory TR (see
The actuator 17 moves the work machine 10. The actuator 17 includes a slewing motor 17a, a boom cylinder 17b, an arm cylinder 17c, and a distal end attachment cylinder 17d. The slewing motor 17a slews the upper slewing body 13 with respect to the lower travelling body 11. The slewing motor 17a may be a hydraulic motor or an electric motor. The boom cylinder 17b raises and lowers the boom 15b with respect to the upper slewing 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 distal end attachment cylinder 17d). The arm cylinder 17c rotationally moves the arm 15c with respect to the boom 15b. The distal end attachment cylinder 17d rotationally moves the distal end attachment 15d with respect to the arm 15c. Note that, in a case where the distal end attachment 15d itself can be driven like, for example, a device that pinches an object, a cylinder or a motor for driving the distal end attachment 15d may be provided.
The drive control unit 19 (see
The attitude sensor 21 detects an attitude of the work machine 10. The attitude sensor 21 may include a sensor (for example, a rotary encoder) that detects an angle, a sensor that detects an inclination with respect to a horizontal plane, or a sensor that detects a stroke of a hydraulic cylinder that drives the attachment 15. Further, 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 23a (see
The slewing angle sensor 21a detects a slewing angle of the upper slewing body 13 with respect to the lower travelling body 11. The boom angle sensor 21b detects a rotation angle of the boom 15b with respect to the upper slewing body 13. The arm angle sensor 21c detects a rotation angle of the arm 15c with respect to the boom 15b. The distal end attachment angle sensor 21d detects a rotation angle of the distal end attachment 15d with respect to the arm 15c. The reference position sensor 21e detects the position and orientation of the work machine 10 with respect to the work site. The reference position sensor 21c may perform detection with a positioning system. The positioning system may be a satellite positioning system, such as, a global navigation satellite system (GNSS). In this case, the reference position sensor 21e may include a GNSS antenna 21el and the like. The positioning system may use a total station.
The situation detection unit 23 (see
The communication device 25 performs communication. For example, the communication device 25 performs communication between the controller 40 and the mobile terminal 30. In addition, the communication device 25 may perform communication between the controllers 40 disposed outside and inside the work machine 10. Communication by the communication device 25 may include at least one of wireless communication, wired communication, and optical communication.
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 illustrated in
The operation unit 31 is operated by a worker. For example, in the operation unit 31, an operation for performing a setting related to an automatic operation of the work machine 10 (scc
The display unit 33 performs display. The display unit 33 displays information about the target trajectory TR (see
The controller 40 is a computer that inputs and outputs signals, performs arithmetic (processing), stores information, and the like. For example, the function of the controller 40 is implemented by causing an arithmetic unit to execute a program stored in a storage unit of the controller 40. For example, the controller 40 acquires information about the attitude of the work machine 10 (see
The target trajectory setting unit 41 sets the target trajectory TR illustrated in
The target trajectory setting unit 41 (see
The target trajectory correcting unit 43 (see
The operation control unit 45 (see
[Example A1] The target trajectory correcting unit 43 illustrated in
[Example A1a] For example, the target trajectory correcting unit 43 may correct the target trajectory TR in accordance with progress of the work by the attachment 15. Specifically, the situation detection unit 23 (see
[Example A1b] For example, the target trajectory correcting unit 43 may correct the target trajectory TR depending on a situation of an obstacle around the work machine 10. Specifically, when the situation detection unit 23 detects an obstacle (for example, a vehicle (a dump car or the like), a topography, or the like) around the work machine 10, the controller 40 sets an entry prohibition area based on the position of the obstacle. In a case where the attachment 15 is expected to enter the entry prohibition area if it moves along the pre-correction target trajectory TRa, the target trajectory correcting unit 43 may set the post-correction target trajectory TRb where the attachment 15 does not enter the entry prohibition area.
[Example A2] The target trajectory correcting unit 43 may correct the target trajectory TR based on a command (input) different from the determination of the controller 40. For example, the target trajectory correcting unit 43 may set the post-correction target trajectory TRb in accordance with a manual operation (for example, tablet operation or the like) of the operation unit 31 (see
The above [Example A1] and [Example A2] correspond to examples of a path correcting condition of the present invention. That is, the path correcting condition includes at least one of a condition that an obstacle is present on the target path after the target trajectory setting unit 41 sets the pre-correction target trajectory TRa, a condition that the operator instructs to change the target path, and condition that the work position of the attachment 15 is changed. Note that the path correcting condition may be another condition different from the above conditions.
As described above, at the work site of the work machine 10, there is a case where the target path included in the target trajectory TR set in advance by teaching or the like is corrected as necessary. On the other hand, the target trajectory TR includes the target path and the time parameter as described above. Here, in a case where the target path is changed and the time parameter (point-to-point time) is maintained in order to avoid an obstacle or the like, the moving speed of the attachment 15 changes because the movement time of the attachment 15 is not changed although the distance between the adjacent target points changes. In particular, in a case where the distance between the two target points increases with the change of the target path, the moving speed of the attachment 15 partially increases before and after the correction of the target path in order to move the attachment 15 at the identical movement time. In this case, since the speed of the attachment 15 rapidly increases as compared with the moving operation of the attachment 15 set in advance by teaching, a surrounding worker feels insecure. In the present embodiment, in order to solve such a problem at the work site, the controller 40 also adjusts the time parameter as necessary along with the correction of the target path.
As described above, the target trajectory setting unit 41 sets the pre-correction target trajectory TR through teaching or the like in advance (step S1). Note that the target trajectory TR at this time corresponds to a reference target trajectory of the present invention. The reference target trajectory includes a reference target path including a plurality of target points and a time parameter (time information) that is information about a time during which the specific portion 15e moves along the plurality of target points.
Next, the controller 40 determines whether correction of a target trajectory is necessary (step S2). At this time, necessity of the correction is determined based on the above-described path correcting conditions [Example A1], [Example A2], and the like. In a case where the correction is not necessary (NO in step S2), the controller 40 moves the actuator 17 based on the target trajectory TR set in step S1.
On the other hand, in a case where the correction is necessary (YES in step S2), in other words, in a case where the path correcting condition is satisfied, the target trajectory correcting unit 43 first changes a target path (step S3). In the change of the target path, the target trajectory correcting unit 43 specifies at least one pre-correction modification point among the plurality of target points on the reference target trajectory and sets a post-correction modification point obtained by modifying a position of the pre-correction modification point, thereby setting a new target path including the post-correction modification point. The target path set at this time includes the corrected target path of the present invention.
Next, the target trajectory correcting unit 43 determines, based on the time parameter included in the reference target trajectory, the newly set corrected target path as to whether a fecling of anxiety is likely to be given to the surrounding worker, in other words, whether a predetermined time correcting condition is satisfied in a case where the specific portion 15e (attachment 15) moves. Specifically, the target trajectory correcting unit 43 determines whether the point-to-point speed is higher after the correction of the target path than before the correction of the target path (step S4). In the present embodiment, since the time parameter is the time (movement time) between two adjacent points in the plurality of target points, the determination processing in step S4 is equivalent to determining whether the distance between the two adjacent points increases before and after the correction. In a case where the set movement times are the same, when the point-to-point distance increases, the movement speed increases as a result. Thus, the surrounding workers are likely to feel insecure.
Therefore, in a case where the point-to-point speed is higher after the correction of the target path than before the correction of the target path (the speed of the attachment on the reference target trajectory) (YES in step S4), the target trajectory correcting unit 43 corrects the point-to-point time (time parameter) (step S5). As a result, the setting of the post-correction target trajectory TR is completed (step S6). Note that, in step S4, in a case where the point-to-point speed after the correction of the target path is equal to or less than the point-to-point speed before the correction of the target path (NO in step S4), the target trajectory correcting unit 43 completes the setting of the post-correction target trajectory TR based only on the correction of the target path without correcting the point-to-point time (step S6).
Note that the flowchart of
Note that, in step S4, a case where the point-to-point speed after the correction of the target path is equal to or less than the point-to-point speed before the correction of the target path (NO in step S4) is equivalent to that the distance between two adjacent points decreases before and after the correction. In this case, since the speed of the attachment 15 is partially reduced, a feeling of anxiety is not given to the surrounding workers. However, the point-to-point time may be corrected in accordance with the point-to-point speed before correction from the viewpoint of a cycle time such as productivity.
Next, a method for correcting the target trajectory TR will be specifically described in detail. The target trajectory correcting unit 43 corrects the target trajectory TR as follows. The target trajectory correcting unit 43 sets the pre-correction modification point Pa. The pre-correction modification point Pa is a part of the plurality of target points P on the pre-correction target trajectory TRa. Only one pre-correction modification point Pa may be set, or a plurality of pre-correction modification points Pa may be set. The pre-correction modification point Pa may be a first point (target point P1 in
The target trajectory correcting unit 43 sets the point-to-point time (time parameter) of the post-correction target trajectory TRb so as to prevent a feeling of anxiety from being given to a worker who views the attachment 15 that moves along the post-correction target trajectory TRb. Specifically, the target trajectory correcting unit 43 may set the point-to-point time at the post-correction modification point Pb based on the information about the speed of the attachment 15 on the pre-correction target trajectory TRa. The target trajectory correcting unit 43 may set the point-to-point time at the post-correction modification point Pb based on information about an upper limit of the speed of the attachment 15 at the post-correction modification point Pb.
The “speed of the attachment 15” (hereinafter, also referred to as “ATT speed”) may include the slewing speed of the upper slewing body 13 (of the attachment 15) with respect to the lower travelling body 11. The ATT speed may include a rotation (raising and lowering) speed of the boom 15b (the speed of the boom 15b) with respect to the upper slewing body 13 illustrated in
The “information about the speed of the attachment 15” may be information about the speed of the attachment 15 itself or may be the operation speed of the actuator 17 that operates the attachment 15 (the same applies to the “information about the upper limit of the speed of the attachment 15”). The “information about the speed of the attachment 15 itself” is, for example, the rotation speed of the boom 15b with respect to the upper slewing body 13. The “operation speed of the actuator 17 that operates the attachment 15” may be, for example, the expansion and contraction speed of the hydraulic cylinder (for example, the boom cylinder 17b or the like) or the rotation speed of the slewing motor 17a.
The “point-to-point time at the post-correction modification point Pb” may be a point-to-point time between the target point P (P5 in
Hereinafter, the information at the pre-correction modification point Pa illustrated in
For example, the target trajectory correcting unit 43 may set the point-to-point time as in [Example B1] and [Example B2], described below.
[Example B1] The target trajectory correcting unit 43 sets the point-to-point time at the post-correction modification point Pb based on the information about the pre-correction ATT speed (the speed of the attachment 15 on the pre-correction target trajectory TRa) (in consideration of the pre-correction ATT speed). In this case, the target trajectory correcting unit 43 preferably sets the post-correction target trajectory TRb so that a worker around the work machine 10 feels the speeds identical to each other before and after the correction when the specific portion 15e moves along the target trajectory TR.
For example, the target trajectory correcting unit 43 sets the point-to-point time at the post-correction modification point Pb so that the ATT speed at the post-correction modification point Pb becomes equal to or less than the ATT speed at the pre-correction modification point Pa. The “ATT speed at the post-correction modification point Pb” may be an ATT speed (specifically, the average value or average speed of the magnitudes of the ATT speeds) between the target point P (in
For example, the target trajectory correcting unit 43 sets the corrected point-to-point time so that a certain type of post-correction ATT speed (for example, the slewing speed) is equal to or less than the same type of pre-correction ATT speed (for example, the slewing speed). For example, the target trajectory correcting unit 43 sets the corrected point-to-point time so that a certain type of post-correction ATT speed (for example, the slewing speed) is equal to the same type of pre-correction ATT speed (for example, the slewing speed).
<Comparison Between Pre-ATT Speed and Post-Correction ATT Speed Assuming that Point-to-Point Time is not Changed>
For example, the target trajectory correcting unit 43 sets the point-to-point time as follows. For the sake of explanation the target trajectory correcting unit 43 is assumed not to change the post-correction point-to-point time from the pre-correction point-to-point time. In this assumption, the plurality of types of ATT speeds may include an ATT speed (for example, a slewing speed) that is higher after correction than before correction. In this case, the target trajectory correcting unit 43 sets the corrected point-to-point time so that the post-correction ATT speed (slewing speed) becomes equal to or less than the pre-correction ATT speed (slewing speed).
Assuming that the point-to-point time is not changed before and after correction, a plurality of types of ATT speeds that are higher after correction than before correction may present. In this case, the target trajectory correcting unit 43 sets the corrected point-to-point time so that the post-correction ATT speed becomes equal to or less than the pre-correction ATT speed among all types of ATT speeds higher after correction than before correction. Here, it is assumed that the directions of the ATT speed is equal to each other before and after correction. Specifically, for example, in a case where a direction of the slewing speed before correction is rightward (right slewing), a direction of the slewing speed after correction is also rightward (right slewing). For example, assuming that the point-to-point time is not changed before and after correction, the target trajectory correcting unit 43 calculates a ratio (speed change ratio) of a certain type of post-correction ATT speed to the same type of pre-correction ATT speed for each of the plurality of types of ATT speeds. The target trajectory correcting unit 43 specifies the type of the ATT speed having the greatest speed change ratio among the plurality of types of ATT speeds. The target trajectory correcting unit 43 then sets the point-to-point time so that the post-correction ATT speed becomes equal to or less than the pre-correction ATT speed for the type of the ATT speed having the greatest speed change ratio.
Note that in a case where a central target point among the three consecutive target points is set as the pre-correction modification point Pa and the position thereof is modified, the distance between the post-correction modification point Pb and the first target point may be long, whereas the distance between the post-correction modification point Pb and the third target point may be short. Also in such a case, the time parameter may be changed based on these distances (attachment speeds) between two points.
<Specific Example of Information about Pre-Correction Target Trajectory TRa>
Here, as illustrated in
The controller 40 calculates the slewing speed between the target points P based on the change amount of a slewing angle Sw between the target points P and the point-to-point time. In addition, the controller 40 calculates at least one of the rotation angle of each portion (for example, the boom 15b) of the attachment 15 illustrated in
<Various Types of Speeds (Point-to-Point Time: 1) at Pre-Correction Target Point P6>
The controller 40 calculates each type of speeds at the post-correction target point P6 as follows assuming that the point-to-point time at the post-correction target point P6 is 1 second which is identical to the point-to-point time at the pre-correction target point P6.
<Each Type of Speeds (Assuming that Point-to-Point Time: 1) at Post-Correction Target Point P6>
In this example, the magnitude of the expansion and contraction speed of the boom cylinder 17b illustrated in
<Each type of Speeds (Point-to-Point Time: 2) at Post-Correction Target Point P6>
In this example, since the point-to-point time at the target point P6 is set to 2, the magnitude of the post-correction slewing speed becomes 10 which is identical to the pre-correction slewing speed (see
On the pre-correction target trajectory TRa of the example illustrated in
<Case where Speed is 0 or the Like>
Therefore, in a case where the pre-correction ATT speed is equal to or less than a predetermined minute threshold (referred to also as a threshold or a first minute threshold), the target trajectory correcting unit 43 sets the post-correction point-to-point time as follows. In this case, the target trajectory correcting unit 43 determines a reference target point (for example, the target point P5) closest to the pre-correction modification point Pa (for example, the target point P6) among the target points P where the ATT speed is greater than the minute threshold. The target trajectory correcting unit 43 then sets the point-to-point time at the post-correction modification point Pb so that the post-correction ATT speed becomes equal to or less than the ATT speed at the reference target point (for example, the target point P5). The “minute threshold” is set in the target trajectory correcting unit 43 in advance (before the processing for setting the point-to-point time). The minute threshold may be 0. In a case where the post-correction modification point Pb is a point (a point that is neither the start point nor the end point) between the start point and the end point of the pre-correction target trajectory TRa, two reference target points may be present.
In the above example, the controller 40 calculates the ratio (speed change ratio) of the post-correction ATT speed to the pre-correction ATT speed for each of the plurality of types of ATT speeds. In this calculation method, the speed change ratio cannot be calculated at the ATT speed of such a type that the pre-correction speed is zero. Further, as for a pre-correction ATT speed that has a minute value, the speed change ration has an extremely great value.
Therefore, in a case where a pre-correction ATT speed having a value equal to or less than a second minute threshold, the target trajectory correcting unit 43 calculates the speed change ratio as follows. In this case, the target trajectory correcting unit 43 determines a second reference target point (for example, the target point P5) closest to the pre-correction modification point Pa (for example, the target point P6) among the target points P where the speed is greater than the second minute threshold. The target trajectory correcting unit 43 then calculates a ratio of the ATT speed at the post-correction modification point Pb to the pre-correction ATT speed at the second reference target point (for example, the target point P5) as the speed change ratio. Note that the “minute threshold” and the “second minute threshold” may be equal to or different from each other.
[Example B2] The target trajectory correcting unit 43 may set the point-to-point time at the post-correction modification point Pb based on the information about an upper limit (“upper limit speed Vm” of the speed of the attachment 15 at the post-correction modification point Pb illustrated in
The target trajectory correcting unit 43 may set the point-to-point time at the post-correction modification point Pb by combining [Example B1] and [Example B2] described above. For example, when the post-correction target trajectory TRb is in the “region of the predetermined position”, the target trajectory correcting unit 43 may set the post-correction point-to-point time so that the post-correction ATT speed becomes equal to or less than smaller one of the pre-correction ATT speed and the upper limit speed Vm.
The display unit 33 (see
Effects of the trajectory generating system 1 illustrated in
The target trajectory correcting unit 43 sets the point-to-point time at the post-correction modification point Pb based on at least one of the information about the speed of the attachment 15 on the pre-correction target trajectory TRa and the information about the upper limit of the speed of the attachment 15 at the post-correction modification point Pb.
In the above configuration, in a case where the point-to-point time at the post-correction modification point Ph is set based on the information about the speed of the attachment 15 on the pre-correction target trajectory TRa, the following effects can be obtained. In this case, the post-correction target trajectory TRb can be set so that the movement of the specific portion 15e moving along the post-correction target trajectory TRb is close to the movement of the specific portion 15e moving along the pre-correction target trajectory TRa. Therefore, the post-correction target trajectory TRb can be set so that the speeds of the attachment 15 felt by a worker around the work machine 10 are equivalent to each other before and after the correction of the target trajectory TR. As a result, the trajectory generating system 1 (see
In the above configuration, in a case where the post-correction point-to-point time is set based on the information about the upper limit of the speed of the attachment 15 at the post-correction modification point Pb, the following effects can be obtained. In this case, the post-correction target trajectory TRb can be set so that the speed of the attachment 15 at the position of the post-correction modification point Pb is equal to or less than the upper limit of the speed (upper limit speed Vm). As a result, the trajectory generating system 1 (see
The target trajectory correcting unit 43 (see
The above configuration can provide the same effects as those described above.
The target trajectory correcting unit 43 (see
With the above configuration, the speed of the attachment 15 moving along the post-correction target trajectory TRb does not become higher than the speed of the attachment 15 moving along the pre-correction target trajectory TRa. As a result, it is possible to more reliably prevent the movement of the attachment 15 from giving a feeling of anxiety to a worker around the work machine 10.
The target trajectory correcting unit 43 (see
With the above configuration, even in a case where the speed of the attachment 15 at the pre-correction modification point Pa is equal to or less than the predetermined minute threshold, the point-to-point time can be appropriately set based on the speed of the attachment 15 on the pre-correction target trajectory TRa.
The target trajectory correcting unit 43 (see
With the above configuration, the trajectory gencrating system 1 can reliably prevent the movement of the attachment 15 from giving a feeling of anxiety to a worker around the work machine 10 in a case where the target trajectory TR of the attachment 15 is corrected.
As illustrated in
With the above configuration, even if the specific portion 15e is not actually moved along the post-correction target trajectory TRb illustrated in
The above embodiment may be variously modified. For example, the connection mode of the components illustrated in
The present invention provides a trajectory generating system that is used in a work machine including a machine body and an attachment that is attached to the machine body and performs work. The trajectory generating system includes a target trajectory setting unit and a target trajectory correcting unit. The target trajectory setting unit sets a reference target trajectory that is a target for a movement of a specific portion of the attachment and includes a reference target path including a plurality of target points and time information that is information regarding time for a movement of the specific portion along the plurality of target points. The target trajectory correcting unit corrects the reference target trajectory. In addition, in a case where a predetermined path correcting condition is satisfied, the target trajectory correcting unit specifics at least one pre-correction modification point among the plurality of target points on the reference target trajectory and sets a post-correction modification point obtained by modifying a position of the pre-correction modification point, thus setting a corrected target path including the post-correction modification point, and in a case where a predetermined time correcting condition is satisfied, the target trajectory correcting unit sets the time information in the corrected target path based on at least one of information about a speed of the attachment on the reference target trajectory and information about a preset upper limit of the speed of the attachment.
In the above configuration, the target trajectory correcting unit may set the time information in the corrected target path based on information about the speed of the attachment on the reference target trajectory.
In the above configuration, the target trajectory correcting unit may set the time information in the corrected target path so that a speed of the attachment at the post-correction modification point is equal to or less than a speed of the attachment at the pre-correction modification point on the reference target trajectory.
In the above configuration, the target trajectory correcting unit may set the time information in the corrected target path so that an average speed of the attachment in a region between an adjacent target point adjacent to the post-correction modification point among the plurality of target points and the post-correction modification point is equal to or less than an average speed of the attachment in a region between the pre-correction modification point and the adjacent target point on the reference target trajectory.
In the above configuration, in a case where the speed of the attachment at the pre-correction modification point is equal to or less than a predetermined threshold on the reference target trajectory, the target trajectory correcting unit may specify, among the plurality of target points, a certain reference target point that is the target point at which the speed of the attachment is higher than the threshold, the target point being the closest to the pre-correction modification point, and may set the time information in the corrected target path so that a speed of the attachment at the post-correction modification point is equal to or less than the speed of the attachment at the reference target point on the reference target trajectory.
In the above configuration, the target trajectory correcting unit may set the time information in the corrected target path so that a speed of the attachment at the post-correction modification point is equal to or less than a preset upper limit of the speed of the attachment.
In the above configuration, the time information may be a movement time of the attachment between two target points adjacent to each other among the plurality of target points.
The above configuration may further include a display unit that displays information about the reference target trajectory corrected by the target trajectory correcting unit.
In the above configuration, the path correcting condition includes at least one of a such condition that an obstacle is present in the reference target path after the target trajectory setting unit sets the reference target trajectory, a condition that an operator instructs to change the reference target path, and a condition that the work position of the attachment is modified.
In the above configuration, the time correcting condition may include a condition that assuming that the attachment moves to the plurality of target points included in the corrected target path, based on the time information about the reference target trajectory, the speed of the attachment at the post-correction modification point is higher than the speed of the attachment at the pre-correction modification point on the reference target trajectory.
The present invention provides a work machine including a machine body, an attachment that is attached to the machine body and performs work, and any one trajectory generating system among the above-described systems.
Number | Date | Country | Kind |
---|---|---|---|
2021-158772 | Sep 2021 | JP | national |
2022-083929 | May 2022 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/023302 | 6/9/2022 | WO |