WO2017043112A1 - 建設機械 - Google Patents

建設機械 Download PDF

Info

Publication number
WO2017043112A1
WO2017043112A1 PCT/JP2016/058082 JP2016058082W WO2017043112A1 WO 2017043112 A1 WO2017043112 A1 WO 2017043112A1 JP 2016058082 W JP2016058082 W JP 2016058082W WO 2017043112 A1 WO2017043112 A1 WO 2017043112A1
Authority
WO
WIPO (PCT)
Prior art keywords
reaction force
target
actual
angle
correction
Prior art date
Application number
PCT/JP2016/058082
Other languages
English (en)
French (fr)
Inventor
慶幸 土江
坂本　博史
秀一 森木
釣賀　靖貴
Original Assignee
日立建機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日立建機株式会社 filed Critical 日立建機株式会社
Priority to EP16843978.4A priority Critical patent/EP3348715B1/en
Priority to KR1020177037400A priority patent/KR101986446B1/ko
Priority to US15/749,828 priority patent/US10533303B2/en
Priority to CN201680037755.6A priority patent/CN107709672B/zh
Publication of WO2017043112A1 publication Critical patent/WO2017043112A1/ja

Links

Images

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2025—Particular purposes of control systems not otherwise provided for
    • E02F9/2037—Coordinating the movements of the implement and of the frame
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/22—Hydraulic or pneumatic drives
    • E02F9/2203—Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2004—Control mechanisms, e.g. control levers
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2025—Particular purposes of control systems not otherwise provided for
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2025—Particular purposes of control systems not otherwise provided for
    • E02F9/2029—Controlling the position of implements in function of its load, e.g. modifying the attitude of implements in accordance to vehicle speed
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2025—Particular purposes of control systems not otherwise provided for
    • E02F9/2041—Automatic repositioning of implements, i.e. memorising determined positions of the implement
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/22—Hydraulic or pneumatic drives
    • E02F9/2264—Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271—Actuators and supports therefor and protection therefor
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/30—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes

Definitions

  • the present invention relates to a construction machine.
  • a construction machine such as a hydraulic excavator provided with a front work device composed of a plurality of front members such as a boom, an arm, and a bucket is known (see Patent Document 1).
  • the front working device is driven by operating an operation member corresponding to each front member.
  • the operation device for a construction machine described in Patent Literature 1 applies an operation reaction force according to the degree of approach to the work range boundary of the front work device by the operation of each operation member to the operation of each operation member.
  • reaction force control means for controlling the reaction force application means.
  • the reaction force control means described in Patent Document 1 calculates the distance between the front work device and the work range boundary after a predetermined time by the operation of each operation member based on the attitude of the front work device and the operation of each operation member. To do.
  • the reaction force control means applies the reaction force so as to apply the operation reaction force only to the operation of the operation member such that the calculated distance is shorter than the distance between the current position of the front work device and the work range boundary. Control the applying means.
  • the front work device is composed of a plurality of front members, for example, when performing a work of moving the toe of the bucket along a linear target locus, such as a straight excavation work, the front work devices are operated in combination. It was necessary to make it operate, and skill was required for operation. Further, even a skilled operator cannot easily perform high-precision and high-speed work, and there is a problem that work efficiency decreases due to fatigue caused by long-time work.
  • Patent Document 1 proposes assisting an operator by using an operation reaction force, but it cannot solve the above problems.
  • a construction machine includes a front working device having a plurality of front members including at least a first front member and a second front member, a plurality of actuators for driving the plurality of front members, and a plurality of actuators.
  • a reaction force applying device that applies an operation reaction force to the operation unit based on an actual operation amount
  • a control signal for the reaction force application device are generated in order to
  • An operation amount detection unit that detects an actual operation amount of the unit, a trajectory determination unit that determines a target trajectory of a preset part of the front work device, and a front work device that moves by driving a plurality of front members in advance.
  • a position detection unit for detecting the position of the set part, and a target of the part set in advance of the front work device along the target locus
  • a target speed determining unit for determining the degree
  • a target operation amount determining unit for determining a target operation amount for each of the first front member and the second front member based on the target speed, a target operation amount for the front member
  • a correction is performed to increase the operation reaction force applied by the reaction force application device to the operation unit that operates the actuator that drives the front member
  • a control device having a reaction force correction control unit that performs correction to reduce the operation reaction force applied by the reaction force applying device to the operation unit that operates the actuator that drives the front member if within the range; I have.
  • (A) is a figure showing actual speed vector VAc of tiptoe Pb.
  • (B) is a figure showing the target velocity vector VTc of the toe Pb.
  • the flowchart which shows an example of the process by the operation reaction force control program performed by a controller.
  • the flowchart which shows an example of the 1st correction control processing by the operation reaction force control program performed by a controller, and a 2nd correction control processing.
  • FIG. 1 is a side view of a hydraulic excavator (backhoe) 100, which is an example of a construction machine to which the present embodiment is applied.
  • a hydraulic excavator 100 includes a traveling body 101 and a revolving body 102 that is turnably mounted on the traveling body 101.
  • the traveling body 101 travels by driving a pair of left and right crawlers by a traveling motor.
  • a driver's cab 107 is provided on the left side of the front part of the swivel body 102, and an engine room is provided at the rear of the driver's cab 107.
  • the engine room houses an engine, hydraulic equipment, and the like that are power sources.
  • a counterweight 109 for balancing the airframe during work is attached to the rear of the engine compartment.
  • a front working device 103 is provided on the right side of the front portion of the swivel body 102.
  • the front working device 103 includes a plurality of front members, that is, a boom 104, an arm 105, and a bucket 106.
  • the boom 104 is pivotally attached to the front part of the swing body 102 at the base end.
  • One end of the arm 105 is rotatably attached to the tip of the boom 104.
  • the boom 104 and the arm 105 are driven up and down by the boom cylinder 104a and the arm cylinder 105a, respectively.
  • the bucket 106 is attached at the tip of the arm 105 so as to be rotatable in the vertical direction with respect to the arm 105, and is driven by a bucket cylinder 106a.
  • FIG. 2 is a diagram showing a schematic configuration of the controller 120 according to the present embodiment.
  • the excavator 100 includes a controller 120.
  • the controller 120 includes an arithmetic processing unit having a CPU and a storage device such as ROM and RAM, and other peripheral circuits, and controls each part of the excavator 100.
  • the controller 120 includes an operation amount sensor 111d that outputs a signal corresponding to an operation direction and an actual operation angle of the electric left operation lever 111 disposed in the cab 107, and an operation direction of the electric right operation lever 112.
  • An operation amount sensor 112d that outputs a signal corresponding to the actual operation angle is connected.
  • the actual operation angle (actual operation amount) is an inclination angle from the neutral position NP of the operation levers 111 and 112.
  • the controller 120 receives signals corresponding to the operation direction and the actual operation angle ⁇ of the left operation lever 111 and the right operation lever 112.
  • the controller 120 functionally includes an operation amount detection unit 120d.
  • the operation amount detection unit 120d detects the operation direction and the actual operation angle ⁇ of the left operation lever 111 and the right operation lever 112 based on signals from the operation amount sensors 111d and 112d.
  • FIG. 3 is a diagram for explaining the operation of the excavator 100 corresponding to the operation directions of the left operation lever 111 and the right operation lever 112.
  • the left operation lever 111 is located on the left side of the driver seat, and the right operation lever 112 is located on the right side of the driver seat.
  • the left operation lever 111 is an operation member that operates the rotation operation of the arm 105 with respect to the boom 104 and the rotation operation of the revolving body 102.
  • an arm pushing operation is performed.
  • the arm pushing operation means that the arm cylinder 105a contracts and the arm 105 rotates with respect to the boom 104 in a direction in which the relative angle of the arm 105 widens at a speed corresponding to the actual operation angle (in FIG. 1, it rotates clockwise). Motion).
  • an arm pulling operation is performed.
  • the arm pulling operation means that the arm 105 rotates at a speed corresponding to the actual operation angle so that the arm cylinder 105a extends and the arm 105 is folded toward the boom 104 (rotates counterclockwise in FIG. 1). Is the action.
  • a turning motor (not shown) is driven, and the turning body 102 turns left at a speed corresponding to the actual operation angle.
  • a turning motor (not shown) is driven, and the turning body 102 turns right at a speed corresponding to the actual operation angle.
  • the right operation lever 112 is an operation member that operates the rotation operation of the boom 104 with respect to the revolving structure 102 and the rotation operation of the bucket 106 with respect to the arm 105.
  • a boom lowering operation is performed.
  • the boom lowering operation is an operation in which the boom cylinder 104a contracts and the boom 104 rotates downward at a speed corresponding to the actual operation angle.
  • a boom raising operation is performed.
  • the boom raising operation is an operation in which the boom cylinder 104a extends and the boom 104 rotates upward at a speed corresponding to the actual operation angle.
  • bucket excavation operation is performed.
  • the bucket 106 rotates at a speed corresponding to the actual operation angle so that the bucket cylinder 106a extends and the toe (tip) Pb of the bucket 106 approaches the abdominal surface of the arm 105 (reverse to FIG. 1). (Clockwise rotation).
  • the bucket earthing operation is performed.
  • the bucket earthing operation means that the bucket 106 rotates at a speed corresponding to the actual operation angle so that the bucket cylinder 106a contracts and the toe Pb of the bucket 106 moves away from the abdominal surface of the arm 105 (clockwise in FIG. 1). Rotating).
  • the left operating lever 111 When the left operating lever 111 is tilted from the neutral position NP in an oblique direction such as diagonally forward to the left, the arm 105 and the swinging body 102 can be operated in a composite manner.
  • the right operation lever 112 When the right operation lever 112 is tilted from the neutral position NP in an oblique direction such as diagonally forward to the left, the boom 104 and the bucket 106 can be operated in a composite manner. For this reason, in the hydraulic excavator 100 according to the present embodiment, by simultaneously operating the left operation lever 111 and the right operation lever 112, a maximum of four operations can be performed in combination.
  • the controller 120 is connected to a reaction force applying device 111r that generates an operation reaction force that is a force opposite to the operation direction of the operator with respect to the left operation lever 111.
  • the controller 120 is connected to a reaction force applying device 112r that generates an operation reaction force that is a force opposite to the operation direction of the operator with respect to the right operation lever 112.
  • the reaction force applying device 111r and the reaction force applying device 112r have the same configuration, and can be configured by electromagnetic actuators such as a plurality of electromagnetic motors. As will be described later, when a control signal indicating the operation reaction force determined by the controller 120 is output to the reaction force application devices 111r and 112r, the reaction force application devices 111r and 112r apply the left operation lever 111 and the right operation lever 112 to each other. On the other hand, an operation reaction force is generated.
  • a control valve 108 is connected to the controller 120.
  • the controller 120 outputs a control signal for controlling the control valve 108 based on the operation direction and the actual operation angle of the left operation lever 111 and the right operation lever 112 described above.
  • the control valve 108 is switched according to a control signal from the controller 120.
  • the control valve 108 controls the flow of pressure oil supplied from an unillustrated hydraulic pump to the actuators (boom cylinder 104a, arm cylinder 105a, and bucket cylinder 106a) of each front member. For this reason, each front member drives the operation according to the operation direction of the left operation lever 111 and the right operation lever 112 at a speed according to the actual operation angle.
  • a plurality of angle sensors for determining the position of the front member are connected to the controller 120, and signals detected by the respective angle sensors are input.
  • the plurality of angle sensors include a boom angle sensor 110a, an arm angle sensor 110b, and a bucket angle sensor 110c.
  • the boom angle sensor 110 a is provided at a connection portion between the boom 104 and the swing body 102 and detects the rotation angle of the boom 104 with respect to the swing body 102.
  • the arm angle sensor 110 b is provided at a connection portion between the boom 104 and the arm 105 and detects a rotation angle of the arm 105 with respect to the boom 104.
  • the bucket angle sensor 110 c is provided at a connection portion between the arm 105 and the bucket 106 and detects a rotation angle of the bucket 106 with respect to the arm 105.
  • the controller 120 includes an attitude calculation unit 121, a target trajectory determination unit 122, an actual speed calculation unit 123, a target speed calculation unit 124, a vector decomposition unit 125, a target operation amount calculation unit 126, and a reference reaction force calculation unit. 127, a determination unit 128, and a reaction force correction unit 129.
  • the posture calculation unit 121 calculates the posture of the excavator 100, that is, the positions of the boom 104, the arm 105, and the bucket 106, which are the front members constituting the front working device 103.
  • the storage device of the controller 120 stores information on the dimensions of each part of the front member, the swivel body 102, and the traveling body 101.
  • the controller 120 uses a dimension of each part of the front member and information detected by the boom angle sensor 110a, the arm angle sensor 110b, and the bucket angle sensor 110c to set a predetermined portion of each front member including the toe Pb of the bucket 106. Calculate the position.
  • the dimensions of each part of the front member include the dimension from the pivot fulcrum of the boom 104 to the pivot fulcrum of the arm 105, the dimension from the pivot fulcrum of the arm 105 to the pivot fulcrum of the bucket 106, and the pivot of the bucket 106.
  • the dimension from the fulcrum to the toe Pb of the bucket 106 is included.
  • the posture calculation unit 121 calculates the position of the toe Pb of the bucket 106 every predetermined control cycle.
  • the toe Pb of the bucket 106 that moves by driving the front members from the information from the plurality of angle sensors 110a, 110b, 110c and the information on the dimensions of the front members.
  • the position can be detected.
  • the target locus determination unit 122 determines the target locus of the toe Pb of the bucket 106.
  • An example of a target locus determination method will be described with reference to FIG.
  • FIG. 4 is a diagram illustrating a method for determining the target trajectory TL.
  • the operator places the toe Pb of the bucket 106 at the first position P1, operates a position setting switch (not shown), and the numerical value of the excavation depth h1 by the depth setting switch (not shown). Enter.
  • the target trajectory determination unit 122 causes the storage device to store a position separated downward from the first position P1 by the excavation depth h1 as the first set point P1T.
  • the operator places the toe Pb of the bucket 106 at a second position P2 different from the first position P1, operates a position setting switch (not shown), and sets the excavation depth h2 by a depth setting switch (not shown). Enter a number.
  • the target locus determination unit 122 causes the storage device to store the position separated from the second position P2 by the excavation depth h2 as the second set point P2T.
  • the first set point P1T and the second set point P2T are specified by, for example, the horizontal distance from the turning center point BP that is the reference position and the vertical direction distance from the turning center point BP, and are stored in the storage device. Is done.
  • the target locus determination unit 122 connects the first set point P1T located below the first position P1 by the depth h1 and the second set point P2T located below the second position P2 by the depth h2.
  • the straight line equation is calculated and set as the target locus TL.
  • FIG. 5 is a diagram showing a slope leveling operation as an example of a straight excavation operation.
  • the slope leveling operation shown in FIG. 5 can be realized by combining the arm pulling operation and the boom raising operation.
  • the toe Pb of the bucket 106 acts on the left operation lever 111 and the right operation lever 112 so as to move along the target locus TL.
  • Reaction force correction control that adjusts the operation reaction force and prompts the operator to perform an appropriate operation is executed.
  • the operation reaction force correction control when the operation for operating the bucket 106 and the swinging body 102 is not executed will be described.
  • FIG. 6A is a diagram illustrating the actual velocity vector VAc of the toe Pb.
  • the actual speed calculation unit 123 calculates the difference between the current position of the bucket 106 calculated by the attitude calculation unit 121 and the position of the bucket 106 calculated by the attitude calculation unit 121 before one control cycle, and the time of one control cycle. Based on the above, the actual speed vector VAc of the toe Pb of the bucket 106 is calculated.
  • FIG. 6B is a diagram showing the target speed vector VTc of the toe Pb.
  • the direction of the target velocity vector VTc of the toe Pb is a direction parallel to the target locus TL.
  • the norm of the target velocity vector VTc of the toe Pb is set to the same value as the norm of the actual velocity vector VAc (
  • the vector decomposition unit 125 shown in FIG. 2 decomposes the actual speed vector VAc into the arm speed vector VAa and the boom speed vector VAb, as shown in FIG. 6A, based on the current posture of the front working device 103. .
  • the vector decomposition unit 125 decomposes the target speed vector VTc into an arm speed vector VTa and a boom speed vector VTb as shown in FIG.
  • the arm speed vectors VAa and VTa are speed vectors resulting from the rotation operation of the arm 105 with respect to the boom 104, and the direction thereof is a straight line connecting the rotation fulcrum (connection point with the boom 104) of the arm 105 and the toe Pb.
  • the direction is perpendicular to the direction.
  • the boom speed vectors VAb and VTb are speed vectors resulting from the turning operation of the boom 104 with respect to the swinging body 102, and the direction of the boom speed vectors VAb and VTb connects the pivoting fulcrum (connection point with the swinging body 102) of the boom 104 and the toe Pb.
  • the direction is perpendicular to the straight line.
  • the correction coefficients Ka and Kb are coefficients corresponding to the difference between the actual operation angle and the target operation angle, and the target operation angle ⁇ t is obtained by multiplying the actual operation angle ⁇ by the correction coefficients Ka and Kb. That is, when the correction coefficient is 1, it indicates that the target operation angle ⁇ t and the actual operation angle ⁇ match. When the correction coefficient is larger than 1, it represents that the actual operation angle ⁇ is smaller than the target operation angle ⁇ t, and when the correction coefficient is smaller than 1, it represents that the actual operation angle ⁇ is larger than the target operation angle ⁇ t. Yes.
  • the target operation amount calculation unit 126 multiplies an actual operation angle ⁇ in the arm pulling direction of the left operation lever 111 (hereinafter also referred to as an actual operation angle ⁇ a) by a correction coefficient Ka to generate a target arm speed vector VTa.
  • the target operation amount calculation unit 126 multiplies the actual operation angle ⁇ of the right operation lever 112 in the boom raising operation direction (hereinafter also referred to as the actual operation angle ⁇ b) by the correction coefficient Kb to generate a target boom speed vector VTb.
  • the reference reaction force calculation unit 127 determines an operation reaction force F generated by the reaction force applying devices 111r and 112r based on the actual operation angle ⁇ .
  • FIG. 7 is a diagram illustrating a relationship between the actual operation angle ⁇ and the reference operation reaction force FB.
  • characteristics Na and Nb of the reference operation reaction force FB that increase as the actual operation angles ⁇ a and ⁇ b of the left operation lever 111 and the right operation lever 112 increase are stored in a look-up table format. .
  • an operation reaction force F corresponding to the actual operation angles ⁇ a and ⁇ b is applied to the operation levers 111 and 112 by the reaction force applying devices 111r and 112r according to the characteristics Na and Nb.
  • the characteristic Na based on the actual operation angle ⁇ a and the characteristic Nb based on the actual operation angle ⁇ b may be the same characteristic or different characteristics.
  • the characteristics Na and Nb are collectively referred to as the characteristic N
  • the actual operating angle ⁇ a and the actual operating angle ⁇ b are collectively referred to as the actual operating angle ⁇ , explain.
  • the left operation lever 111 and the right operation lever 112 are collectively referred to simply as the operation lever R.
  • Characteristic N is a characteristic in which the reference operation reaction force FB increases linearly as the actual operation angle ⁇ increases, and its maximum value is Fmax.
  • the reference reaction force calculation unit 127 calculates the reference operation reaction force FB according to the actual operation angle ⁇ detected by the operation amount sensors 111d and 112d with reference to the characteristic N. To do.
  • the determination unit 128 shown in FIG. 2 determines whether the actual operation angle ⁇ of the operation lever R has increased, decreased, or has not been changed.
  • the determination unit 128 compares the actual operation angle ⁇ detected by the operation amount sensors 111d and 112d at the current time with the actual operation angle ⁇ detected by the operation amount sensors 111d and 112d one control cycle before.
  • the determination unit 128 determines that the actual operation angle ⁇ of the operation lever R has increased when the current actual operation angle ⁇ is larger than the actual operation angle ⁇ one control cycle before.
  • the determination unit 128 determines that the actual operation angle ⁇ of the operation lever R has decreased when the current actual operation angle ⁇ is smaller than the actual operation angle ⁇ one control cycle before.
  • the determination unit 128 determines that there is no change in the actual operation angle ⁇ of the operation lever R when the current actual operation angle ⁇ is the same as the actual operation angle ⁇ one control cycle before.
  • the reaction force correction unit 129 corrects the operation reaction force based on the correction coefficients Ka and Kb.
  • the control content of the correction of the operation reaction force by the reaction force correction unit 129 will be described.
  • the control for correcting the operation reaction force F for the left operation lever 111 and the control for correcting the operation reaction force F for the right operation lever 112 are substantially the same. Therefore, the left control lever 111 and the right operation lever 112 are collectively referred to as the operation lever R, and the control of the correction of the operation reaction force F on the operation lever R will be described.
  • the correction coefficients Ka and Kb are collectively referred to as the correction coefficient K, and the actual operation angles ⁇ a and ⁇ b are collectively referred to as the actual operation angle ⁇ in the same manner as described above.
  • the reaction force correction unit 129 executes either the first correction control or the second correction control according to the change in the actual operation angle ⁇ of the operation lever R.
  • the determination unit 128 determines that the actual operation angle ⁇ of the operation lever R is decreasing
  • the first correction control is executed.
  • the first correction control is continued until the determination unit 128 determines that the actual operation angle ⁇ of the operation lever R is increasing.
  • the reaction force correction unit 129 performs the second correction control when the determination unit 128 determines that the actual operation angle ⁇ of the operation lever R is increasing. The second correction control is continued until the determination unit 128 determines that the actual operation angle ⁇ of the operation lever R is decreasing.
  • the reaction force correction unit 129 determines whether or not the correction coefficient K is less than the threshold value ⁇ , and whether or not the correction coefficient K is greater than or equal to the threshold value ⁇ .
  • the threshold value ⁇ is a value larger than 1, and is stored in advance in the storage device ( ⁇ > 1).
  • the threshold ⁇ is a value smaller than 1 and is stored in advance in the storage device ( ⁇ ⁇ 1).
  • Threshold value ⁇ and threshold value ⁇ are set according to the allowable range of the target locus TL.
  • the allowable range is a range between a target locus upper limit TLU offset by a predetermined amount upward from the target locus TL and a target locus lower limit TLL offset by a predetermined amount downward from the target locus TL. It is.
  • the allowable range is set according to the required slope accuracy.
  • the permissible range may be configured to be arbitrarily changed by the operator.
  • the distance from the target locus TL to the target locus upper limit TLU and the distance from the target locus TL to the target locus lower limit TLL may be different values or the same value.
  • the reaction force correction unit 129 When it is determined that the difference between the actual operation angle and the target operation angle is large and the correction coefficient K is less than the threshold value ⁇ , the reaction force correction unit 129 adds the correction amount ⁇ F to the reference operation reaction force FB to perform the operation.
  • the reaction force correction unit 129 determines that the actual operation angle ⁇ is It is determined that the target operation angle ⁇ t has been reached.
  • ⁇ 1 shown in FIG. 10 is the actual operation angle ⁇ at which the correction coefficient K is the threshold value ⁇
  • the operation angle ⁇ 2 is the actual operation angle ⁇ at which the correction coefficient K is the threshold value ⁇ . That is, when the correction coefficient K is not less than ⁇ and less than ⁇ , it means that the actual operation angle ⁇ is within a preset operation range including the target operation angle ⁇ t ( ⁇ 1 to ⁇ 2 in FIG. 10A).
  • the reaction force correction unit 129 determines whether or not the correction coefficient K is greater than or equal to the threshold ⁇ and whether or not the correction coefficient K is less than the threshold ⁇ .
  • the threshold value ⁇ is larger than the threshold value ⁇ and is stored in advance in the storage device ( ⁇ > ⁇ ).
  • the threshold ⁇ is such that the magnitude of the operation reaction force F that has been corrected to decrease from the reference operation reaction force FB determined by the characteristic N by the correction amount ⁇ F is at least when the operation lever R is in the neutral position NP when the operation lever R is not operated. It is set so as to be larger than the size returned to.
  • the lower limit value of the actual operation angle ⁇ for executing the correction control of the operation reaction force F is the operation angle ⁇ 0 at which the correction coefficient K becomes the threshold value ⁇ (see FIG. 10B). In other words, when the actual operation angle ⁇ is smaller than the operation angle ⁇ 0, the correction control of the operation reaction force F is not executed.
  • the operating reaction force F0 when the actual operating angle ⁇ is the operating angle ⁇ 0 is such that, after the operator releases the operating lever R, the operating lever R is neutral against the mechanical resistance of the operating lever R (such as friction of the connecting structure).
  • the operation reaction force is larger than the magnitude that can return to the position NP.
  • the reaction force correction unit 129 adds the correction amount ⁇ F to the reference operation reaction force FB to perform the operation.
  • the correction amount ⁇ F is a positive value and is stored in advance in the storage device ( ⁇ F> 0). Note that the operation reaction force correction amount ⁇ F for the left operation lever 111 and the operation reaction force correction amount ⁇ F for the right operation lever 112 may be the same value or different values.
  • the determination unit 128 shown in FIG. 2 determines whether or not to execute control for correcting the reference operation reaction force FB determined based on the characteristic N by the reference reaction force calculation unit 127.
  • the determination unit 128 draws a perpendicular to the target locus TL from the position of the toe Pb, and calculates a distance from the toe Pb to the foot of the perpendicular (hereinafter, perpendicular distance D).
  • the perpendicular distance D is a difference between the target trajectory TL determined by the target trajectory determining unit 122 and the position of the toe Pb calculated by the posture calculating unit 121.
  • the determination unit 128 determines that the correction execution condition is satisfied when the perpendicular distance D is less than the threshold value Dt.
  • the determination unit 128 determines that the correction execution condition is not satisfied when the perpendicular distance D is equal to or greater than the threshold value Dt.
  • the threshold value Dt is arbitrarily set by the operator. For example, when the toe Pb is 1 m or more away from the target locus TL, 1 m may be set in advance as the threshold value Dt in order not to execute the correction control.
  • the control for correcting the operation reaction force by the controller 120 described above is executed when the correction execution condition is satisfied, and is not executed when the correction execution condition is not satisfied.
  • FIGS. 8 and 9 are flowcharts showing an example of processing by the operation reaction force control program executed by the controller 120.
  • FIG. FIG. 9 shows the contents of the first correction control process and the second correction control process shown in FIG.
  • the processing shown in the flowcharts of FIGS. 8 and 9 is started by turning on an operation guide switch (not shown) connected to the controller 120 after the target locus TL is set based on the operation of the operator, and has a predetermined control cycle. Every time, the processing after step S100 is repeatedly executed, and the operation is ended by turning off the operation guidance switch (not shown).
  • step S100 the controller 120 acquires various types of information, and proceeds to step S110.
  • the various information acquired in step S100 includes information on the rotation angle of each front member detected by the angle sensors 110a, 110b, and 110c, and the actual operation angle ⁇ of the operation lever detected by the operation amount sensors 111d and 112d. Contains information.
  • step S110 the controller 120 refers to the table of the characteristic N (FIG. 7) stored in the storage device, and calculates the reference operation reaction force FB based on the information on the actual operation angle ⁇ acquired in step S110. Then, the process proceeds to step S115.
  • the controller 120 refers to the table of the characteristic N (FIG. 7) stored in the storage device, and calculates the reference operation reaction force FB based on the information on the actual operation angle ⁇ acquired in step S110. Then, the process proceeds to step S115.
  • step S115 the controller 120 calculates the working posture of the excavator 100 based on the dimensions of each front member stored in the storage device and the information on the rotation angle of each front member acquired in step S100.
  • the process proceeds to step S120.
  • the posture calculation processing in step S115 the position of the toe Pb of the bucket 106, the position of the rotation fulcrum of the arm 105, and the position of the rotation fulcrum of the bucket 106 are calculated with reference to the turning center point BP of the turning body 102.
  • a perpendicular distance D from the toe Pb to the target locus TL is calculated.
  • step S120 the controller 120 determines whether a correction execution condition is satisfied. If an affirmative determination is made in step S120, that is, if it is determined that the perpendicular distance D is less than the threshold value Dt and the correction execution condition is satisfied, the process proceeds to step S125. If a negative determination is made in step S120, that is, if it is determined that the perpendicular distance D is equal to or greater than the threshold value Dt and the correction execution condition is not satisfied, the process proceeds to step S180.
  • step S180 the controller 120 determines the reference operation reaction force FB as the operation reaction force F to be generated as it is, and proceeds to step S190. That is, the reference operation reaction force is not corrected.
  • step S125 the controller 120 determines the position of the toe Pb based on the difference between the position (current position) of the toe Pb calculated in step S115 and the position of the toe Pb calculated in step S115 one control cycle before.
  • the actual speed vector VAc is calculated, and the process proceeds to step S130.
  • step S130 the controller 120 calculates the target velocity vector VTc based on the position of the toe Pb calculated in step S115 and the target locus TL, and proceeds to step S135.
  • step S135 the controller 120 executes vector decomposition processing, and proceeds to step S140.
  • the vector decomposition process based on the actual speed vector VAc calculated in step S125 and the position information of each front member calculated in step S115, the actual speed vector VAc is converted into the arm speed vector VAa and the boom speed vector VAb.
  • the target speed vector VTc is converted into the arm speed vector VTa and the boom speed vector VTb.
  • step S140 the controller 120 calculates the correction coefficient K based on the target value and actual value of the arm speed vector decomposed in step S135 and the target value and actual value of the boom speed vector (correction coefficient calculation process). ), Go to step S145.
  • the controller 120 divides the norm of the arm speed vector VTa (target value) calculated in step S135 by the norm of the arm speed vector VAa (actual value) calculated in step S135. Is calculated.
  • the controller 120 divides the norm of the boom speed vector VTb (target value) calculated in step S135 by the norm of the boom speed vector VAb (actual value) calculated in step S135, thereby correcting the coefficient Kb. Is calculated.
  • step S145 the controller 120 calculates the target operation angle ⁇ t by multiplying the actual operation angle ⁇ ( ⁇ a and ⁇ b) acquired in step S100 by the correction coefficient K (Ka and Kb) calculated in step S140. Proceed to step S150.
  • step S150 the controller 120 determines whether or not a lever operation that reduces the actual operation angle ⁇ is being performed.
  • the current actual operation angle ⁇ is smaller than the actual operation angle ⁇ acquired in step S100 one control cycle before, an affirmative determination is made in step S150, the operation amount decrease flag is turned on, and the process proceeds to step S160.
  • step S150 if there is no difference between the current actual operation angle ⁇ and the actual operation angle ⁇ one control cycle before, the process proceeds to step S160 or step S170 depending on the state of the operation amount decrease flag. ing. That is, if the operation amount decrease flag is on, the process proceeds to step S160, and if the operation amount decrease flag is off, the process proceeds to step S170.
  • step S160 the controller 120 executes the first correction control and proceeds to step S190.
  • step S170 the controller 120 executes the second correction control and proceeds to step S190.
  • FIG. 9A is a flowchart showing the flow of the first correction control process. As shown in FIG. 9A, in the first correction control process, the operation reaction force F is determined based on the correction coefficient K calculated in step S140 and the threshold value stored in the storage device.
  • step S161 the controller 120 determines whether or not the correction coefficient K is less than the threshold value ⁇ . If a positive determination is made in step S161, the process proceeds to step S163, and if a negative determination is made in step S161, the process proceeds to step S165.
  • step S165 the controller 120 determines whether or not the correction coefficient K is greater than or equal to the threshold ⁇ and less than the threshold ⁇ . If an affirmative determination is made in step S165, the process proceeds to step S167, and if a negative determination is made in step S165, the process proceeds to step S169.
  • step S163 the controller 120 determines a value obtained by adding the correction amount ⁇ F (a constant value) stored in the storage device to the reference operation reaction force FB as the corrected operation reaction force F, and then proceeds to step 190.
  • ⁇ F a constant value
  • step S167 the controller 120 determines, as the corrected operation reaction force F, a value obtained by subtracting the correction amount ⁇ F (a constant value) stored in the storage device from the reference operation reaction force FB, and proceeds to step S190.
  • step S169 the controller 120 determines the reference reaction reaction force FB as the operation reaction force F to be generated as it is, and proceeds to step S190. That is, the reference operation reaction force is not corrected.
  • FIG. 9B is a flowchart showing the flow of the second correction control process. As shown in FIG. 9B, in the second correction control process, the operation reaction force F is determined based on the correction coefficient K calculated in step S140 and the threshold value stored in the storage device.
  • step S171 the controller 120 determines whether or not the correction coefficient K is greater than or equal to the threshold value ⁇ . If an affirmative determination is made in step S171, the process proceeds to step S173, and if a negative determination is made in step S171, the process proceeds to step S175.
  • step S175 the controller 120 determines whether or not the correction coefficient K is greater than or equal to the threshold ⁇ and less than the threshold ⁇ . If a positive determination is made in step S175, the process proceeds to step S177, and if a negative determination is made in step S175, the process proceeds to step S179.
  • step S173 the controller 120 determines the reference operation reaction force FB as the operation reaction force F to be generated as it is, and proceeds to step S190. That is, the reference operation reaction force is not corrected.
  • step S177 the controller 120 determines a value obtained by subtracting the correction amount ⁇ F (constant value) stored in the storage device from the reference operation reaction force FB as the corrected operation reaction force F, and the process proceeds to step S190.
  • step S179 the controller 120 determines a value obtained by adding the correction amount ⁇ F (constant value) stored in the storage device to the reference operation reaction force FB as the corrected operation reaction force F, and the process proceeds to step 190.
  • step S190 the controller 120 generates a control signal for generating the operation reaction force F determined in steps S160, S170, and S180, and uses the generated control signal as a reaction force applying device 111r. , 112r.
  • FIG. 10 is a diagram illustrating characteristics of the operation reaction force F generated by the reaction force applying devices 111r and 112r according to the actual operation angle ⁇ .
  • FIG. 10A shows the characteristics of the operation reaction force F that changes in accordance with the actual operation angle ⁇ when a lever operation is performed such that the actual operation angle ⁇ decreases.
  • FIG. 10B shows a characteristic of the operation reaction force F that changes in accordance with the actual operation angle ⁇ when a lever operation is performed such that the actual operation angle ⁇ increases.
  • the horizontal axis represents the actual operation angle ⁇
  • the vertical axis represents the operation reaction force F.
  • the operator operates the operation levers 111 and 112 to sequentially arrange the toes Pb of the bucket 106 at the first position P1 and the second position P2, and set the positions at the respective positions.
  • a switch (not shown) is operated, and the numerical values of the excavation depths h1 and h2 at that position are input by a depth setting switch (not shown).
  • the target trajectory TL is set by the controller 120 and stored in the storage device.
  • the operator operates the operation levers 111 and 112 to perform the slope leveling work.
  • the position of the toe Pb of the bucket 106 is positioned on the target locus TL, and an operation guide switch (not shown) is operated. Thereby, the correction control of the operation reaction force is executed according to the operation after the switch operation.
  • the first correction control is executed (Yes in step S150, S160).
  • the operation reaction force F is corrected so as to increase by ⁇ F from the reference operation reaction force FB determined by the characteristic N (step S163). For this reason, the operator feels a larger reaction force than usual.
  • the operator can know that the actual operation angle ⁇ is too large compared to the target operation angle ⁇ t by feeling a large operation reaction force.
  • the operation reaction force F gradually increases as the actual operation angle ⁇ decreases, as shown in FIG. Get smaller.
  • the operation reaction force F is ⁇ F more than the reference operation reaction force FB determined by the characteristic N. Correction is made to decrease (step S167).
  • the operation angle ⁇ 2 is an operation angle at which the correction coefficient K becomes the threshold value ⁇ .
  • the operator can know that the actual operation angle ⁇ has approached the target operation angle ⁇ t by feeling that the operation reaction force F has decreased discontinuously. Thereby, the operator maintains the operation lever R so as not to change the actual operation angle ⁇ .
  • the operation lever R When the operation lever R is operated so that the actual operation angle ⁇ becomes smaller than the target operation angle ⁇ t, and the actual operation angle ⁇ becomes smaller than the operation angle ⁇ 1 (No in step S161, No in S165), the operation counterclockwise The force F becomes the reference operation reaction force FB determined by the characteristic N (step S169).
  • the operation angle ⁇ 1 is an operation angle at which the correction coefficient K becomes the threshold value ⁇ .
  • the operator can know that the actual operation angle ⁇ has become too small beyond the target operation angle ⁇ t by feeling that the operation reaction force F has increased discontinuously. Thereby, the operator performs an operation of returning the operation lever R so that the actual operation angle ⁇ approaches the target operation angle ⁇ t.
  • the second correction control is executed (No in step S150).
  • S170 The operation angle ⁇ s2 is a case where the actual operation angle ⁇ is smaller than the target operation angle ⁇ t, and the difference between the actual operation angle ⁇ and the target operation angle ⁇ t is within a preset range ( ⁇ or more and less than ⁇ ). (No in step S171, Yes in S175).
  • the operation reaction force F is corrected so as to decrease by ⁇ F from the reference operation reaction force FB determined by the characteristic N (step S177). For this reason, the operator feels an operation reaction force smaller than usual.
  • the operator can know that the actual operation angle ⁇ is too small compared to the target operation angle ⁇ t by feeling a small operation reaction force.
  • the operation reaction force F gradually increases as the actual operation angle ⁇ increases as shown in FIG. .
  • step S179 When the actual operation angle ⁇ becomes larger than the operation angle ⁇ 2 close to the target operation angle ⁇ t (No in step S171, No in step S175), the operation reaction force F is greater than the reference operation reaction force FB determined by the characteristic N by ⁇ F. It is corrected so as to increase (step S179).
  • the operator can know that the actual operation angle ⁇ has become too large beyond the target operation angle ⁇ t by feeling that the operation reaction force F has increased discontinuously. Thereby, the operator performs an operation of returning the operation lever R so that the actual operation angle ⁇ approaches the target operation angle ⁇ t.
  • the operator feels that the operation reaction force F has increased discontinuously, so that the operation lever R is operated such that the actual operation angle ⁇ moves away from the target operation angle ⁇ t, that is, reverse to the operation toward the target. It can be known that the operation is executed. Thereby, the operator performs an operation of returning the operation lever R so that the actual operation angle ⁇ t approaches the target operation angle ⁇ t.
  • the operator is guided so that the operation of moving the position of the toe Pb of the bucket 106 along the target locus TL is performed. can do.
  • the controller 120 drives the front member. Correction for increasing the operation reaction force applied by the reaction force applying devices 111r and 112r to the operation levers 111 and 112 for operating the actuators 103a and 104a is executed.
  • Correction is performed to reduce the operation reaction force applied by the reaction force applying devices 111r and 112r to the operation levers 111 and 112 that operate the actuators 103a and 104a that drive the front member.
  • the operation can be guided so that an appropriate operation for moving the toe Pb of the bucket 106 along the target locus TL is performed.
  • the magnitude of the operation reaction force that has been corrected to reduce the operation reaction force applied by the reaction force application devices 111r and 112r is such that the operation levers 111 and 112 are at a neutral position when the operation levers 111 and 112 are not operated. It is more than the magnitude
  • the controller 120 increases the operation reaction force when an operation that increases the difference between the target operation angle ⁇ t and the actual operation angle ⁇ is executed. Thereby, the operator can know that the operation lever R is operated so that the actual operation angle ⁇ is away from the target operation angle ⁇ t by feeling that the operation reaction force F has increased.
  • the controller 120 determines whether or not the actual operation angle ⁇ is within a preset operation range ( ⁇ 1 to ⁇ 2) including the target operation angle ⁇ t.
  • the controller 120 determines that the actual operation angle ⁇ is within a preset operation range ( ⁇ 1 to ⁇ 2) including the target operation angle ⁇ t, the controller 120 applies reaction force applying devices 111r and 112r to the operation levers 111 and 112. A correction that reduces the applied reaction force is executed.
  • the operator can know that the actual operation angle ⁇ has approached the target operation angle ⁇ t by feeling that the operation reaction force has decreased. Thereby, the operator can easily perform an appropriate work along the target locus TL.
  • the actual speed vector VAc of the toe Pb of the bucket 106 is calculated, and the norm of the target speed vector VTc is determined as the same value as the norm of the actual speed vector VAc. That is, the target speed of the toe Pb of the bucket 106 is determined as the same value as the actual speed. Thereby, the toe Pb can be operated smoothly.
  • the posture calculation unit 121 corresponds to a position detection unit
  • a partial function of the reaction force correction unit 129 corresponds to a target arrival determination unit.
  • Fig.11 (a) is a figure similar to Fig.10 (a), and is a figure which shows the modification of the correction method of operation reaction force.
  • FIG. 11A the characteristic of the operation reaction force in the above-described embodiment is indicated by a two-dot chain line.
  • the operation reaction force increases to the reference operation reaction force FB. .
  • FIG.11 (b) is a figure similar to FIG.10 (b), and is a figure which shows the modification of the correction method of operation reaction force.
  • FIG.11 (b) the characteristic of the operation reaction force in embodiment mentioned above is shown with the dashed-two dotted line.
  • the operation reaction increased by the correction amount ⁇ F from the reference operation reaction force FB. This is a characteristic that generates force.
  • the second correction control has a characteristic that the operation reaction force F increases linearly as the actual operation angle ⁇ increases from the operation angle ⁇ 0 toward the target operation angle ⁇ t.
  • the operation reaction force decreases discontinuously. It is considered to be a characteristic.
  • an operation reaction force F that is reduced by a correction amount ⁇ F / 2 from the reference operation reaction force FB is generated at the operation angles ⁇ 0 to ⁇ 1, and a correction amount from the reference operation reaction force FB at the operation angles ⁇ 1 to ⁇ 2.
  • the operation reaction force F may be continuously changed according to the increase and decrease in the actual operation angle ⁇ .
  • the correction amount ⁇ F changes according to the actual operation angle ⁇ .
  • the ratio (inclination) of the change amount of the operation reaction force F to the change amount of the actual operation angle ⁇ may be set so that the operator can understand the change of the operation reaction force F.
  • the target speed calculation unit 124 calculates the target speed vector VTc when the current tiptoe Pb is on the target locus TL has been described, but the present invention is not limited to this.
  • the target speed calculation unit 124 calculates a transition target locus TLt that allows the toe Pb to move smoothly toward the target locus TL.
  • a target speed vector VTc is calculated based on the target locus TLt.
  • the calculation method of the actual speed vector VAc, the arm speed vector VAa, and the boom speed vector VAb is not limited to the above-described embodiment.
  • the arm speed vector VAa is calculated based on the actual operating angle ⁇ a of the left operating lever 111
  • the boom speed vector VAb is calculated based on the actual operating angle ⁇ b of the right operating lever 112, and both are combined to obtain the actual speed vector.
  • VAc may be calculated.
  • reaction force applying devices 111r and 112r are configured by a plurality of electromagnetic motors
  • You may comprise a reaction force provision apparatus by the coil spring and the piston which changes the full length of a coil spring.
  • the reaction force may be generated using pressure such as hydraulic pressure or pneumatic pressure.
  • the reaction force applying device may be configured by a reaction force cylinder and an electromagnetic proportional valve that controls driving of the reaction force cylinder.
  • the crawler type backhoe has been described as an example, but the present invention is not limited to this.
  • a construction machine including a front working device having a plurality of front members including at least two or more front members along a target locus TL, such as a loading excavator or a wheeled hydraulic excavator, including at least two or more
  • the present invention can be applied to various construction machines in which the front member is operated in combination.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Paleontology (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

建設機械は、フロント部材の目標操作量と実操作量との差が、予め設定した範囲よりも大きい場合、そのフロント部材を駆動するアクチュエータを操作する操作部に対して反力付与装置により付与される操作反力を増加させる補正を実行し、上記範囲内の場合、そのフロント部材を駆動するアクチュエータを操作する操作部に対して反力付与装置により付与される操作反力を減少させる補正を実行する反力補正制御部を有する制御装置を備えている。

Description

建設機械
　本発明は、建設機械に関する。
　ブーム、アーム、バケットなどの複数のフロント部材で構成されるフロント作業装置を備えた油圧ショベルなどの建設機械が知られている（特許文献１参照）。フロント作業装置は、各フロント部材のそれぞれに対応した操作部材が操作されることで駆動される。特許文献１に記載の建設機械の操作装置は、各操作部材の操作によるフロント作業装置の作業範囲境界への接近の度合いに応じた操作反力を各操作部材の操作に対してそれぞれ付与するように反力付与手段を制御する反力制御手段を備えている。
　特許文献１に記載の反力制御手段は、フロント作業装置の姿勢と各操作部材の操作とに基づき、各操作部材の操作による所定時間後のフロント作業装置と作業範囲境界との距離をそれぞれ演算する。反力制御手段は、演算された距離が、フロント作業装置の現在位置と作業範囲境界との距離よりも短くなるような操作部材の操作に対してのみ、操作反力を付与するように反力付与手段を制御する。
日本国特開２００５－３２０８４６号公報
　フロント作業装置は、複数のフロント部材により構成されているため、たとえば、直線掘削作業など、バケットの爪先を直線的な目標軌跡に沿って動かす作業を行う場合、複数のフロント部材を複合的に動作させる必要があり、操作に熟練を要していた。また、熟練したオペレータであっても、高精度かつ高速な作業は容易ではなく、長時間作業を行うと疲労を招いて作業効率が低下するという問題がある。
　特許文献１では、操作反力を用いて操作者を補助することについて提案されているが、上記問題点を解決することができるものではなかった。
　本発明の一態様によると、建設機械は、少なくとも第１フロント部材および第２フロント部材を含む複数のフロント部材を有するフロント作業装置、ならびに複数のフロント部材を駆動する複数のアクチュエータ、ならびに複数のアクチュエータを操作する操作部を備えた建設機械において、操作部に対して、実操作量に基づき操作反力を付与する反力付与装置と、この反力付与装置に対する制御信号を生成するために、操作部の実操作量を検出する操作量検出部と、フロント作業装置の予め設定された部位の目標軌跡を決定する軌跡決定部と、複数のフロント部材が駆動することにより移動するフロント作業装置の予め設定された部位の位置を検出する位置検出部と、目標軌跡に沿うようにフロント作業装置の予め設定された部位の目標速度を決定する目標速度決定部と、目標速度に基づいて、少なくとも第１フロント部材および第２フロント部材のそれぞれの目標操作量を決定する目標操作量決定部と、フロント部材の目標操作量と実操作量との差が、予め設定した範囲よりも大きい場合、そのフロント部材を駆動するアクチュエータを操作する操作部に対して反力付与装置により付与される操作反力を増加させる補正を実行し、範囲内の場合、そのフロント部材を駆動するアクチュエータを操作する操作部に対して反力付与装置により付与される操作反力を減少させる補正を実行する反力補正制御部とを有する制御装置とを備えている。
　本発明によれば、目標軌跡に沿った作業を簡単に行うことができ、作業効率の向上を図ることができる。
本実施の形態が適用される建設機械の側面図。 本実施の形態に係るコントローラの概略構成を示す図。 左操作レバーと右操作レバーの操作方向に対応する油圧ショベルの動作を説明する図。 目標軌跡ＴＬの決定方法について説明する図。 斜面の均し作業を示す図。 （ａ）は、爪先Ｐｂの実速度ベクトルＶＡｃを表す図。（ｂ）は、爪先Ｐｂの目標速度ベクトルＶＴｃを表す図。 実操作角θと基準操作反力ＦＢとの関係を示す図。 コントローラにより実行される操作反力制御プログラムによる処理の一例を示すフローチャート。 コントローラにより実行される操作反力制御プログラムによる第１補正制御処理および第２補正制御処理の一例を示すフローチャート。 実操作角θに応じて、反力付与装置により発生される操作反力Ｆの特性を示す図。 操作反力の補正方法の変形例（変形例１－１，１－２，１－３）を示す図。 操作反力の補正方法の変形例（変形例１－４）を示す図。
　図１は、本実施の形態が適用される建設機械の一例である油圧ショベル（バックホウ）１００の側面図である。なお、説明の便宜上、図１に示したように前後および上下方向を規定する。図１に示すように、油圧ショベル１００は、走行体１０１と、走行体１０１上に旋回可能に搭載された旋回体１０２とを備える。走行体１０１は、左右一対のクローラを走行モータによって駆動することにより走行する。
　旋回体１０２の前部左側には運転室１０７が設けられ、運転室１０７の後部にはエンジン室が設けられている。エンジン室には、動力源であるエンジンや油圧機器等が収容されている。エンジン室の後部には、作業時の機体のバランスをとるためのカウンタウエイト１０９が取り付けられている。旋回体１０２の前部右側にはフロント作業装置１０３が設けられている。
　フロント作業装置１０３は、複数のフロント部材、すなわちブーム１０４、アーム１０５、および、バケット１０６を備える。ブーム１０４は、基端部が旋回体１０２の前部に回動可能に取り付けられている。アーム１０５は、その一端がブーム１０４の先端に回動可能に取り付けられている。ブーム１０４およびアーム１０５は、ブームシリンダ１０４ａおよびアームシリンダ１０５ａによってそれぞれ駆動されて起伏する。バケット１０６は、アーム１０５の先端において、アーム１０５に対して上下方向に回動可能に取り付けられ、バケットシリンダ１０６ａによって駆動される。
　図２は、本実施の形態に係るコントローラ１２０の概略構成を示す図である。油圧ショベル１００は、コントローラ１２０を備えている。コントローラ１２０は、ＣＰＵや記憶装置であるＲＯＭおよびＲＡＭ、その他の周辺回路などを有する演算処理装置を含んで構成され、油圧ショベル１００の各部の制御を行っている。
　コントローラ１２０には、運転室１０７内に配設される電気式の左操作レバー１１１の操作方向および実操作角に相当する信号を出力する操作量センサ１１１ｄおよび電気式の右操作レバー１１２の操作方向および実操作角に相当する信号を出力する操作量センサ１１２ｄが接続されている。実操作角（実操作量）とは、操作レバー１１１，１１２の中立位置ＮＰからの傾き角である。コントローラ１２０には、左操作レバー１１１および右操作レバー１１２の操作方向および実操作角θに相当する信号が入力される。コントローラ１２０は、操作量検出部１２０ｄを機能的に備えている。操作量検出部１２０ｄは、各操作量センサ１１１ｄ，１１２ｄからの信号に基づいて、左操作レバー１１１および右操作レバー１１２の操作方向および実操作角θを検出する。図３は、左操作レバー１１１と右操作レバー１１２の操作方向に対応する油圧ショベル１００の動作を説明する図である。左操作レバー１１１は運転席の左側に位置し、右操作レバー１１２は運転席の右側に位置している。
　左操作レバー１１１は、ブーム１０４に対するアーム１０５の回動動作、および、旋回体１０２の旋回動作を操作する操作部材である。左操作レバー１１１を中立位置ＮＰから前方に傾けると、アーム押し動作が行われる。アーム押し動作とは、アームシリンダ１０５ａが収縮し、ブーム１０４に対し、アーム１０５の相対角度が広がる方向に、アーム１０５が実操作角に応じた速度で回動する（図１において時計回りに回動する）動作である。左操作レバー１１１を中立位置ＮＰから後方に傾けると、アーム引き動作が行われる。アーム引き動作とは、アームシリンダ１０５ａが伸長し、アーム１０５をブーム１０４側に折りたたむように、アーム１０５が実操作角に応じた速度で回動する（図１において反時計回りに回動する）動作である。
　左操作レバー１１１を中立位置ＮＰから左方に傾けると、旋回モータ（不図示）が駆動され、旋回体１０２が実操作角に応じた速度で左旋回する。左操作レバー１１１を中立位置ＮＰから右方に傾けると、旋回モータ（不図示）が駆動され、旋回体１０２が実操作角に応じた速度で右旋回する。
　右操作レバー１１２は、旋回体１０２に対するブーム１０４の回動動作、および、アーム１０５に対するバケット１０６の回動動作を操作する操作部材である。右操作レバー１１２を中立位置ＮＰから前方に傾けると、ブーム下げ動作が行われる。ブーム下げ動作とは、ブームシリンダ１０４ａが収縮し、ブーム１０４が実操作角に応じた速度で下方に回動する動作である。右操作レバー１１２を中立位置ＮＰから後方に傾けると、ブーム上げ動作が行われる。ブーム上げ動作とは、ブームシリンダ１０４ａが伸長し、ブーム１０４が実操作角に応じた速度で上方に回動する動作である。
　右操作レバー１１２を中立位置ＮＰから左方に傾けると、バケット掘削動作が行われる。バケット掘削動作とは、バケットシリンダ１０６ａが伸長し、バケット１０６の爪先（先端）Ｐｂがアーム１０５の腹面に近づくように、バケット１０６が実操作角に応じた速度で回動する（図１において反時計回りに回動する）動作である。右操作レバー１１２を中立位置ＮＰから右方に傾けると、バケット放土動作が行われる。バケット放土動作とは、バケットシリンダ１０６ａが収縮し、バケット１０６の爪先Ｐｂがアーム１０５の腹面から離れるように、バケット１０６が実操作角に応じた速度で回動する（図１において時計回りに回動する）動作である。
　左操作レバー１１１を中立位置ＮＰから左斜め前方などの斜め方向に傾けると、アーム１０５と旋回体１０２を複合的に動作させることができる。右操作レバー１１２を中立位置ＮＰから左斜め前方などの斜め方向に傾けると、ブーム１０４とバケット１０６を複合的に動作させることができる。このため、本実施の形態における油圧ショベル１００では、左操作レバー１１１および右操作レバー１１２を同時に操作することで、最大、４つの動作を複合的に行わせることができる。
　図２に示すように、コントローラ１２０には、左操作レバー１１１に対してオペレータの操作方向とは反対側の力である操作反力を発生させる反力付与装置１１１ｒが接続されている。コントローラ１２０には、右操作レバー１１２に対してオペレータの操作方向とは反対側の力である操作反力を発生させる反力付与装置１１２ｒが接続されている。
　反力付与装置１１１ｒおよび反力付与装置１１２ｒは、同様の構成であり、複数の電磁モータなどの電磁アクチュエータで構成することができる。後述するように、コントローラ１２０が決定した操作反力を表す制御信号が反力付与装置１１１ｒ，１１２ｒに出力されると、反力付与装置１１１ｒ，１１２ｒにより、左操作レバー１１１および右操作レバー１１２に対して操作反力が発生する。
　コントローラ１２０には、コントロールバルブ１０８が接続される。コントローラ１２０は、上述した左操作レバー１１１および右操作レバー１１２の操作方向および実操作角に基づいて、コントロールバルブ１０８を制御する制御信号を出力する。コントロールバルブ１０８はコントローラ１２０からの制御信号に応じて切り換えられる。コントロールバルブ１０８は、図示しない油圧ポンプから各フロント部材のアクチュエータ（ブームシリンダ１０４ａ、アームシリンダ１０５ａおよびバケットシリンダ１０６ａ）に供給される圧油の流れを制御する。このため、各フロント部材は、左操作レバー１１１および右操作レバー１１２の操作方向に応じた動作を、実操作角に応じた速度で駆動される。
　コントローラ１２０には、フロント部材の位置を求めるための複数の角度センサが接続され、各角度センサで検出された信号が入力される。複数の角度センサには、ブーム角度センサ１１０ａと、アーム角度センサ１１０ｂと、バケット角度センサ１１０ｃとが含まれる。ブーム角度センサ１１０ａは、ブーム１０４と旋回体１０２との接続部に設けられ、旋回体１０２に対するブーム１０４の回動角度を検出する。アーム角度センサ１１０ｂは、ブーム１０４とアーム１０５との接続部に設けられ、ブーム１０４に対するアーム１０５の回動角度を検出する。バケット角度センサ１１０ｃは、アーム１０５とバケット１０６との接続部に設けられ、アーム１０５に対するバケット１０６の回動角度を検出する。
　コントローラ１２０は、姿勢演算部１２１と、目標軌跡決定部１２２と、実速度演算部１２３と、目標速度演算部１２４と、ベクトル分解部１２５と、目標操作量演算部１２６と、基準反力演算部１２７と、判定部１２８と、反力補正部１２９とを備える。
　姿勢演算部１２１は、油圧ショベル１００の姿勢、すなわちフロント作業装置１０３を構成する各フロント部材であるブーム１０４、アーム１０５およびバケット１０６の位置を演算する。コントローラ１２０の記憶装置には、各フロント部材および旋回体１０２、走行体１０１の各部寸法の情報が記憶されている。
　コントローラ１２０は、フロント部材の各部の寸法と、ブーム角度センサ１１０ａ、アーム角度センサ１１０ｂおよびバケット角度センサ１１０ｃで検出した情報を用いてバケット１０６の爪先Ｐｂを含む各フロント部材における予め設定された部位の位置を演算する。フロント部材の各部の寸法としては、ブーム１０４の回動支点からアーム１０５の回動支点までの寸法、アーム１０５の回動支点からバケット１０６の回動支点までの寸法、および、バケット１０６の回動支点からバケット１０６の爪先Ｐｂまでの寸法が含まれる。姿勢演算部１２１は、所定の制御周期ごとにバケット１０６の爪先Ｐｂの位置を演算する。
　つまり、本実施の形態では、複数の角度センサ１１０ａ，１１０ｂ，１１０ｃからの情報と、複数のフロント部材の寸法の情報とから、複数のフロント部材が駆動することにより移動するバケット１０６の爪先Ｐｂの位置を検出することができる。
　目標軌跡決定部１２２は、バケット１０６の爪先Ｐｂの目標軌跡を決定する。図４を参照して目標軌跡の決定方法の一例を説明する。図４は、目標軌跡ＴＬの決定方法について説明する図である。図４に示すように、オペレータがバケット１０６の爪先Ｐｂを第１の位置Ｐ１に配置し、位置設定スイッチ（不図示）を操作し、深さ設定スイッチ（不図示）により掘削深さｈ１の数値を入力する。これにより、目標軌跡決定部１２２は第１の位置Ｐ１から掘削深さｈ１だけ下方に離れた位置を第１設定点Ｐ１Ｔとして記憶装置に記憶させる。
　オペレータがバケット１０６の爪先Ｐｂを第１の位置Ｐ１とは異なる第２の位置Ｐ２に配置し、位置設定スイッチ（不図示）を操作し、深さ設定スイッチ（不図示）により掘削深さｈ２の数値を入力する。これにより、目標軌跡決定部１２２は第２の位置Ｐ２から掘削深さｈ２だけ下方に離れた位置を第２設定点Ｐ２Ｔとして記憶装置に記憶させる。なお、第１設定点Ｐ１Ｔおよび第２設定点Ｐ２Ｔは、たとえば、基準位置である旋回中心点ＢＰからの水平方向距離と、旋回中心点ＢＰからの鉛直方向距離とで特定され、記憶装置に記憶される。
　目標軌跡決定部１２２は、第１の位置Ｐ１から深さｈ１だけ下方に位置した第１設定点Ｐ１Ｔと、第２の位置Ｐ２から深さｈ２だけ下方に位置した第２設定点Ｐ２Ｔとを結んだ直線式を計算して、目標軌跡ＴＬとして設定する。
　図５は、直線掘削作業の一例である斜面の均し作業を示す図である。図５に示す斜面の均し作業では、アーム引き動作と、ブーム上げ動作を複合することで実現できる。本実施の形態では、手動で操作を行う場合において、図５に示すように、バケット１０６の爪先Ｐｂが目標軌跡ＴＬに沿って移動するように、左操作レバー１１１および右操作レバー１１２に作用する操作反力を調整し、オペレータに対して適切な操作を促す反力補正制御が実行される。なお、本実施の形態では、説明の便宜上、バケット１０６および旋回体１０２を動作させる操作は実行しない場合における操作反力の補正制御について説明する。
　図２に示す実速度演算部１２３は、爪先Ｐｂの実速度ベクトルＶＡｃを演算する。図６（ａ）は、爪先Ｐｂの実速度ベクトルＶＡｃを表す図である。実速度演算部１２３は、姿勢演算部１２１により演算された現時点のバケット１０６の位置と、１制御周期前に姿勢演算部１２１により演算されたバケット１０６の位置との差、ならびに１制御周期の時間に基づいて、バケット１０６の爪先Ｐｂの実速度ベクトルＶＡｃを演算する。
　図２に示す目標速度演算部１２４は、目標軌跡ＴＬに沿うように爪先Ｐｂの目標速度ベクトルＶＴｃを決定する。図６（ｂ）は、爪先Ｐｂの目標速度ベクトルＶＴｃを表す図である。図６（ｂ）に示すように、爪先Ｐｂが目標軌跡ＴＬ上に位置している場合、爪先Ｐｂの目標速度ベクトルＶＴｃの方向は、目標軌跡ＴＬと平行な方向となる。また、本実施の形態では、爪先Ｐｂの目標速度ベクトルＶＴｃのノルムは、実速度ベクトルＶＡｃのノルムと同じ値に設定される（｜｜ＶＴｃ｜｜＝｜｜ＶＡｃ｜｜）。つまり、爪先Ｐｂの実速度の大きさを目標速度の大きさとして代用する。
　図２に示すベクトル分解部１２５は、現時点におけるフロント作業装置１０３の姿勢に基づいて、図６（ａ）に示すように、実速度ベクトルＶＡｃをアーム速度ベクトルＶＡａとブーム速度ベクトルＶＡｂとに分解する。ベクトル分解部１２５は、現時点におけるフロント作業装置１０３の姿勢に基づいて、図６（ｂ）に示すように、目標速度ベクトルＶＴｃをアーム速度ベクトルＶＴａとブーム速度ベクトルＶＴｂとに分解する。
　アーム速度ベクトルＶＡａ，ＶＴａは、ブーム１０４に対するアーム１０５の回動動作に起因する速度ベクトルであり、その方向はアーム１０５の回動支点（ブーム１０４との接続点）と爪先Ｐｂとを結ぶ直線に対して垂直な方向である。ブーム速度ベクトルＶＡｂ，ＶＴｂは、旋回体１０２に対するブーム１０４の回動動作に起因する速度ベクトルであり、その方向はブーム１０４の回動支点（旋回体１０２との接続点）と爪先Ｐｂとを結ぶ直線に対して垂直な方向である。
　図２に示す目標操作量演算部１２６は、目標値であるアーム速度ベクトルＶＴａのノルムを実測値であるアーム速度ベクトルＶＡａのノルムで割ることで補正係数Ｋａを演算する（Ｋａ＝｜｜ＶＴａ｜｜／｜｜ＶＡａ｜｜）。目標操作量演算部１２６は、目標値であるブーム速度ベクトルＶＴｂのノルムを実測値であるブーム速度ベクトルＶＡｂのノルムで割ることで補正係数Ｋｂを演算する（Ｋｂ＝｜｜ＶＴｂ｜｜／｜｜ＶＡｂ｜｜）。
　補正係数Ｋａ，Ｋｂは、実操作角と目標操作角との差に相当する係数となり、実操作角θに補正係数Ｋａ，Ｋｂを乗じることで目標操作角θｔが得られる。つまり、補正係数が１の場合、目標操作角θｔと実操作角θは一致していることを表している。補正係数が１よりも大きい場合、目標操作角θｔよりも実操作角θが小さいことを表し、補正係数が１よりも小さい場合、目標操作角θｔよりも実操作角θが大きいことを表している。
　目標操作量演算部１２６は、左操作レバー１１１のアーム引き動作方向の実操作角θ（以下、実操作角θａとも記す）に補正係数Ｋａを乗じて、目標となるアーム速度ベクトルＶＴａを発生させる目標操作角θｔを求める（θｔ＝Ｋａ・θａ）。目標操作量演算部１２６は、右操作レバー１１２のブーム上げ動作方向の実操作角θ（以下、実操作角θｂとも記す）に補正係数Ｋｂを乗じて、目標となるブーム速度ベクトルＶＴｂを発生させる目標操作角θｔを求める（θｔ＝Ｋｂ・θｂ）。
　基準反力演算部１２７は、実操作角θに基づいて、反力付与装置１１１ｒ，１１２ｒにより発生させる操作反力Ｆを決定する。図７は、実操作角θと基準操作反力ＦＢとの関係を示す図である。コントローラ１２０の記憶装置には、左操作レバー１１１および右操作レバー１１２の実操作角θａ，θｂの増加にしたがって大きくなる基準操作反力ＦＢの特性Ｎａ，Ｎｂがルックアップテーブル形式で記憶されている。後述する操作反力の補正がなされない場合、この特性Ｎａ，Ｎｂにしたがって実操作角θａ，θｂに応じた操作反力Ｆが、反力付与装置１１１ｒ，１１２ｒによって操作レバー１１１，１１２に付与される。
　実操作角θａに基づく特性Ｎａと実操作角θｂに基づく特性Ｎｂは、同一の特性でもよいし、異なる特性でもよい。本実施の形態では、特性Ｎａと特性Ｎｂが同一であるとして、特性Ｎａ，Ｎｂを総称して特性Ｎと記し、実操作角θａと実操作角θｂを総称して実操作角θと記し、説明する。なお、左操作レバー１１１および右操作レバー１１２については、総称して、単に操作レバーＲとも記す。
　特性Ｎは、実操作角θが増加するにしたがって、基準操作反力ＦＢが直線的に増加する特性であり、その最大値はＦｍａｘである。基準反力演算部１２７は、操作レバーＲが前後方向に操作されると、特性Ｎを参照し、操作量センサ１１１ｄ，１１２ｄで検出された実操作角θに応じた基準操作反力ＦＢを演算する。
　図２に示す判定部１２８は、操作レバーＲの実操作角θが増加したか、減少したか、あるいは変更が無いかを判定する。判定部１２８は、現時点において操作量センサ１１１ｄ，１１２ｄで検出された実操作角θと、１制御周期前に操作量センサ１１１ｄ，１１２ｄで検出された実操作角θとを比較する。判定部１２８は、現時点の実操作角θが１制御周期前の実操作角θよりも大きい場合、操作レバーＲの実操作角θが増加したと判定する。判定部１２８は、現時点の実操作角θが１制御周期前の実操作角θに比べて小さい場合、操作レバーＲの実操作角θが減少したと判定する。判定部１２８は、現時点の実操作角θが１制御周期前の実操作角θと同じである場合、操作レバーＲの実操作角θに変更が無いと判定する。
　反力補正部１２９は、補正係数Ｋａ，Ｋｂに基づいて、操作反力の補正を行う。以下、反力補正部１２９による操作反力の補正の制御内容について説明する。左操作レバー１１１に対する操作反力Ｆの補正の制御と、右操作レバー１１２に対する操作反力Ｆの補正の制御とは略同様である。このため、左操作レバー１１１および右操作レバー１１２を総称して操作レバーＲとして、操作レバーＲに対する操作反力Ｆの補正の制御について説明する。なお、補正係数Ｋａ，Ｋｂについては総称して補正係数Ｋと記し、実操作角θａ，θｂについては上述と同様に総称して実操作角θと記す。
　反力補正部１２９は、操作レバーＲの実操作角θの変化にしたがって、第１補正制御および第２補正制御のいずれかを実行する。判定部１２８により、操作レバーＲの実操作角θが減少していると判定された場合、第１補正制御を実行する。第１補正制御は、判定部１２８により、操作レバーＲの実操作角θが増加していると判定されるまで継続される。
　反力補正部１２９は、判定部１２８により、操作レバーＲの実操作角θが増加していると判定された場合、第２補正制御を実行する。第２補正制御は、判定部１２８により、操作レバーＲの実操作角θが減少していると判定されるまで継続される。
－第１補正制御（実操作角減少時の反力の補正制御）－
　反力補正部１２９による第１補正制御について説明する。反力補正部１２９は、補正係数Ｋが閾値β未満であるか否か、ならびに、補正係数Ｋが閾値α以上であるか否かを判定する。閾値αは、１よりも大きい値であり、予め記憶装置に記憶されている（α＞１）。閾値βは、１よりも小さい値であり、予め記憶装置に記憶されている（β＜１）。
　閾値αおよび閾値βは、目標軌跡ＴＬの許容範囲に応じて設定される。許容範囲は、図６に示すように、目標軌跡ＴＬから上方に所定量だけオフセットされた目標軌跡上限ＴＬＵと、目標軌跡ＴＬから下方に所定量だけオフセットされた目標軌跡下限ＴＬＬとの間の範囲である。許容範囲は、要求される斜面の精度に応じて設定されるものである。なお、許容範囲は、オペレータにより任意に設定変更できる構成とすることもできる。目標軌跡ＴＬから目標軌跡上限ＴＬＵまでの距離と、目標軌跡ＴＬから目標軌跡下限ＴＬＬまでの距離は、異なる値としてもよいし、同じ値としてもよい。
　実操作角と目標操作角との差が大きく、補正係数Ｋが閾値β未満であると判定された場合、反力補正部１２９は、補正量ΔＦを基準操作反力ＦＢに加算して、操作反力Ｆを補正する（Ｆ＝ＦＢ＋ΔＦ）。実操作角と目標操作角との差に相当する補正係数Ｋが、予め設定した閾値β以上、かつ、閾値α未満であると判定された場合、反力補正部１２９は、実操作角θが目標操作角θｔに到達したと判定する。実操作角θが目標操作角θｔに到達したと判定されると、反力補正部１２９は、補正量ΔＦを基準操作反力ＦＢから減算して、操作反力Ｆを補正する（Ｆ＝ＦＢ－ΔＦ）。補正係数Ｋが閾値α以上であると判定された場合、反力補正部１２９は、補正を行わずに、基準操作反力ＦＢをそのまま操作反力Ｆとして出力する（Ｆ＝ＦＢ）。
　なお、図１０に示すθ１は補正係数Ｋが閾値αとなる実操作角θであり、操作角θ２は補正係数Ｋが閾値βとなる実操作角θである。つまり、補正係数Ｋがβ以上α未満であるときには、実操作角θが目標操作角θｔを含む予め設定した操作範囲内（図１０（ａ）のθ１～θ２）にあることを意味する。
－第２補正制御（実操作角増加時の反力の補正制御）－
　反力補正部１２９による第２補正制御について説明する。反力補正部１２９は、補正係数Ｋが閾値γ以上であるか否か、ならびに、補正係数Ｋが閾値β未満であるか否かを判定する。閾値γは、閾値αよりも大きい値であり、予め記憶装置に記憶されている（γ＞α）。
　閾値γは、特性Ｎによって決定された基準操作反力ＦＢから補正量ΔＦだけ減少させる補正を実行した操作反力Ｆの大きさが、少なくとも操作レバーＲの非操作時に操作レバーＲが中立位置ＮＰに戻る大きさ以上となるように設定されている。本実施の形態では、操作反力Ｆの補正制御を実行する実操作角θの下限値は、補正係数Ｋが閾値γとなる操作角θ０となる（図１０（ｂ）参照）。換言すれば、実操作角θが操作角θ０よりも小さいときは、操作反力Ｆの補正制御は実行されない。実操作角θが操作角θ０のときの操作反力Ｆ０は、オペレータが操作レバーＲを放した後、操作レバーＲの機械抵抗（連結構造の摩擦等）に抗して、操作レバーＲが中立位置ＮＰに戻ることのできる大きさ以上の操作反力である。
　補正係数Ｋが閾値γ以上であると判定された場合、反力補正部１２９は、補正を行わずに、基準操作反力ＦＢをそのまま操作反力Ｆとして出力する（Ｆ＝ＦＢ）。
　実操作角と目標操作角との差に相当する補正係数Ｋが、予め設定した閾値β以上、かつ、閾値γ未満の範囲内であると判定された場合、反力補正部１２９は、実操作角θが目標操作角θｔを含む予め設定した操作範囲内（図１０（ｂ）のθ０～θ２）にあると判定する。実操作角θが上記操作範囲内（図１０（ｂ）のθ０～θ２）にあると判定されたとき、反力補正部１２９は、補正量ΔＦを基準操作反力ＦＢから減算して、操作反力Ｆを補正する（Ｆ＝ＦＢ－ΔＦ）。実操作角と目標操作角との差が大きく、補正係数Ｋが閾値β未満であると判定された場合、反力補正部１２９は、補正量ΔＦを基準操作反力ＦＢに加算して、操作反力Ｆを補正する（Ｆ＝ＦＢ＋ΔＦ）。
　補正量ΔＦは、正の値であり、予め記憶装置に記憶されている（ΔＦ＞０）。なお、左操作レバー１１１に対する操作反力の補正量ΔＦと、右操作レバー１１２に対する操作反力の補正量ΔＦとは、同じ値としてもよいし、異なる値としてもよい。
　図２に示す判定部１２８は、基準反力演算部１２７により特性Ｎに基づいて決定された基準操作反力ＦＢを補正する制御を実行するか否かを決定する。判定部１２８は、爪先Ｐｂの位置から目標軌跡ＴＬに対する垂線を下ろし、爪先Ｐｂから垂線の足までの距離（以下、垂線距離Ｄ）を演算する。垂線距離Ｄは、目標軌跡決定部１２２により決定された目標軌跡ＴＬと、姿勢演算部１２１で演算された爪先Ｐｂの位置との差である。
　判定部１２８は、垂線距離Ｄが、閾値Ｄｔ未満の場合、補正実行条件が成立していると判定する。判定部１２８は、垂線距離Ｄが閾値Ｄｔ以上の場合、補正実行条件が成立していないと判定する。閾値Ｄｔは、オペレータにより任意に設定される。たとえば、爪先Ｐｂが目標軌跡ＴＬから１ｍ以上離れている場合には、補正制御を実行しないようにするには、予め、閾値Ｄｔとして１ｍを設定しておけばよい。
　上述したコントローラ１２０による操作反力を補正する制御は、補正実行条件が成立している場合には実行し、補正実行条件が成立していない場合には実行しない。
　図８および図９は、コントローラ１２０により実行される操作反力制御プログラムによる処理の一例を示すフローチャートである。図９は、図８に示す第１補正制御処理および第２補正制御処理の内容を示している。図８および図９のフローチャートに示す処理は、オペレータの操作に基づいて目標軌跡ＴＬが設定された後、コントローラ１２０に接続される操作案内スイッチ（不図示）のＯＮにより開始され、所定の制御周期ごとにステップＳ１００以降の処理が繰り返し実行され、操作案内スイッチ（不図示）のＯＦＦにより終了する。
　図８に示すように、ステップＳ１００において、コントローラ１２０は、各種情報を取得し、ステップＳ１１０へ進む。ステップＳ１００で取得される各種情報には、角度センサ１１０ａ，１１０ｂ，１１０ｃで検出された各フロント部材の回動角度の情報、操作量センサ１１１ｄ，１１２ｄで検出された操作レバーの実操作角θの情報が含まれる。
　ステップＳ１１０において、コントローラ１２０は、記憶装置に記憶されている特性Ｎ（図７）のテーブルを参照し、ステップＳ１１０で取得した実操作角θの情報に基づいて、基準操作反力ＦＢを演算して、ステップＳ１１５へ進む。
　ステップＳ１１５において、コントローラ１２０は、記憶装置に記憶された各フロント部材の各部寸法と、ステップＳ１００で取得した各フロント部材の回動角度の情報とに基づいて、油圧ショベル１００の作業姿勢を演算し、ステップＳ１２０へ進む。ステップＳ１１５の姿勢演算処理では、旋回体１０２の旋回中心点ＢＰを基準としたバケット１０６の爪先Ｐｂの位置や、アーム１０５の回動支点の位置、バケット１０６の回動支点の位置を演算する。ステップＳ１１５の姿勢演算処理では、爪先Ｐｂから目標軌跡ＴＬまでの垂線距離Ｄを演算する。
　ステップＳ１２０において、コントローラ１２０は、補正実行条件が成立したか否かを判定する。ステップＳ１２０で肯定判定されると、すなわち垂線距離Ｄが閾値Ｄｔ未満であり、補正実行条件が成立していると判定されると、ステップＳ１２５へ進む。ステップＳ１２０で否定判定されると、すなわち垂線距離Ｄが閾値Ｄｔ以上であり、補正実行条件が成立していないと判定されると、ステップＳ１８０へ進む。
　ステップＳ１８０において、コントローラ１２０は、基準操作反力ＦＢをそのまま発生する操作反力Ｆとして決定し、ステップＳ１９０へ進む。すなわち、基準操作反力の補正を行わない。
　ステップＳ１２５において、コントローラ１２０は、ステップＳ１１５で演算された爪先Ｐｂの位置（現時点の位置）と、１制御周期前のステップＳ１１５で演算された爪先Ｐｂの位置との差に基づいて、爪先Ｐｂの実速度ベクトルＶＡｃを演算し、ステップＳ１３０へ進む。
　ステップＳ１３０において、コントローラ１２０は、ステップＳ１１５で演算された爪先Ｐｂの位置と、目標軌跡ＴＬとに基づいて目標速度ベクトルＶＴｃを演算し、ステップＳ１３５へ進む。
　ステップＳ１３５において、コントローラ１２０は、ベクトル分解処理を実行し、ステップＳ１４０へ進む。ベクトル分解処理では、ステップＳ１２５で演算された実速度ベクトルＶＡｃと、ステップＳ１１５で演算された各フロント部材の位置の情報とに基づいて、実速度ベクトルＶＡｃをアーム速度ベクトルＶＡａとブーム速度ベクトルＶＡｂとに分解する。ベクトル分解処理では、ステップＳ１３０で演算された目標速度ベクトルＶＴｃと、ステップＳ１１５で演算された各フロント部材の位置の情報とに基づいて、目標速度ベクトルＶＴｃをアーム速度ベクトルＶＴａとブーム速度ベクトルＶＴｂとに分解する。
　ステップＳ１４０において、コントローラ１２０は、ステップＳ１３５で分解されたアーム速度ベクトルの目標値と実測値、ならびに、ブーム速度ベクトルの目標値と実測値に基づいて、補正係数Ｋを演算し（補正係数演算処理）、ステップＳ１４５へ進む。補正係数演算処理において、コントローラ１２０は、ステップＳ１３５で演算されたアーム速度ベクトルＶＴａ（目標値）のノルムをステップＳ１３５で演算されたアーム速度ベクトルＶＡａ（実測値）のノルムで割ることで補正係数Ｋａを演算する。補正係数演算処理において、コントローラ１２０は、ステップＳ１３５で演算されたブーム速度ベクトルＶＴｂ（目標値）のノルムをステップＳ１３５で演算されたブーム速度ベクトルＶＡｂ（実測値）のノルムで割ることで補正係数Ｋｂを演算する。
　ステップＳ１４５において、コントローラ１２０は、ステップＳ１４０で演算された補正係数Ｋ（ＫａおよびＫｂ）をステップＳ１００で取得した実操作角θ（θａおよびθｂ）に乗じることで、目標操作角θｔを演算し、ステップＳ１５０へ進む。
　ステップＳ１５０において、コントローラ１２０は、実操作角θが減少するレバー操作が実行されているか否かを判定する。１制御周期前のステップＳ１００で取得された実操作角θよりも現時点の実操作角θが小さい場合、ステップＳ１５０で肯定判定され、操作量減少フラグをオンし、ステップＳ１６０へ進む。
　１制御周期前のステップＳ１００で取得された実操作角θよりも現時点の実操作角θが大きい場合、ステップＳ１５０で否定判定され、操作量減少フラグをオフし、ステップＳ１７０へ進む。ステップＳ１５０において、現時点の実操作角θと１制御周期前の実操作角θとの差が無い場合には、操作量減少フラグの状態に応じて、ステップＳ１６０またはステップＳ１７０へ移行するようになっている。すなわち、操作量減少フラグがオンであれば、ステップＳ１６０へ移行し、操作量減少フラグがオフであれば、ステップＳ１７０へ移行する。
　ステップＳ１６０において、コントローラ１２０は、第１補正制御を実行して、ステップＳ１９０へ進む。ステップＳ１７０において、コントローラ１２０は、第２補正制御を実行して、ステップＳ１９０へ進む。
　図９（ａ）は、第１補正制御処理の流れを示すフローチャートである。図９（ａ）に示すように、第１補正制御処理では、ステップＳ１４０で演算された補正係数Ｋと、記憶装置に記憶されている閾値とに基づいて、操作反力Ｆを決定する。
　ステップＳ１６１において、コントローラ１２０は、補正係数Ｋが閾値β未満であるか否かを判定する。ステップＳ１６１で肯定判定されるとステップＳ１６３へ進み、ステップＳ１６１で否定判定されるとステップＳ１６５へ進む。
　ステップＳ１６５において、コントローラ１２０は、補正係数Ｋが閾値β以上、閾値α未満であるか否かを判定する。ステップＳ１６５で肯定判定されるとステップＳ１６７へ進み、ステップＳ１６５で否定判定されるとステップＳ１６９へ進む。
　ステップＳ１６３において、コントローラ１２０は、基準操作反力ＦＢに記憶装置に記憶されている補正量ΔＦ（一定値）を加算した値を補正後の操作反力Ｆとして決定し、ステップ１９０へ進む。
　ステップＳ１６７において、コントローラ１２０は、基準操作反力ＦＢから記憶装置に記憶されている補正量ΔＦ（一定値）を減算した値を補正後の操作反力Ｆとして決定し、ステップＳ１９０へ進む。
　ステップＳ１６９において、コントローラ１２０は、基準操作反力ＦＢをそのまま発生する操作反力Ｆとして決定し、ステップＳ１９０へ進む。すなわち、基準操作反力の補正を行わない。
　図９（ｂ）は、第２補正制御処理の流れを示すフローチャートである。図９（ｂ）に示すように、第２補正制御処理では、ステップＳ１４０で演算された補正係数Ｋと、記憶装置に記憶されている閾値とに基づいて、操作反力Ｆを決定する。
　ステップＳ１７１において、コントローラ１２０は、補正係数Ｋが閾値γ以上であるか否かを判定する。ステップＳ１７１で肯定判定されるとステップＳ１７３へ進み、ステップＳ１７１で否定判定されるとステップＳ１７５へ進む。
　ステップＳ１７５において、コントローラ１２０は、補正係数Ｋが閾値β以上、閾値γ未満であるか否かを判定する。ステップＳ１７５で肯定判定されるとステップＳ１７７へ進み、ステップＳ１７５で否定判定されるとステップＳ１７９へ進む。
　ステップＳ１７３において、コントローラ１２０は、基準操作反力ＦＢをそのまま発生する操作反力Ｆとして決定し、ステップＳ１９０へ進む。すなわち、基準操作反力の補正を行わない。
　ステップＳ１７７において、コントローラ１２０は、基準操作反力ＦＢから記憶装置に記憶されている補正量ΔＦ（一定値）を減算した値を補正後の操作反力Ｆとして決定し、ステップＳ１９０へ進む。
　ステップＳ１７９において、コントローラ１２０は、基準操作反力ＦＢに記憶装置に記憶されている補正量ΔＦ（一定値）を加算した値を補正後の操作反力Ｆとして決定し、ステップ１９０へ進む。
　図８に示すように、ステップＳ１９０において、コントローラ１２０は、ステップＳ１６０，Ｓ１７０，Ｓ１８０で決定された操作反力Ｆを発生させるための制御信号を生成し、生成した制御信号を反力付与装置１１１ｒ，１１２ｒに出力する。
　図１０を参照して、本実施の形態に係る油圧ショベル１００の主要な動作を斜面の均し作業を例にまとめると次のようになる。図１０は、実操作角θに応じて、反力付与装置１１１ｒ，１１２ｒにより発生される操作反力Ｆの特性を示す図である。図１０（ａ）は、実操作角θが減少するようなレバー操作が実行されたときに、実操作角θに応じて変化する操作反力Ｆの特性を示している。図１０（ｂ）は、実操作角θが増加するようなレバー操作が実行されたときに、実操作角θに応じて変化する操作反力Ｆの特性を示している。図１０（ａ），（ｂ）において、横軸は実操作角θであり、縦軸は操作反力Ｆである。
　オペレータは、各操作レバー１１１，１１２を操作して、図４に示すように、バケット１０６の爪先Ｐｂを第１の位置Ｐ１と第２の位置Ｐ２に順番に配置し、それぞれの位置で位置設定スイッチ（不図示）を操作し、その位置での掘削深さｈ１，ｈ２の数値を深さ設定スイッチ（不図示）により入力する。これにより、コントローラ１２０によって目標軌跡ＴＬが設定され、記憶装置に記憶される。
　オペレータは、各操作レバー１１１，１１２を操作して斜面の均し作業を行う。ここで、図５に示すように、バケット１０６の爪先Ｐｂの位置を目標軌跡ＴＬ上に位置させ、操作案内スイッチ（不図示）を操作する。これにより、スイッチ操作後の操作にしたがって操作反力の補正制御が実行される。
　図１０（ａ）に示すように、たとえば、操作角θｓ１から実操作角θが減少するように操作レバーＲが操作されると、第１補正制御が実行される（ステップＳ１５０でＹｅｓ，Ｓ１６０）。操作角θｓ１は、実操作角θが目標操作角θｔ（θｔ＝Ｋ・θ）よりも大きい場合であって、かつ、実操作角θと目標操作角θｔとの差が大きい場合である（ステップＳ１６１でＹｅｓ）。なお、各操作レバー１１１，１１２の実操作角θのそれぞれが目標操作角θｔよりも大きいと、図６に示すように、｜｜ＶＡａ｜｜＞｜｜ＶＴａ｜｜，｜｜ＶＡｂ｜｜＞｜｜ＶＴｂ｜｜となる。
　この場合、図１０（ａ）に示すように、操作反力Ｆが特性Ｎにより決定される基準操作反力ＦＢよりもΔＦだけ増加するように補正される（ステップＳ１６３）。このため、オペレータは通常よりも大きな操作反力を感じる。
　オペレータは、大きな操作反力を感じることで、実操作角θが目標操作角θｔに比べて大きすぎていることを知ることができる。これにより、オペレータが、実操作角θを減少させるように操作レバー１１１，１１２を操作すると、図１０（ａ）に示すように、実操作角θの減少に伴って操作反力Ｆも徐々に小さくなる。
　実操作角θが目標操作角θｔに近い操作角θ２を超えて小さくなると（ステップＳ１６１でＮｏ，Ｓ１６５でＹｅｓ）、操作反力Ｆが特性Ｎにより決定される基準操作反力ＦＢよりもΔＦだけ減少するように補正される（ステップＳ１６７）。なお、操作角θ２は、補正係数Ｋが閾値βとなる操作角である。
　オペレータは、不連続的に操作反力Ｆが減少したことを感じることで、実操作角θが目標操作角θｔに近づいたことを知ることができる。これにより、オペレータは、実操作角θを変更しないように操作レバーＲを維持させる。
　なお、実操作角θが目標操作角θｔよりも小さくなるように操作レバーＲが操作され、実操作角θが操作角θ１を超えて小さくなると（ステップＳ１６１でＮｏ，Ｓ１６５でＮｏ）、操作反力Ｆが特性Ｎにより決定される基準操作反力ＦＢとなる（ステップＳ１６９）。なお、操作角θ１は、補正係数Ｋが閾値αとなる操作角である。
　オペレータは、不連続的に操作反力Ｆが増加したことを感じることで、実操作角θが目標操作角θｔを越えて小さくなりすぎてしまったこと知ることができる。これにより、オペレータは、実操作角θが目標操作角θｔに近づくように操作レバーＲを戻す操作を行う。
　一方、図１０（ｂ）に示すように、たとえば、操作角θｓ２から実操作角θが増加するように操作レバーＲが操作されると、第２補正制御が実行される（ステップＳ１５０でＮｏ、Ｓ１７０）。操作角θｓ２は、実操作角θが目標操作角θｔよりも小さい場合であって、かつ、実操作角θと目標操作角θｔとの差が予め設定した範囲内（β以上γ未満）の場合である（ステップＳ１７１でＮｏ，Ｓ１７５でＹｅｓ）。なお、図示しないが、各操作レバー１１１，１１２の実操作角θのそれぞれが目標操作角θｔよりも小さいと、｜｜ＶＡａ｜｜＜｜｜ＶＴａ｜｜，｜｜ＶＡｂ｜｜＜｜｜ＶＴｂ｜｜となる。
　この場合、図１０（ｂ）に示すように、操作反力Ｆが特性Ｎにより決定される基準操作反力ＦＢよりもΔＦだけ減少するように補正される（ステップＳ１７７）。このため、オペレータは通常よりも小さな操作反力を感じる。
　オペレータは、小さな操作反力を感じることで、実操作角θが目標操作角θｔに比べて小さすぎていることを知ることができる。これにより、オペレータが、実操作角θを増加させるように操作レバーＲを操作すると、図１０（ｂ）に示すように、実操作角θの増加に伴って操作反力Ｆも徐々に大きくなる。
　実操作角θが目標操作角θｔに近い操作角θ２を超えて大きくなると（ステップＳ１７１でＮｏ、ステップＳ１７５でＮｏ）、操作反力Ｆが特性Ｎにより決定される基準操作反力ＦＢよりもΔＦだけ増加するように補正される（ステップＳ１７９）。
　オペレータは、不連続的に操作反力Ｆが増加したことを感じることで、実操作角θが目標操作角θｔを越えて大きくなりすぎてしまったこと知ることができる。これにより、オペレータは、実操作角θが目標操作角θｔに近づくように操作レバーＲを戻す操作を行う。
　なお、操作角θ０～θ１の操作範囲において、実操作角θが減少するように操作レバーＲが操作されると、すなわち、目標操作角θｔと実操作角θとの差が大きくなる操作が実行されると、第２補正制御から第１補正制御に切り替わる（ステップＳ１５０でＹｅｓ，Ｓ１６０）。これにより、減少補正されていた操作反力Ｆが不連続的に増加し、基準操作反力ＦＢに戻る（ステップＳ１６９）。
　オペレータは、不連続的に操作反力Ｆが増加したことを感じることで、実操作角θが目標操作角θｔから遠ざかるように操作レバーＲが操作されている、すなわち目標に向かう操作とは逆の操作が実行されていることを知ることができる。これにより、オペレータは、実操作角θｔが目標操作角θｔに近づくように操作レバーＲを戻す操作を行う。
　このように、本実施の形態によれば、操作反力Ｆを調整することで、バケット１０６の爪先Ｐｂの位置が目標軌跡ＴＬに沿って移動するような操作が行われるように、オペレータを案内することができる。
　以上説明した実施の形態によれば、以下のような作用効果を奏することができる。
（１）コントローラ１２０は、フロント部材の目標操作角θｔと実操作角θとの差が、予め設定した範囲よりも大きい場合（すなわち補正係数Ｋがβ未満の場合）、そのフロント部材を駆動するアクチュエータ１０３ａ，１０４ａを操作する操作レバー１１１，１１２に対して反力付与装置１１１ｒ，１１２ｒにより付与される操作反力を増加させる補正を実行する。コントローラ１２０は、フロント部材の目標操作角θｔと実操作角θとの差が、予め設定した範囲内の場合（すなわち補正係数Ｋがβ以上α未満の場合、またはβ以上γ未満の場合）、そのフロント部材を駆動するアクチュエータ１０３ａ，１０４ａを操作する操作レバー１１１，１１２に対して反力付与装置１１１ｒ，１１２ｒにより付与される操作反力を減少させる補正を実行する。
　このため、オペレータが操作レバー１１１，１１２を複合操作する際に、バケット１０６の爪先Ｐｂを目標軌跡ＴＬに沿って移動させるための適切な操作が行われるように、操作を案内することができる。
（２）反力付与装置１１１ｒ，１１２ｒにより付与される操作反力を減少させる補正を実行した操作反力の大きさは、少なくとも操作レバー１１１，１１２の非操作時に操作レバー１１１，１１２が中立位置ＮＰに戻る大きさ以上である。これにより、オペレータが操作レバー１１１，１１２から手を放すと、自然に操作レバー１１１，１１２が中立位置ＮＰに戻るので、操作性がよい。また、緊急時に操作レバー１１１，１１２から手を放すことで、作業が継続されることを防止できる。
（３）コントローラ１２０は、目標操作角θｔと実操作角θとの差が大きくなる操作が実行された場合に操作反力を増加させる。これにより、オペレータは、操作反力Ｆが増加したことを感じることで、実操作角θが目標操作角θｔから遠ざかるように操作レバーＲが操作されていることを知ることができる。
（４）コントローラ１２０は、実操作角θが目標操作角θｔを含む予め設定した操作範囲内（θ１～θ２）にあるか否かを判定する。コントローラ１２０は、実操作角θが目標操作角θｔを含む予め設定した操作範囲内（θ１～θ２）にあると判定されたとき、操作レバー１１１，１１２に対して反力付与装置１１１ｒ，１１２ｒにより付与される操作反力を減少させる補正を実行する。
　オペレータは、操作反力が減少したことを感じることで、実操作角θが目標操作角θｔに近づいたことを知ることができる。これにより、オペレータは、目標軌跡ＴＬに沿った適切な作業を容易に行うことができる。
（５）目標軌跡ＴＬと、検出されたバケット１０６の爪先Ｐｂの位置との差（たとえば垂線距離）Ｄが予め設定した閾値Ｄｔよりも小さい場合、操作反力の補正を実行し、目標軌跡ＴＬと、検出されたバケット１０６の爪先Ｐｂの位置との差Ｄが予め設定した閾値Ｄｔよりも大きい場合、操作反力の補正を実行しないようにした。目標軌跡ＴＬに沿った動作とは異なる動作を意図的に実施したい場合など、爪先Ｐｂが目標軌跡ＴＬから大きく離れているときには、操作反力の補正が実行されないため、上記異なる動作を実行するための操作性がよい。
（６）バケット１０６の爪先Ｐｂの実速度ベクトルＶＡｃを演算し、目標速度ベクトルＶＴｃのノルムを実速度ベクトルＶＡｃのノルムと同じ値として決定するようにした。つまり、バケット１０６の爪先Ｐｂの目標速度は、実速度の大きさと同じ値として決定される。これにより、爪先Ｐｂを滑らかに動作させることができる。
（７）操作反力を用いてオペレータに操作を案内する構成としたので、オペレータは、表示装置の表示画面を用いた画像ガイダンスやスピーカを用いた音声ガイダンスに比べて、より直感的に適切な操作を理解することができる。
　なお、本実施の形態では、姿勢演算部１２１が位置検出部に相当し、反力補正部１２９の一部機能が目標到達判定部に相当する。
　次のような変形も本発明の範囲内であり、変形例の一つ、もしくは複数を上述の実施形態と組み合わせることも可能である。
（変形例１）
　操作反力の補正の方法は、上述した実施の形態に限定されない。
（変形例１－１）
　図１１（ａ）は、図１０（ａ）と同様の図であり、操作反力の補正方法の変形例を示す図である。図１１（ａ）では、上述した実施の形態における操作反力の特性を二点鎖線で示している。上述した実施の形態では、第１補正制御において、実操作角θが目標操作角θｔよりも小さくなり、操作角θ１に達すると、基準操作反力ＦＢまで操作反力が増加する特性であった。
　これに対して、本変形例では、実操作角θが目標操作角θｔよりも小さくなり、操作角θ１に達すると、基準操作反力ＦＢからさらに補正量ΔＦだけ増加された操作反力が発生する。操作角θ１に達したときの操作反力の増加量が上述した実施の形態よりも大きいので、オペレータは、よりはっきりと、目標操作角θｔを越えて実操作角θが減少したことを認識できる。
（変形例１－２）
　図１１（ｂ）は、図１０（ｂ）と同様の図であり、操作反力の補正方法の変形例を示す図である。図１１（ｂ）では、上述した実施の形態における操作反力の特性を二点鎖線で示している。上述した実施の形態では、第２補正制御において、実操作角θが目標操作角θｔよりも大きくなり、操作角θ２に達すると、基準操作反力ＦＢからさらに補正量ΔＦだけ増加された操作反力が発生する特性であった。
　これに対して、本変形例では、実操作角θが目標操作角θｔよりも大きくなり、操作角θ２に達すると、操作反力Ｆを最大値Ｆｍａｘまで増加させる。操作角θ２に達したときの操作反力の増加量が上述した実施の形態よりも大きいので、オペレータは、よりはっきりと、目標操作角θｔを越えて実操作角θが増加したことを認識できる。
（変形例１－３）
　上述した実施の形態では、第２補正制御において、実操作角θが操作角θ０から目標操作角θｔに向かって増加するにしたがって、直線的に操作反力Ｆが増加する特性であった。これに対して、本変形例では、図１１（ｂ）に示すように、実操作角θが操作角θ０から増加し、操作角θ１を超えて大きくなると、操作反力が不連続的に減少する特性とされている。本変形例では、操作角θ０～θ１では、基準操作反力ＦＢから補正量ΔＦ／２だけ減少させた操作反力Ｆを発生させ、操作角θ１～θ２では、基準操作反力ＦＢから補正量ΔＦだけ減少させた操作反力Ｆを発生させている。このように、本変形例によれば、実操作角θを増加させる操作においても、目標操作角θｔに近づいたときに、操作反力が不連続的に減少する。このため、オペレータは、不連続的に操作反力Ｆが減少したことを感じることで、実操作角θが目標操作角θｔに近づいたことを知ることができる。
（変形例１－４）
　上述した実施の形態では、操作反力Ｆを不連続的に変化させる例について説明したが、本発明はこれに限定されない。たとえば、図１２（ａ）および図１２（ｂ）に示すように、実操作角θの増加および減少に応じて、連続的に操作反力Ｆを変化させてもよい。図１２に示す例では、補正量ΔＦが実操作角θに応じて変化する。この場合、操作反力Ｆの変化をオペレータがわかるように、実操作角θの変化量に対する操作反力Ｆの変化量の割合（傾き）を設定すればよい。
（変形例２）
　上述した実施の形態では、各フロント部材の位置を求めるために、各フロント部材の回動角度を検出する角度センサ１１０ａ，１１０ｂ，１１０ｃを設ける例について説明したが、本発明はこれに限定されない。角度センサ１１０ａ，１１０ｂ，１１０ｃに代えて、油圧シリンダのストロークを検出するストロークセンサを設けて、ストロークの情報から各フロント部材の位置を求めてもよい。
（変形例３）
　上述した実施の形態では、現時点の爪先Ｐｂが目標軌跡ＴＬ上にあった場合に目標速度演算部１２４が目標速度ベクトルＶＴｃを演算する例について説明したが本発明はこれに限定されない。現時点の爪先Ｐｂが目標軌跡ＴＬから離れた位置にある場合、目標速度演算部１２４は、目標軌跡ＴＬに向かって滑らかに爪先Ｐｂが移動するような遷移用目標軌跡ＴＬｔを演算し、この遷移用目標軌跡ＴＬｔに基づいて目標速度ベクトルＶＴｃを演算する。
（変形例４）
　実速度ベクトルＶＡｃ、アーム速度ベクトルＶＡａおよびブーム速度ベクトルＶＡｂの演算方法は、上述した実施の形態に限定されない。たとえば、左操作レバー１１１の実操作角θａに基づいてアーム速度ベクトルＶＡａを演算し、右操作レバー１１２の実操作角θｂに基づいてブーム速度ベクトルＶＡｂを演算し、両者を合成して実速度ベクトルＶＡｃを演算してもよい。
（変形例５）
　上述した実施の形態では、反力付与装置１１１ｒ，１１２ｒを複数の電磁モータで構成する例について説明したが、本発明はこれに限定されない。コイルばねと、コイルばねの全長を変更させるピストンとにより反力付与装置を構成してもよい。油圧や空圧などの圧力を利用して、反力を発生させてもよい。たとえば、反力シリンダと、反力シリンダの駆動を制御する電磁比例弁とにより反力付与装置を構成してもよい。
（変形例６）
　上述した実施の形態では、左操作レバー１１１および右操作レバー１１２が電気式の操作レバーである例について説明したが、本発明はこれに限定されない。油圧パイロット式の操作レバーに本発明を適用してもよい。
（変形例７）
　上述した実施の形態では、ブーム１０４とアーム１０５の複合動作により、斜面の均し作業を行う場合の例について説明したが、本発明はこれに限定されない。水平引きなどの作業に対して本発明を適用してもよい。ブーム１０４とアーム１０５に加え、バケット１０６の動作を加えた複合動作に本発明を適用することもできる。この場合、右操作レバー１１２の左右方向の傾き角に応じて、操作反力を決定する。
（変形例８）
　｜｜ＶＡａ｜｜＞｜｜ＶＴａ｜｜，｜｜ＶＡｂ｜｜＞｜｜ＶＴｂ｜｜となる場合（図６参照）や、｜｜ＶＡａ｜｜＜｜｜ＶＴａ｜｜，｜｜ＶＡｂ｜｜＜｜｜ＶＴｂ｜｜となる場合に限らない。｜｜ＶＡａ｜｜＞｜｜ＶＴａ｜｜，｜｜ＶＡｂ｜｜＜｜｜ＶＴｂ｜｜となる場合や、｜｜ＶＡａ｜｜＜｜｜ＶＴａ｜｜，｜｜ＶＡｂ｜｜＞｜｜ＶＴｂ｜｜となる場合にも本発明が適用される。
（変形例９）
　上述した実施の形態では、バケット１０６の爪先Ｐｂの位置の目標軌跡ＴＬに沿って動作する作業を例について説明したが、本発明はこれに限定されない。目標軌跡を決定するフロント作業装置の予め設定された部位として、爪先Ｐｂに代えて、たとえば、バケット１０６の回動中心の位置を採用してもよい。この場合、バケット１０６の回動中心の位置の目標軌跡ＴＬに沿って動作する作業について、本発明を適用することもできる。
（変形例１０）
　上述した実施の形態では、フロント作業装置がブーム１０４、アーム１０５およびバケット１０６を備えている例について説明したが本発明はこれに限定されない。旋回体１０２に回動可能に取り付けられる基端ブームと、基端ブームに回動可能に取り付けられる先端ブームと、先端ブームに回動可能に取り付けられるアーム１０５と、バケット１０６とを備えた、いわゆるツーピースタイプのフロント作業装置を備えた建設機械に本発明を適用してもよい。少なくとも２つ以上のフロント部材が目標軌跡ＴＬに沿って複合的に操作される種々のフロント作業装置に本発明を適用することができる。
（変形例１１）
　上述した実施の形態では、クローラ式のバックホウを例に説明したが、本発明はこれに限定されない。たとえば、ローディングショベルやホイール式油圧ショベルなど、目標軌跡ＴＬに沿って、少なくとも２つ以上のフロント部材を含む複数のフロント部材を有するフロント作業装置を備えた建設機械であって、少なくとも２つ以上のフロント部材が複合的に動作される種々の建設機械に本発明を適用することができる。
　上記では、種々の実施の形態および変形例を説明したが、本発明はこれらの内容に限定されるものではない。本発明の技術的思想の範囲内で考えられるその他の態様も本発明の範囲内に含まれる。
　次の優先権基礎出願の開示内容は引用文としてここに組み込まれる。
　日本国特許出願２０１５年第１７８５１６号（２０１５年９月１０日出願）
　１００　油圧ショベル、１０１　走行体、１０２　旋回体、１０３　フロント作業装置、１０３ａ　アクチュエータ、１０４　ブーム、１０４ａ　ブームシリンダ、１０５　アーム、１０５ａ　アームシリンダ、１０６　バケット、１０６ａ　バケットシリンダ、１０７　運転室、１０８　コントロールバルブ、１０９　カウンタウエイト、１１０ａ　ブーム角度センサ、１１０ｂ　アーム角度センサ、１１０ｃ　バケット角度センサ、１１１　左操作レバー、１１１ｄ　操作量センサ、１１１ｒ　反力付与装置、１１２　右操作レバー、１１２ｄ　操作量センサ、１１２ｒ　反力付与装置、１２０　コントローラ、１２０ｄ　操作量検出部、１２１　姿勢演算部、１２２　目標軌跡決定部、１２３　実速度演算部、１２４　目標速度演算部、１２５　ベクトル分解部、１２６　目標操作量演算部、１２７　基準反力演算部、１２８　判定部、１２９　反力補正部
　Ｄ　垂線距離、Ｆ　操作反力、ＢＰ　旋回中心点、Ｄｔ　閾値、ＦＢ　基準操作反力、Ｋａ　補正係数、Ｋｂ　補正係数、ＮＰ　中立位置、Ｐｂ　爪先、ＴＬ　目標軌跡、ＴＬＬ　目標軌跡下限、ＴＬＵ　目標軌跡上限、ＶＡａ　アーム速度ベクトル、ＶＡｂ　ブーム速度ベクトル、ＶＡｃ　実速度ベクトル、ＶＴａ　アーム速度ベクトル、ＶＴｂ　ブーム速度ベクトル、ＶＴｃ　目標速度ベクトル 

Claims (6)

  1. 　少なくとも第１フロント部材および第２フロント部材を含む複数のフロント部材を有するフロント作業装置、ならびに前記複数のフロント部材を駆動する複数のアクチュエータ、ならびに前記複数のアクチュエータを操作する操作部を備えた建設機械において、
    　前記操作部に対して、実操作量に基づき操作反力を付与する反力付与装置と、
    　この反力付与装置に対する制御信号を生成するために、前記操作部の実操作量を検出する操作量検出部と、
    　前記フロント作業装置の予め設定された部位の目標軌跡を決定する軌跡決定部と、
    　前記複数のフロント部材が駆動することにより移動する前記フロント作業装置の予め設定された部位の位置を検出する位置検出部と、
    　前記目標軌跡に沿うように前記フロント作業装置の予め設定された部位の目標速度を決定する目標速度決定部と、
    　前記目標速度に基づいて、少なくとも前記第１フロント部材および前記第２フロント部材のそれぞれの目標操作量を決定する目標操作量決定部と、
    　前記フロント部材の目標操作量と実操作量との差が、予め設定した範囲よりも大きい場合、そのフロント部材を駆動するアクチュエータを操作する操作部に対して前記反力付与装置により付与される操作反力を増加させる補正を実行し、前記範囲内の場合、そのフロント部材を駆動するアクチュエータを操作する操作部に対して前記反力付与装置により付与される操作反力を減少させる補正を実行する反力補正制御部とを有する制御装置とを備えたことを特徴とする建設機械。
  2. 　請求項１に記載の建設機械において、
    　前記反力補正制御部によって、前記反力付与装置により付与される操作反力を減少させる補正を実行した操作反力の大きさは、少なくとも前記操作部の非操作時に前記操作部が中立位置に戻る大きさ以上であることを特徴とする建設機械。
  3. 　請求項１に記載の建設機械において、
    　前記反力補正制御部が、前記目標操作量と前記実操作量との差が大きくなる操作が実行された場合に前記操作反力を増加させることを特徴とする建設機械。
  4. 　請求項１に記載の建設機械において、
    　前記実操作量が、前記目標操作量を含む予め設定した操作範囲内にあるか否かを判定する目標到達判定部を備え、
    　前記反力補正制御部は、前記目標到達判定部により前記実操作量が前記目標操作量を含む予め設定した操作範囲内にあると判定されたとき、前記操作部に対して前記反力付与装置により付与される操作反力を減少させる補正を実行することを特徴とする建設機械。
  5. 　請求項１に記載の建設機械において、
    　前記軌跡決定部により決定された前記目標軌跡と、前記位置検出部により検出された前記フロント作業装置の予め設定された部位の位置との差が予め設定した閾値よりも小さい場合、前記反力補正制御部による前記操作反力の補正を実行し、
    　前記軌跡決定部により決定された前記目標軌跡と、前記位置検出部により検出された前記フロント作業装置の予め設定された部位の位置との差が予め設定した閾値よりも大きい場合、前記反力補正制御部による前記操作反力の補正を実行しないことを特徴とする建設機械。
  6. 　請求項１に記載の建設機械において、
    　前記フロント作業装置の予め設定された部位の実速度を演算する実速度演算部を備え、
    　前記目標速度決定部は、前記目標速度の大きさを前記実速度の大きさと同じ値として決
    定することを特徴とする建設機械。 
PCT/JP2016/058082 2015-09-10 2016-03-15 建設機械 WO2017043112A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
EP16843978.4A EP3348715B1 (en) 2015-09-10 2016-03-15 Construction machine
KR1020177037400A KR101986446B1 (ko) 2015-09-10 2016-03-15 건설 기계
US15/749,828 US10533303B2 (en) 2015-09-10 2016-03-15 Construction machine to adjust operation reaction force of an operating lever
CN201680037755.6A CN107709672B (zh) 2015-09-10 2016-03-15 工程机械

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015-178516 2015-09-10
JP2015178516A JP6373812B2 (ja) 2015-09-10 2015-09-10 建設機械

Publications (1)

Publication Number Publication Date
WO2017043112A1 true WO2017043112A1 (ja) 2017-03-16

Family

ID=58239524

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2016/058082 WO2017043112A1 (ja) 2015-09-10 2016-03-15 建設機械

Country Status (6)

Country Link
US (1) US10533303B2 (ja)
EP (1) EP3348715B1 (ja)
JP (1) JP6373812B2 (ja)
KR (1) KR101986446B1 (ja)
CN (1) CN107709672B (ja)
WO (1) WO2017043112A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2019163603A (ja) * 2018-03-19 2019-09-26 コベルコ建機株式会社 建設機械
US11261578B2 (en) 2017-03-21 2022-03-01 Hitachi Construction Machinery Co., Ltd. Work machine

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6552996B2 (ja) * 2016-06-07 2019-07-31 日立建機株式会社 作業機械
JP6889579B2 (ja) * 2017-03-15 2021-06-18 日立建機株式会社 作業機械
JP7141894B2 (ja) * 2018-09-05 2022-09-26 日立建機株式会社 作業機械
JP7043470B2 (ja) * 2019-09-26 2022-03-29 日立建機株式会社 作業機械
JP7313633B2 (ja) * 2020-01-31 2023-07-25 国立大学法人広島大学 位置制御装置及び位置制御方法
CN116490655A (zh) * 2020-11-09 2023-07-25 国立大学法人广岛大学 工程机械的自动运行装置
WO2024043303A1 (ja) * 2022-08-26 2024-02-29 コベルコ建機株式会社 制御装置及び制御方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0988112A (ja) * 1995-09-27 1997-03-31 Hitachi Constr Mach Co Ltd 建設機械の軌跡制御装置
JPH10317417A (ja) * 1997-05-19 1998-12-02 Hitachi Constr Mach Co Ltd 多関節作業機械の姿勢制御装置
JP2005320846A (ja) * 2004-04-05 2005-11-17 Hitachi Constr Mach Co Ltd 建設機械の操作装置
JP2006144349A (ja) * 2004-11-18 2006-06-08 Hitachi Constr Mach Co Ltd 建設機械の安全装置
JP2007303128A (ja) * 2006-05-10 2007-11-22 Hitachi Constr Mach Co Ltd 建設機械

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4776751A (en) * 1987-08-19 1988-10-11 Deere & Company Crowd control system for a loader
US5950141A (en) * 1996-02-07 1999-09-07 Komatsu Ltd. Dozing system for bulldozer
JP3571142B2 (ja) * 1996-04-26 2004-09-29 日立建機株式会社 建設機械の軌跡制御装置
JPH10147953A (ja) * 1996-11-18 1998-06-02 Komatsu Ltd ブルドーザのドージング装置
DE69821754T2 (de) * 1997-06-20 2005-01-05 Hitachi Construction Machinery Co., Ltd. Vorrichtung zur Regulation der Aushebetiefe einer Baumaschine
JPH11210015A (ja) * 1998-01-27 1999-08-03 Hitachi Constr Mach Co Ltd 建設機械の軌跡制御装置及びその操作装置
JP4444884B2 (ja) 2005-06-28 2010-03-31 日立建機株式会社 建設機械および建設機械に用いられる制御装置
JP2007177437A (ja) 2005-12-27 2007-07-12 Shin Caterpillar Mitsubishi Ltd オープンループ式制御機械の力行・回生判別装置
US8190334B2 (en) * 2007-02-21 2012-05-29 Kobelco Construction Machinery Co., Ltd. Rotation control device and working machine therewith
US7975410B2 (en) * 2008-05-30 2011-07-12 Caterpillar Inc. Adaptive excavation control system having adjustable swing stops
JP2010066962A (ja) * 2008-09-10 2010-03-25 Hitachi Constr Mach Co Ltd 操作装置
JP6023053B2 (ja) * 2011-06-10 2016-11-09 日立建機株式会社 作業機械
CN102518166B (zh) * 2011-12-09 2014-03-12 中联重科股份有限公司 一种工程机械的操控系统及操控方法
JP5969380B2 (ja) * 2012-12-21 2016-08-17 住友建機株式会社 ショベル及びショベル制御方法
JP6884702B2 (ja) * 2015-09-16 2021-06-09 住友重機械工業株式会社 ショベル

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0988112A (ja) * 1995-09-27 1997-03-31 Hitachi Constr Mach Co Ltd 建設機械の軌跡制御装置
JPH10317417A (ja) * 1997-05-19 1998-12-02 Hitachi Constr Mach Co Ltd 多関節作業機械の姿勢制御装置
JP2005320846A (ja) * 2004-04-05 2005-11-17 Hitachi Constr Mach Co Ltd 建設機械の操作装置
JP2006144349A (ja) * 2004-11-18 2006-06-08 Hitachi Constr Mach Co Ltd 建設機械の安全装置
JP2007303128A (ja) * 2006-05-10 2007-11-22 Hitachi Constr Mach Co Ltd 建設機械

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11261578B2 (en) 2017-03-21 2022-03-01 Hitachi Construction Machinery Co., Ltd. Work machine
JP2019163603A (ja) * 2018-03-19 2019-09-26 コベルコ建機株式会社 建設機械
JP7119457B2 (ja) 2018-03-19 2022-08-17 コベルコ建機株式会社 建設機械

Also Published As

Publication number Publication date
US20180223500A1 (en) 2018-08-09
CN107709672A (zh) 2018-02-16
US10533303B2 (en) 2020-01-14
EP3348715A4 (en) 2019-05-01
EP3348715A1 (en) 2018-07-18
CN107709672B (zh) 2020-03-31
EP3348715B1 (en) 2020-05-06
KR101986446B1 (ko) 2019-06-05
KR20180014032A (ko) 2018-02-07
JP2017053160A (ja) 2017-03-16
JP6373812B2 (ja) 2018-08-15

Similar Documents

Publication Publication Date Title
JP6373812B2 (ja) 建設機械
JP4776640B2 (ja) 油圧ショベルのフロント制御装置
US7881841B2 (en) Motion-control system
WO2018003176A1 (ja) 作業機械
US10633022B2 (en) Track-type machine propulsion system having independent track controls integrated to joysticks
KR100281009B1 (ko) 2피스부움식 유압셔블의 간섭 방지장치
WO2010101233A1 (ja) 建設機械、建設機械の制御方法、及びこの方法をコンピュータに実行させるプログラム
JP5886323B2 (ja) 旋回制御装置及び方法
US20210002853A1 (en) Construction machine
JP6106129B2 (ja) 建設機械の掘削制御装置
JP7084722B2 (ja) ショベルおよびその制御方法
JP4444884B2 (ja) 建設機械および建設機械に用いられる制御装置
JP4455465B2 (ja) 建設機械のフロント制御装置
JP4215944B2 (ja) 油圧ショベルのフロント制御装置
JP6695620B2 (ja) 建設機械
JP6692568B2 (ja) 建設機械
JP5757690B2 (ja) 作業機
JP6706094B2 (ja) 作業機械および作業機械の干渉回避方法
US20190186100A1 (en) Work vehicle and method for controlling work vehicle
JPWO2018096667A1 (ja) 作業車両および作業車両の制御方法
JP2022128084A (ja) 作業機モーメントを推定する方法
WO2024070262A1 (ja) 作業機械
JP6180764B2 (ja) 建設機械の油圧回路及びその制御方法
JP7096180B2 (ja) 作業機械
JP2018119667A (ja) 旋回制御装置

Legal Events

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

Ref document number: 16843978

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 20177037400

Country of ref document: KR

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 15749828

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE