WO2020170687A1 - 安全装置及び建設機械 - Google Patents

安全装置及び建設機械 Download PDF

Info

Publication number
WO2020170687A1
WO2020170687A1 PCT/JP2020/001805 JP2020001805W WO2020170687A1 WO 2020170687 A1 WO2020170687 A1 WO 2020170687A1 JP 2020001805 W JP2020001805 W JP 2020001805W WO 2020170687 A1 WO2020170687 A1 WO 2020170687A1
Authority
WO
WIPO (PCT)
Prior art keywords
slope
construction machine
tip
boom
safety device
Prior art date
Application number
PCT/JP2020/001805
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 EP20759411.0A priority Critical patent/EP3892781A4/en
Priority to US17/427,373 priority patent/US20220018095A1/en
Priority to CN202080008702.8A priority patent/CN113272499A/zh
Publication of WO2020170687A1 publication Critical patent/WO2020170687A1/ja

Links

Images

Classifications

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

Definitions

  • the present disclosure relates to a safety device and a construction machine that ensure the safety of the construction machine.
  • the area restriction control device sets an arbitrary restricted area in advance by a worker, compares the position of the front working apparatus with the set restricted area, and when the front working apparatus attempts to enter the restricted area, the front working apparatus is controlled. Is a device for operating the front working device so as not to enter the restricted area by stopping or moving along the boundary of the restricted area. When the operator determines that the workability may be impaired by performing the area limiting control, the operator can cancel the area limiting function at will.
  • Patent Document 1 it is determined whether or not the vehicle body may float based on the state quantity of the vehicle body, and when it is determined that the vehicle body may float, the area limitation control is released.
  • an area limitation control device that allows manual escape.
  • the area restriction control of the front working device is only released when it is determined that the vehicle body may float, and the operation after that is left to the operator.
  • the area limitation control of the front working device is released, but the operation after release is left to the operator. .. In this case, the operator needs to quickly perform an operation for preventing a fall and ensure safety.
  • the present disclosure has been made to solve the above problems, and a safety device and a construction capable of automatically preventing a construction machine from tipping over and reliably ensuring the safety of the construction machine.
  • the purpose is to provide a machine.
  • a safety device is a safety device that ensures the safety of a construction machine including a machine body and a work device attached to the machine body, and is shape data indicating a shape of a terrain around the construction machine. Based on the shape data and the acquisition unit that acquires, whether the construction machine satisfies the operating condition of operating the fall prevention control for preventing the construction machine from falling toward the slope in the specific direction around the construction machine. And a descending controller that descends the tip of the working device toward the slope when the operating condition is determined by the determining unit.
  • FIG. 1 It is a figure which shows the hydraulic excavator which is an example of the construction machine with which the safety device which concerns on embodiment of this indication is mounted. It is a block diagram which shows the structure of the hydraulic shovel shown in FIG. In this Embodiment, it is a figure which shows an example of the scene where the hydraulic excavator is working in the vicinity of the road shoulder on the slope. In this Embodiment, it is a figure which shows an example of the scene where the scaffold part of the hydraulic shovel collapsed. In this Embodiment, it is a figure which shows an example of the scene which dropped the front-end
  • FIG. 1 is a diagram showing a hydraulic excavator that is an example of a construction machine equipped with a safety device according to an embodiment of the present disclosure.
  • the hydraulic excavator 1 includes a lower traveling body 10 capable of traveling on the ground G, an upper revolving structure 12 mounted on the lower traveling structure 10, and a work device 14 mounted on the upper revolving structure 12.
  • the configuration in which the safety device is applied to the hydraulic excavator 1 is illustrated, but the present disclosure is not limited thereto.
  • the safety device may be applied to any construction machine as long as it is a construction machine including a lower traveling body such as a hydraulic crane, an upper swing body, and a working device.
  • the upper direction orthogonal to the ground G is referred to as the upper direction and the lower direction is referred to as the lower direction, and the upper direction and the lower direction are collectively referred to as the vertical direction.
  • the direction in which the lower traveling body 10 moves forward is referred to as the front
  • the direction in which the lower traveling body 10 moves backward is referred to as the rear
  • the front and the rear are collectively referred to as the front-back direction.
  • a direction orthogonal to each of the up-down direction and the front-back direction is called a left-right direction.
  • the left side in the left-right direction when viewed from the rear to the front is called the left side
  • the right side is called the right side.
  • the length of the lower traveling body 10 in the front-rear direction is longer than the length in the left-right direction. Therefore, the longitudinal direction of the lower traveling body 10 faces the front-back direction.
  • the lower traveling structure 10 and the upper revolving structure 12 form a machine body that supports the work device 14.
  • the upper swing body 12 has a swing frame 16 and a plurality of elements mounted thereon.
  • the plurality of elements include an engine room 17 that houses an engine and a cab 18 that is a driver's cab.
  • the lower traveling body 10 is composed of a pair of crawlers.
  • the upper swing body 12 is attached to the lower traveling body 10 so as to be swingable.
  • the work device 14 can perform operations for excavation work and other necessary work, and includes a boom 21, an arm 22 and a bucket 23.
  • the boom 21 has a base end portion that is supported on the front end of the revolving frame 16 so as to be capable of undulating, that is, rotatable about a horizontal axis, and a tip portion on the opposite side.
  • the arm 22 has a base end portion attached to the tip end portion of the boom 21 so as to be rotatable around a horizontal axis, and a tip end portion on the opposite side.
  • the bucket 23 is rotatably attached to the tip of the arm 22.
  • the boom cylinder C1 is interposed between the upper swing body 12 and the boom 21, and expands and contracts to cause the boom 21 to perform a hoisting motion.
  • the arm cylinder C2 is interposed between the boom 21 and the arm 22 and expands and contracts so as to cause the arm 22 to rotate.
  • the bucket cylinder C3 is interposed between the arm 22 and the bucket 23, and expands and contracts so that the bucket 23 can rotate.
  • the hydraulic excavator 1 includes a controller 100, a shape sensor 101, a tilt sensor 102, an attitude sensor 103, a turning sensor 104, a boom operating device 105, an arm operating device 106, a bucket operating device 107, a turning operating device 108, a travel operating device 109, and a hydraulic pressure.
  • the circuit 200 is provided.
  • the hydraulic circuit 200 includes, in addition to the boom cylinder C1, the arm cylinder C2, and the bucket cylinder C3 shown in FIG. 1, a swing motor M1, a pair of left and right traveling motors M2L and M2R, a pair of boom solenoid valves V1, a pair of arm solenoid valves V2, A pair of bucket solenoid valves V3, a pair of swing solenoid valves V4, a pair of left traveling solenoid valves V5L, a right pair of traveling solenoid valves V5R, a boom control valve V6, an arm control valve V7, a bucket control valve V8, a swing control valve V9 and a pair of left and right traveling control valves V10L and V10R are included. Further, the hydraulic circuit 200 includes a hydraulic pump that is driven by the power of an engine (not shown) and supplies hydraulic oil to each actuator, and a pilot pump that sends pilot pressure to the pilot port of each switching valve via a pilot line.
  • the boom cylinder C1 expands and contracts by receiving the hydraulic oil supplied from the hydraulic pump, thereby performing the boom raising operation and the boom lowering operation.
  • the arm cylinder C2 expands and contracts by receiving the supply of hydraulic oil from the hydraulic pump, which causes the arm pulling operation and the arm pushing operation.
  • the bucket cylinder C3 expands and contracts by receiving the supply of hydraulic oil from the hydraulic pump, which causes the bucket scooping operation and the bucket opening operation.
  • the swing motor M1 has a motor output shaft that rotates bidirectionally by receiving the supply of hydraulic oil from a hydraulic pump.
  • the upper swing body 12 connected to the motor output shaft rotates left or right. Make an action.
  • Each of the traveling motor M2L and the traveling motor M2R has a motor output shaft that bidirectionally rotates by receiving the supply of hydraulic oil from a hydraulic pump, and advances to the lower traveling body 10 connected to the motor output shaft. A running operation or a backward running operation is performed.
  • the traveling motor M2L and the traveling motor M2R rotate at the same speed, so that the lower traveling body 10 moves forward or backward.
  • the traveling motor M2L and the traveling motor M2R rotate at different speeds, so that the lower traveling body 10 turns.
  • the boom control valve V6 is composed of a hydraulic pilot switching valve having a pair of boom pilot ports, and by inputting a boom pilot pressure to one of the pair of boom pilot ports, the boom control valve V6 is operated in a direction corresponding to the boom pilot port. The valve is opened with a stroke corresponding to the magnitude of the boom pilot pressure, thereby changing the direction and flow rate of the hydraulic oil supplied to the boom cylinder C1.
  • the arm control valve V7 is composed of a hydraulic pilot switching valve having a pair of arm pilot ports, and when arm pilot pressure is input to any one of the pair of arm pilot ports, the arm control valve V7 operates in a direction corresponding to the arm pilot port.
  • the valve is opened with a stroke corresponding to the magnitude of the arm pilot pressure, thereby changing the direction and flow rate of the supply of hydraulic oil to the arm cylinder C2.
  • the bucket control valve V8 is composed of a hydraulic pilot switching valve having a pair of bucket pilot ports, and when the bucket pilot pressure is input to any one of the pair of bucket pilot ports, the bucket control valve V8 operates in the direction corresponding to the bucket pilot port.
  • the valve is opened with a stroke corresponding to the magnitude of the bucket pilot pressure, thereby changing the direction and flow rate of the working oil supplied to the bucket cylinder C3.
  • the swing control valve V9 is composed of a hydraulic pilot switching valve having a pair of swing pilot ports, and when the swing pilot pressure is input to any one of the pair of swing pilot ports, the swing control valve V9 operates in a direction corresponding to the swing pilot port.
  • the valve is opened with a stroke corresponding to the magnitude of the swing pilot pressure, thereby changing the direction and flow rate of the working oil supplied to the swing motor M1.
  • Each of the travel control valves V10L and V10R is composed of a hydraulic pilot switching valve having a pair of travel pilot ports, and corresponds to the travel pilot port by inputting the travel pilot pressure to one of the pair of travel pilot ports. In this direction, the valve is opened with a stroke corresponding to the magnitude of the traveling pilot pressure, thereby changing the direction and flow rate of the hydraulic oil supplied to the traveling motors M2L and M2R.
  • the pair of boom solenoid valves V1 are solenoid valves respectively interposed between the pilot pump and the pair of boom pilot ports of the boom control valve V6, and perform opening/closing operations upon receiving a boom command signal which is an electric signal.
  • the pair of boom solenoid valves V1 adjust the boom pilot pressure to a degree according to the boom command signal.
  • the pair of arm solenoid valves V2 are solenoid valves respectively interposed between the pilot pump and the pair of arm pilot ports of the arm control valve V7, and open/close upon receiving an arm command signal which is an electric signal.
  • the pair of arm solenoid valves V2 adjust the arm pilot pressure to a degree according to the arm command signal.
  • the pair of bucket solenoid valves V3 are solenoid valves respectively interposed between the pilot pump and the pair of arm pilot ports of the bucket control valve V8, and perform opening/closing operations upon receiving a bucket command signal which is an electric signal.
  • the pair of bucket solenoid valves V3 adjust the bucket pilot pressure to a degree according to the bucket command signal.
  • the pair of swing solenoid valves V4 are solenoid valves respectively interposed between the pilot pump and the pair of swing pilot ports of the swing control valve V9, and perform opening/closing operations by receiving a swing command signal which is an electric signal.
  • the turning solenoid valve V4 upon receiving the input of the turning command signal, adjusts the turning pilot pressure to a degree according to the turning command signal.
  • the pair of traveling solenoid valves V5L are electromagnetic valves that are respectively interposed between the pilot pump and the pair of traveling pilot ports of the traveling control valve V10L, and receive the input of a turning command signal which is an electric signal to perform opening/closing operations.
  • a turning command signal which is an electric signal to perform opening/closing operations.
  • the pair of travel solenoid valves V5L adjust the travel pilot pressure to a degree according to the travel command signal.
  • the pair of traveling solenoid valves V5R are solenoid valves that are respectively interposed between the pilot pump and the pair of traveling pilot ports of the traveling control valve V10R, and perform opening/closing operations upon receiving a turning command signal that is an electrical signal.
  • the traveling solenoid valve V5R adjusts the traveling pilot pressure to a degree according to the traveling command signal.
  • the shape sensor 101 acquires shape data indicating the shape of the terrain around the hydraulic excavator 1.
  • the shape sensor 101 detects shape data indicating a distance distribution of the terrain around the hydraulic excavator 1.
  • the shape sensor 101 includes, for example, a three-dimensional distance measuring sensor such as LIDAR (light detection and ranging).
  • LIDAR light detection and ranging
  • the shape sensor 101 may include any sensor as long as it can measure the distance distribution, such as a distance measuring sensor using infrared rays and a distance measuring sensor using ultrasonic waves.
  • the shape sensor 101 is attached, for example, in the upper revolving structure 12, the working device 14, or the lower traveling structure 10 such that the center line of the angle of view is directed obliquely downward and forward.
  • the shape sensor 101 will be described as being attached to the upper part of the upper swing body 12.
  • the shape data is range image data in which depth data indicating the depth from the shape sensor 101 to the terrain is arranged in a matrix.
  • the shape sensor 101 inputs the detected shape data to the controller 100.
  • the tilt sensor 102 detects a ground plane angle which is a tilt angle of the lower surface of the lower traveling body 10 with respect to the ground plane (horizontal plane).
  • the tilt sensor 102 includes, for example, an inertial sensor having the functions of an acceleration sensor and an angular velocity sensor.
  • the tilt sensor 102 detects the ground plane angle by a strapdown method or the like based on the detection signal of the inertial sensor.
  • the inclination sensor 102 converts the detected ground plane angle into a detection signal which is an electric signal corresponding to these angles and inputs the detection signal to the controller 100.
  • the attitude sensor 103 detects the attitude of the work device 14.
  • the attitude sensor 103 includes the boom angle sensor 61, the arm angle sensor 62, and the bucket angle sensor 63 shown in FIG. 1.
  • the boom angle sensor 61 detects a boom angle which is a rotation angle of the boom 21 with respect to the upper swing body 12.
  • the arm angle sensor 62 detects an arm angle that is a rotation angle of the arm 22 with respect to the boom 21.
  • the bucket angle sensor 63 detects a bucket angle that is a rotation angle of the bucket 23 with respect to the arm 22.
  • the boom angle sensor 61, the arm angle sensor 62, and the bucket angle sensor 63 are each configured by a resolver, a rotary encoder, or the like.
  • the attitude sensor 103 converts the detected boom angle, arm angle, and bucket angle into detection signals which are electrical signals corresponding to these, and inputs them to the controller 100.
  • the turning sensor 104 detects a turning angle of the upper turning body 12 with respect to the lower traveling body 10.
  • the turning sensor 104 is composed of, for example, a resolver or a rotary encoder.
  • the turning sensor 104 converts the detected turning angle into a detection signal which is an electric signal corresponding to the detected turning angle and inputs the detection signal to the controller 100.
  • the boom operation device 105 includes a boom operation lever that receives an operation from an operator for performing a boom raising operation or a boom lowering operation, and an operation signal generation unit that inputs a boom operation signal corresponding to an operation amount of the boom operation lever to the controller 100. It is composed of an electric lever device including.
  • the arm operation device 106 includes an arm operation lever that receives an operation from an operator for an arm pulling operation or an arm pushing operation, and an operation signal generation unit that inputs an arm operation signal corresponding to an operation amount of the arm operation lever to the controller 100. It is composed of an electric lever device including.
  • the bucket operation device 107 includes a bucket operation lever that receives an operation from an operator for a bucket scooping operation or a bucket opening operation, and an operation signal generation unit that inputs a bucket operation signal corresponding to the operation amount of the bucket operation lever to the controller 100. It is composed of an electric lever device including.
  • the turning operation device 108 is an operation for inputting to the controller 100 a turning operation lever that receives an operation from an operator for turning the upper-part turning body 12 rightward or leftward, and a turning operation signal corresponding to an operation amount of the turning operation lever. It is composed of an electric lever device including a signal generator.
  • the travel operation device 109 includes a travel operation lever that receives an operation from an operator for moving the lower traveling body 10 forward or backward, and an operation signal generation unit that inputs a travel operation signal corresponding to an operation amount of the travel operation lever to the controller 100. It is composed of an electric lever device including and.
  • the controller 100 is composed of, for example, a microcomputer, and includes a calculation unit 110 and a command unit 120.
  • the calculator 110 directs the tip of the work device 14 toward the slope.
  • the command unit 120 has a function of controlling the operation of each element included in the hydraulic circuit 200.
  • the command unit 120 includes a boom command unit 121, an arm command unit 122, a bucket command unit 123, a turning command unit 124, and a travel command unit 125.
  • the boom command unit 121 inputs a boom command signal having a value according to the operation amount of the boom operation device 105 to the pair of boom solenoid valves V1 to open the boom solenoid valve to an opening degree according to the operation amount of the boom operation device 105.
  • the flow rate of the hydraulic oil supplied to the boom cylinder C1 increases as the opening degree of V1 is set and increases.
  • the arm command unit 122 inputs an arm command signal having a value according to the operation amount of the arm operation device 106 to the pair of arm solenoid valves V2, so that the arm solenoid valve has an opening degree according to the operation amount of the arm operation device 106. Set the opening of V2.
  • the bucket command unit 123 inputs a bucket command signal having a value according to the operation amount of the bucket operation device 107 to the pair of bucket solenoid valves V3, so that the bucket solenoid valve has an opening degree according to the operation amount of the bucket operation device 107. Set the opening of V3.
  • the turning command unit 124 inputs a turning command signal having a value according to the operation amount of the turning operation device 108 to the turning solenoid valve V4, so that the opening degree of the turning solenoid valve V4 is adjusted to the opening according to the operation amount of the turning operation device 108. Set the opening.
  • the travel command unit 125 inputs a travel command signal having a value corresponding to the operation amount of the travel operation device 109 to the pair of travel electromagnetic valves V5L and the pair of travel electromagnetic valves V5R, thereby responding to the operation amount of the travel operation device 109.
  • the opening of each of the pair of traveling electromagnetic valves V5L and the pair of traveling electromagnetic valves V5R is set to the different opening.
  • the calculation unit 110 includes a coordinate system conversion unit 111, a determination unit 112, and a descent control unit 113.
  • the coordinate system conversion unit 111 converts the shape data detected by the shape sensor 101 into data of a machine coordinate system with the hydraulic excavator 1 as a reference.
  • the machine coordinate system is, for example, an X-axis in the longitudinal direction (front-rear direction), a Y-axis in the left-right direction, a Z-axis in the up-and-down direction, and joining of the upper swing body 12 and the lower traveling body 10 on the swing axis of the upper swing body 12. It is a three-dimensional Cartesian coordinate system whose origin is a part.
  • the X axis, the Y axis, the Z axis, and the origin of the machine coordinate system are not limited to the above.
  • the origin of the mechanical coordinate system may be, for example, the base end portion of the work device 14 (base end portion of the boom 21).
  • the coordinate system conversion unit 111 calculates the position of the shape sensor 101 in the machine coordinate system using the turning angle detected by the turning sensor 104, and the relative position between the coordinate system of the shape sensor 101 and the machine coordinate system is calculated from this position.
  • the physical positional relationship is specified, and the shape data is converted into data in the machine coordinate system based on the specified relative positional relationship.
  • the shape sensor 101 represents the terrain by depth data of a plurality of detection points in a matrix. Therefore, the coordinate system conversion unit 111 calculates the coordinates of each detection point in the machine coordinate system from the depths (distances) to the plurality of detection points.
  • the detection signal of the attitude sensor 103 and the turning angle are required when converting the shape data into the data of the machine coordinate system. Further, when the shape sensor 101 is arranged on the lower traveling body 10, the position of the shape sensor 101 in the machine coordinate system is constant. The turning angle is not necessary.
  • the determination unit 112 determines whether or not the operating condition for operating the fall prevention control for preventing the hydraulic excavator 1 from falling toward a slope in a specific surrounding direction is satisfied.
  • the fall prevention control in the present embodiment is control for lowering the tip of the work device 14 toward the slope.
  • the determination unit 112 includes a tilt angle calculation unit 114, an operating condition determination unit 115, and a state determination unit 116.
  • the inclination angle calculation unit 114 calculates the inclination angle of the slope with respect to the ground contact surface of the hydraulic excavator 1 based on the shape data.
  • FIG. 3 is a diagram showing an example of a scene where the hydraulic excavator is working near a shoulder on a slope in the present embodiment.
  • the hydraulic excavator 1 is working on the shoulder 302 of the slope 301.
  • the slope 301 is, for example, a slope, and the slope is an artificial slope made by cutting or embankment.
  • the road shoulder 302 is a surface continuing to the upper end of the slope 301.
  • the shoulder 302 is horizontal.
  • the inclination angle ⁇ 1 is the inclination angle of the slope 301 with respect to the ground contact surface SA of the hydraulic excavator 1.
  • the ground contact surface SA is the road shoulder 302.
  • the slope 301 is a surface on which the hydraulic excavator 1 performs work such as cutting or embankment with the work device 14.
  • the tilt angle calculation unit 114 calculates the tilt angle ⁇ 1 from the shape data converted into the machine coordinate system.
  • the inclination angle calculation unit 114 detects the boundary line between the ground contact surface SA of the lower traveling body 10 and the slope 301 from the shape data, and slopes a predetermined range region on the opposite side of the ground contact surface SA across the boundary line. Extract as a candidate area.
  • the inclination angle calculation unit 114 sets a direction orthogonal to the boundary line as the inclination direction of the slope 301, extracts a coordinate data group of one line parallel to the inclination direction from the slope candidate region, and extracts the extracted data. Find the regression line of the group.
  • the tilt angle calculation unit 114 calculates the angle of this regression line with respect to the XY plane, that is, the angle with respect to the ground contact surface SA, as the tilt angle. At this time, the inclination angle calculation unit 114 determines that the slope 301 is not included in the shape data if the coefficient of determination of the regression line is less than or equal to a predetermined value, and if the coefficient of determination is greater than the predetermined value, It may be determined that the slope 301 is included.
  • the tilt angle calculation unit 114 extracts a coordinate data group of a plurality of lines parallel to the tilt direction from the slope candidate region, obtains regression lines for each of the plurality of lines, and calculates an angle with respect to the ground plane SA for each of the regression lines. If each angle is within a certain angle range and the coefficient of determination of each of the plurality of regression lines is larger than a predetermined threshold, it may be determined that the shape data includes the slope 301. .. Then, in this case, the tilt angle calculation unit 114 may calculate the average value of the angles of the respective regression lines with respect to the ground contact surface SA as the tilt angle ⁇ 1.
  • the state determination unit 116 determines whether the hydraulic excavator 1 is in a stable state or an unstable state. When the entire lower surface of the lower traveling body 10 is in contact with the ground contact surface SA, the hydraulic excavator 1 is in a stable state. However, in FIG. 3, when the scaffold portion 303 of the hydraulic excavator 1 collapses toward the slope 301 and only a part of the lower surface of the lower traveling body 10 contacts the ground contact surface SA, the hydraulic excavator 1 tilts forward and becomes unstable. It becomes a state.
  • FIG. 4 is a diagram showing an example of a scene in which the scaffold portion of the hydraulic excavator collapses in the present embodiment.
  • the state determination unit 116 acquires the acceleration of the hydraulic excavator 1, and when the acquired acceleration is larger than the threshold value, determines that the hydraulic excavator 1 is in an unstable state.
  • the state determination unit 116 calculates the acceleration of the hydraulic excavator 1 by differentiating the contact surface angle ⁇ 2 detected by the tilt sensor 102. The state determination unit 116 determines whether the calculated acceleration is larger than the threshold value. Then, when the state determination unit 116 determines that the calculated acceleration is greater than the threshold value, the state determination unit 116 determines that the hydraulic excavator 1 is in an unstable state.
  • the acceleration is calculated from the ground contact surface angle ⁇ 2 detected by the tilt sensor 102, but the present disclosure is not particularly limited to this, and the hydraulic excavator 1 is provided with an acceleration sensor. The acceleration of the hydraulic excavator 1 may be detected.
  • the operating condition determination unit 115 moves the hydraulic excavator 1 forward. It is determined that the operation condition for operating the fall prevention control for preventing the fall of the vehicle toward the slope is satisfied.
  • the descent control unit 113 When the determination unit 112 determines that the operation condition is satisfied, the descent control unit 113 operates the fall prevention control for lowering the tip of the work device 14 toward the slope.
  • the descent control unit 113 lowers the tip end of the work device 14 toward the slope along the path with the shortest distance between the tip end of the work device 14 and the slope.
  • the descent control unit 113 determines whether the boom angle, the arm angle, and the bucket angle detected by the attitude sensor 103 and the lengths from the base end portion to the tip end portion of the boom 21, the arm 22, and the bucket 23, respectively.
  • the coordinates of the tip of the work device 14 in the coordinate system are calculated.
  • the tip of the work device 14 is the tip 231 of the bucket 23.
  • the lengths of the boom 21, the arm 22, and the bucket 23 from the base end portion to the tip end portion are stored in advance in a memory (not shown).
  • the descent control unit 113 identifies the coordinates of the point 304 on the slope having the shortest distance from the coordinates of the tip portion 231 of the bucket 23 from the coordinate data group in the slope candidate region.
  • the descent control unit 113 connects the straight line connecting the coordinates of the tip portion 231 of the bucket 23 and the coordinates of the point 304 on the slope where the distance from the coordinates of the tip portion 231 of the bucket 23 is the shortest, to the tip of the bucket 23. It is calculated as the route 401 on which the unit 231 moves.
  • the descent control unit 113 generates a boom control signal, an arm control signal, and a bucket control signal for moving the tip portion 231 of the bucket 23 along the calculated path 401, and generates the boom control signal, the arm control signal, and the bucket control signal.
  • the control signal is output to the command unit 120.
  • the boom command unit 121 inputs a boom command signal having a value corresponding to the control amount of the descending control unit 113 to the pair of boom solenoid valves V1.
  • the arm command unit 122 also inputs an arm command signal having a value corresponding to the control amount of the descending control unit 113 to the pair of arm solenoid valves V2.
  • the bucket command unit 123 inputs a bucket command signal having a value according to the control amount of the descending control unit 113 to the pair of bucket solenoid valves V3.
  • FIG. 5 is a diagram showing an example of a scene in which the tip of the working device of the hydraulic excavator is lowered toward the slope in the present embodiment.
  • the descent control unit 113 lowers the tip of the work device 14 to an arrival position where the distance between the position of the tip 231 of the work device 14 and the position of the slope is within a predetermined range.
  • the arrival position is a position where the tip portion 231 of the work device 14 exceeds the slope 301.
  • the descent control unit 113 lowers the tip portion 231 of the working device 14 to a position where the tip portion 231 of the working device 14 exceeds the slope 301. As a result, the tip portion 231 of the work device 14 pierces the slope 301, and the hydraulic excavator 1 can be more reliably stabilized.
  • the arrival position may be a position before the slope 301.
  • the descent control unit 113 may lower the tip portion 231 of the work device 14 to a position before the slope 301. As a result, the time required for the tip portion 231 of the work device 14 to reach the reaching position is shortened, and the hydraulic excavator 1 can be stabilized more quickly.
  • the hydraulic excavator 1 may further include a boom cylinder pressure sensor that detects the pressure value of the boom cylinder C1, and an arm cylinder pressure sensor that detects the pressure value of the arm cylinder C2. Then, the descent control unit 113 may lower the tip of the work device 14 until the boom cylinder pressure sensor or the arm cylinder pressure sensor detects a pressure value equal to or higher than a predetermined value.
  • the pressure value of the boom cylinder C1 or the arm cylinder C2 is increased by pressing the tip of the work device 14 against the ground. Therefore, the tip end of the work device 14 is sufficiently pressed against the ground by lowering the tip end of the work device 14 until the pressure value detected by the boom cylinder pressure sensor or the arm cylinder pressure sensor becomes a predetermined value or more. Therefore, the hydraulic excavator 1 can be reliably stabilized.
  • the descending control unit 113 automatically lowers the tip end portion of the work device 14 toward the slope without accepting the operation by the operator, and the work device 14 After lowering the tip to the arrival position, the operator's operation is accepted. That is, when the determining unit 112 determines that the operating condition is satisfied, the descending control unit 113 operates the boom operating device 105, the arm operating device 106, the bucket operating device 107, the turning operating device 108, and the traveling operating device 109. Do not accept signals.
  • the descending control unit 113 lowers the tip end portion of the working device 14 to the reaching position, and then, the boom operating device 105, the arm operating device 106, the bucket operating device 107, the turning operating device 108, and the traveling operating device 109. Accept an operation signal.
  • the operator's operation is accepted after the tip of the work device 14 reaches the slope, so after stabilizing the hydraulic excavator 1, for example, with the tip of the bucket 23 pressed against the slope, the hydraulic excavator is pressed.
  • the operator can perform a fall avoidance operation such as moving 1 backward.
  • FIG. 6 is a flowchart showing the operation of the hydraulic excavator shown in FIG. The process shown in FIG. 6 is repeatedly executed at a predetermined cycle while the hydraulic excavator 1 is operating.
  • step S1 the shape sensor 101 acquires shape data indicating the distance distribution of the terrain around the hydraulic excavator 1.
  • step S2 the swing sensor 104 acquires the swing angle of the upper swing body 12 with respect to the lower traveling body 10.
  • step S3 the coordinate system conversion unit 111 uses the acquired turning angle and sets the shape data represented by the coordinate system with the acquired shape sensor 101 as a reference, with the hydraulic excavator 1 as a reference. Convert to shape data expressed in the machine coordinate system.
  • step S4 the inclination angle calculation unit 114 calculates the inclination angle of the front slope with respect to the ground contact surface of the hydraulic excavator 1 based on the shape data of the machine coordinate system converted by the coordinate system conversion unit 111.
  • step S5 the inclination sensor 102 acquires the contact surface angle, which is the inclination angle of the lower surface of the lower traveling body 10 with respect to the contact surface (horizontal plane).
  • step S6 the state determination unit 116 calculates the acceleration from the contact surface angle acquired by the tilt sensor 102.
  • step S7 the state determination unit 116 determines whether the hydraulic excavator 1 is in a stable state or an unstable state based on the calculated acceleration.
  • the state determination unit 116 determines whether the calculated acceleration is larger than the threshold value.
  • the state determination unit 116 determines that the calculated acceleration is equal to or less than the threshold value
  • the state determination unit 116 determines that the hydraulic excavator 1 is in a stable state.
  • the state determination unit 116 determines that the hydraulic excavator 1 is in an unstable state.
  • step S8 the operating condition determination unit 115 determines that the inclination angle calculated by the inclination angle calculation unit 114 is larger than the threshold value and the state of the hydraulic excavator 1 determined by the state determination unit 116 is in an unstable state. Determine if there is.
  • step S8 if it is determined that the inclination angle is less than or equal to the threshold value or the state of the hydraulic excavator 1 is stable (NO in step S8), the process ends.
  • the descending control unit 113 prohibits the operation by the operator in step S9. .. That is, the descent control unit 113 discards the operation signals from the boom operation device 105, the arm operation device 106, the bucket operation device 107, the turning operation device 108, and the traveling operation device 109 without accepting them.
  • step S10 the posture sensor 103 detects the posture of the work device 14.
  • the attitude sensor 103 detects the boom angle, the arm angle, and the bucket angle as the attitude of the work device 14.
  • step S11 the descent control unit 113 determines the boom angle, the arm angle, and the bucket angle detected by the attitude sensor 103, and the lengths from the base end portion to the tip end portion of each of the boom 21, the arm 22, and the bucket 23. Based on the above, the coordinates of the tip of the work device 14 in the machine coordinate system are calculated.
  • step S12 the descent control unit 113 identifies the coordinates of the point on the slope that has the shortest distance from the coordinates of the tip of the work device 14 from the coordinate data group in the slope candidate area.
  • step S13 the descent control unit 113 calculates the movement route of the tip of the work device 14. That is, the descent control unit 113 connects the straight line connecting the coordinates of the tip of the work device 14 and the coordinates of the point on the slope where the distance from the tip of the work device 14 is the shortest, to the tip of the work device 14. It is calculated as the movement route of the department.
  • step S14 the descent control unit 113 causes the command unit 120 to output each command signal so as to descend the tip end of the work device 14 toward the slope along the calculated movement route.
  • the descent control unit 113 generates a boom control signal, an arm control signal, and a bucket control signal for lowering the tip of the work device 14 toward the slope along the calculated movement path, and the generated boom control.
  • the signal, the arm control signal, and the bucket control signal are output to the command unit 120.
  • the boom command unit 121 inputs a boom command signal having a value corresponding to the boom control signal input from the descent control unit 113 to the pair of boom solenoid valves V1.
  • the arm command unit 122 inputs an arm command signal having a value corresponding to the arm control signal input from the descent control unit 113 to the pair of arm solenoid valves V2.
  • the bucket command unit 123 inputs a bucket command signal having a value corresponding to the bucket control signal input from the descent control unit 113 to the pair of bucket solenoid valves V3.
  • step S15 the descent control unit 113 receives an operation by the operator. That is, the descent control unit 113 receives each operation signal from the boom operation device 105, the arm operation device 106, the bucket operation device 107, the turning operation device 108, and the travel operation device 109.
  • the present embodiment discloses that the fall prevention control is performed with the front of the lower traveling body 10 facing the slope 301, but the present disclosure is not limited to this, and the front of the lower traveling body 10 is disclosed.
  • the fall prevention control may be performed in a state in which is not directed to the slope 301.
  • the hydraulic excavator 1 may store the relative direction of the hydraulic excavator 1 with respect to the slope 301 on which the work device 14 performs work such as cutting or embankment as a specific direction.
  • the lower traveling body 10 is not directed to the slope 301, the upper revolving body 12 is revolving with respect to the lower traveling body 10, and the work device 14 performs work on the slope 301. Then, when the hydraulic excavator 1 may fall toward the slope 301, the fall prevention control can be applied.
  • the slope 301 is detected using the shape data detected by the shape sensor 101 in the present embodiment, the present disclosure is not limited to this, and the shape data measured in advance is acquired from the memory, or Alternatively, the slope 301 may be detected by acquiring the shape data by communication from an external server. In this case, the inclination angle calculation unit 114 acquires the current position of the hydraulic excavator 1 from a GPS sensor (not shown), and plots the current position of the hydraulic excavator 1 on the acquired shape data, so that the shape data of the hydraulic excavator 1 is calculated. The surrounding slope 301 may be detected.
  • the hydraulic excavator 1 further includes an information presenting device that presents information for notifying the operator that the tip of the working device 14 has been automatically lowered to prevent the hydraulic excavator 1 from falling. May be.
  • the information presentation device is, for example, a display device or a speaker.
  • the determination unit 112 includes the tilt angle calculation unit 114, the operating condition determination unit 115, and the state determination unit 116, but the present disclosure is not particularly limited to this, and the determination unit 112 includes The state determination unit 116 may not be provided, and the tilt angle calculation unit 114 and the operation condition determination unit 115 may be provided.
  • the operating condition determination unit 115 may determine whether the tilt angle calculated by the tilt angle calculation unit 114 is larger than the threshold value. The operating condition determination unit 115 may determine that the operating condition is satisfied when the tilt angle is larger than the threshold value.
  • a safety device is a safety device that ensures the safety of a construction machine including a machine body and a work device attached to the machine body, and is shape data indicating a shape of a terrain around the construction machine. Based on the shape data and the acquisition unit that acquires, whether the construction machine satisfies the operating condition of operating the fall prevention control for preventing the construction machine from falling toward the slope in the specific direction around the construction machine. And a descending controller that descends the tip of the working device toward the slope when the operating condition is determined by the determining unit.
  • the operation condition for activating the fall prevention control for preventing the construction machine from falling toward the slope in the specific direction is satisfied, and it is determined that the operation condition is satisfied.
  • the tip of the work device descends toward the slope, the tip of the work device is pressed against the slope, and the tip of the work device supports the construction machine to automatically prevent the construction machine from tipping over. Not only can it be prevented, but the safety of the construction machine can be reliably ensured.
  • the determination unit calculates an inclination angle of the slope with respect to a ground contact surface of the construction machine based on the shape data, and when the inclination angle is larger than a threshold value, the operation condition is satisfied. You may judge that.
  • the determination unit calculates the inclination angle of the slope with respect to the ground contact surface of the construction machine based on the shape data, determines whether the construction machine is in an unstable state, and determines the inclination. When it is determined that the angle is larger than the threshold and the construction machine is in an unstable state, it may be determined that the operation condition is satisfied.
  • the construction machine when the inclination angle of the slope with respect to the ground contact surface of the construction machine is larger than the threshold and the construction machine is in an unstable state, the construction machine can be automatically prevented from tipping over. ..
  • the determination unit may acquire the acceleration of the construction machine, and when the acquired acceleration is larger than a threshold value, may determine that the construction machine is in an unstable state.
  • the acceleration of the construction machine becomes larger than the threshold value, so the construction machine is reliably in an unstable state. Can be determined.
  • the descending control unit descends the tip end portion of the working device toward the slope along a path in which the distance between the tip end portion of the working device and the slope is the shortest. May be.
  • the construction machine can be automatically prevented from tipping over more quickly.
  • the lowering control unit lowers the tip of the working device to an arrival position where the distance between the position of the tip of the working device and the position of the slope is within a predetermined range. Good.
  • the tip of the working device descends to the arrival position where the distance between the position of the tip of the working device and the position of the slope falls within a predetermined range, for example, support the construction machine with the working device. It is possible to reliably prevent the construction machine from tipping over by lowering the tip of the work device to a position where the construction machine can move.
  • the reaching position may be a position where the tip of the working device exceeds the slope.
  • the tip of the work device by lowering the tip of the work device to a position where the tip of the work device exceeds the slope, the tip of the work device can pierce the slope and more reliably stabilize the construction machine.
  • the descending control unit descends the tip end portion of the working device toward the slope without accepting an operation by an operator when the determining unit determines that the operation condition is satisfied.
  • the operation by the operator may be accepted after lowering the tip of the working device to the arrival position.
  • the tip of the work device descends toward the slope without accepting the operation by the operator, and after the tip of the work device descends to the arrival position, the operator After the construction machine is stabilized, the operator can perform a fall avoidance operation such as moving the construction machine backward with the tip of the working device pressed against the slope.
  • a construction machine includes the safety device according to any one of the above, a machine body, and a work device attached to the machine body.
  • the operation condition for activating the fall prevention control for preventing the construction machine from falling toward the slope in the specific direction is satisfied, and it is determined that the operation condition is satisfied.
  • the tip of the work device descends toward the slope, the tip of the work device is pressed against the slope, and the tip of the work device supports the construction machine to automatically prevent the construction machine from tipping over. Not only can it be prevented, but the safety of the construction machine can be reliably ensured.
  • the safety device and the construction machine according to the present disclosure can automatically prevent the construction machine from tipping over and can surely ensure the safety of the construction machine. It is useful as equipment and construction machinery.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

安全装置は、油圧ショベル(1)の周囲の地形の形状を示す形状データを取得する形状センサ(101)と、形状データに基づいて、油圧ショベル(1)が周囲の特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かを判断する判断部(112)と、判断部(112)によって作動条件を満たすと判断された場合、作業装置の先端部を斜面に向けて降下させる降下制御部(113)とを備える。

Description

安全装置及び建設機械
 本開示は、建設機械の安全を確保する安全装置及び建設機械に関するものである。
 従来、油圧ショベルなどの建設機械には、領域制限制御装置が設けられている。領域制限制御装置は、予め作業者が任意の制限領域を設定し、フロント作業装置の位置と設定した制限領域とを比較してフロント作業装置が制限領域に侵入しようとした場合に、フロント作業装置を停止、もしくは制限領域の境界に沿って動作させ、制限領域には侵入しないようフロント作業装置を動作させる装置である。オペレータは、領域制限制御を行うことにより作業性を損なう可能性があると判断したときは、自分の意志で領域制限機能を解除することができる。
 しかしながら、領域制限機能を解除するには、領域制限機能を解除するための操作をオペレータが行う必要があり、作業上速やかに領域制限機能を解除することは困難であった。
 そこで、例えば、特許文献1は、車体の状態量に基づいて車体が浮上する可能性があるかどうかを判断し、車体が浮上する可能性があると判断したときは領域制限制御を解除して手動による脱出を可能にする領域制限制御装置を開示している。
 上記従来の技術では、車体が浮上する可能性があると判断された場合にフロント作業装置の領域制限制御が解除されるのみであり、解除後の操作はオペレータにゆだねられる。
 例えば、作業時において、建設機械の足場が崩落して車体が浮上する可能性があると判断された場合、フロント作業装置の領域制限制御が解除されるが、解除後の操作はオペレータにゆだねられる。この場合、オペレータは、転倒防止のための操作を迅速に行い、安全を確保する必要がある。
 しかしながら、オペレータが咄嗟に転倒を防止するための操作を行うことは困難であるため、転倒を防止するための安全対策を施すことが望ましい。
特開平8-269998号公報
 本開示は、上記の問題を解決するためになされたもので、建設機械が転倒するのを自動的に防止することができるとともに、確実に建設機械の安全を確保することができる安全装置及び建設機械を提供することを目的とするものである。
 本開示の一態様に係る安全装置は、機体と、前記機体に取り付けられる作業装置とを備える建設機械の安全を確保する安全装置であって、前記建設機械の周囲の地形の形状を示す形状データを取得する取得部と、前記形状データに基づいて、前記建設機械が前記周囲の特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かを判断する判断部と、前記判断部によって前記作動条件を満たすと判断された場合、前記作業装置の先端部を前記斜面に向けて降下させる降下制御部と、を備える。
 本開示によれば、建設機械が転倒するのを自動的に防止することができるとともに、確実に建設機械の安全を確保することができる。
本開示の実施の形態に係る安全装置が搭載される建設機械の例である油圧ショベルを示す図である。 図1に示す油圧ショベルの構成を示すブロック図である。 本実施の形態において、油圧ショベルが斜面の路肩近傍で作業している場面の一例を示す図である。 本実施の形態において、油圧ショベルの足場部分が崩落した場面の一例を示す図である。 本実施の形態において、油圧ショベルの作業装置の先端部を斜面に向けて降下させた場面の一例を示す図である。 図2に示す油圧ショベルの動作を示すフローチャートである。
 以下添付図面を参照しながら、本開示の実施の形態について説明する。なお、以下の実施の形態は、本開示を具体化した一例であって、本開示の技術的範囲を限定するものではない。
 図1は、本開示の実施の形態に係る安全装置が搭載される建設機械の例である油圧ショベルを示す図である。この油圧ショベル1は、地面Gの上を走行可能な下部走行体10と、下部走行体10に搭載される上部旋回体12と、上部旋回体12に搭載される作業装置14とを備える。ここでは、安全装置が油圧ショベル1に適用される構成を例示するが、本開示はこれに限定されない。例えば、安全装置は、油圧クレーン等の下部走行体、上部旋回体及び作業装置を備える建設機械であれば、どのような建設機械に適用されてもよい。
 また、本実施の形態において、地面Gに直行する上側の方向を上方、下側の方向を下方と呼び、上方及び下方を総称して上下方向と呼ぶ。また、下部走行体10が前進する方向を前方、下部走行体10が後進する方向を後方と呼び、前方及び後方を総称して前後方向と呼ぶ。また、上下方向及び前後方向のそれぞれに直行する方向を左右方向と呼ぶ。また、後方から前方に見て左右方向の左側を左方、右側を右方と呼ぶ。なお、下部走行体10は、前後方向の長さが左右方向の長さよりも長い。そのため、下部走行体10の長手方向は前後方向を向く。
 下部走行体10及び上部旋回体12は、作業装置14を支持する機体を構成する。上部旋回体12は、旋回フレーム16と、その上に搭載される複数の要素とを有する。当該複数の要素は、エンジンを収容するエンジンルーム17及び運転室であるキャブ18を含む。下部走行体10は、一対のクローラで構成されている。上部旋回体12は下部走行体10に対して旋回可能に取り付けられている。
 作業装置14は、掘削作業及びその他の必要な作業のための動作を行うことが可能であり、ブーム21、アーム22及びバケット23を含む。ブーム21は、旋回フレーム16の前端に起伏可能すなわち水平軸回りに回動可能に支持される基端部と、その反対側の先端部とを有する。アーム22は、ブーム21の先端部に水平軸回りに回動可能に取付けられる基端部と、その反対側の先端部とを有する。バケット23は、アーム22の先端部に回動可能に取付けられる。
 ブーム21、アーム22、及びバケット23のそれぞれには、複数の伸縮可能な油圧シリンダであるブームシリンダC1、アームシリンダC2及びバケットシリンダC3が取り付けられている。
 ブームシリンダC1は、上部旋回体12とブーム21との間に介在し、ブーム21に起伏動作を行わせるように伸縮する。アームシリンダC2は、ブーム21とアーム22との間に介在し、アーム22に回動動作を行わせるように伸縮する。バケットシリンダC3は、アーム22とバケット23との間に介在し、バケット23に回動動作を行わせるように伸縮する。
 図2は、図1に示す油圧ショベルの構成を示すブロック図である。油圧ショベル1は、コントローラ100、形状センサ101、傾斜センサ102、姿勢センサ103、旋回センサ104、ブーム操作装置105、アーム操作装置106、バケット操作装置107、旋回操作装置108、走行操作装置109及び油圧回路200を備える。
 油圧回路200は、図1に示すブームシリンダC1、アームシリンダC2及びバケットシリンダC3に加え、旋回モータM1、左右一対の走行モータM2L,M2R、一対のブーム電磁弁V1、一対のアーム電磁弁V2、一対のバケット電磁弁V3、一対の旋回電磁弁V4、左の一対の走行電磁弁V5L、右の一対の走行電磁弁V5R、ブーム制御弁V6、アーム制御弁V7、バケット制御弁V8、旋回制御弁V9及び左右一対の走行制御弁V10L,V10Rを含む。さらに、油圧回路200は、図示しないエンジンの動力により駆動され、各アクチュエータに作動油を供給する油圧ポンプ及び各切換弁のパイロットポートに対してパイロットラインを介してパイロット圧を送るパイロットポンプを含む。
 ブームシリンダC1は、油圧ポンプからの作動油の供給を受けることにより伸縮し、これによりブーム上げ動作とブーム下げ動作とを行わせる。
 アームシリンダC2は、油圧ポンプからの作動油の供給を受けることにより伸縮し、これによりアーム引き動作とアーム押し動作とを行わせる。
 バケットシリンダC3は、油圧ポンプからの作動油の供給を受けることにより伸縮し、これによりバケット掬い動作とバケット開き動作とを行わせる。
 旋回モータM1は、油圧ポンプからの作動油の供給を受けることにより双方向に回転動作するモータ出力軸を有し、当該モータ出力軸に連結された上部旋回体12に左旋回動作又は右旋回動作を行わせる。
 走行モータM2L及び走行モータM2Rは、それぞれ、油圧ポンプからの作動油の供給を受けることにより双方向に回転動作するモータ出力軸を有し、当該モータ出力軸に連結された下部走行体10に前進走行動作又は後進走行動作を行わせる。走行モータM2L及び走行モータM2Rは、同一速度で回転することで、下部走行体10は前進又は後進する。一方、走行モータM2L及び走行モータM2Rが異なる速度で回転することで、下部走行体10は旋回する。
 ブーム制御弁V6は、一対のブームパイロットポートを有する油圧パイロット切換弁からなり、当該一対のブームパイロットポートのいずれかにブームパイロット圧が入力されることにより、そのブームパイロットポートに対応した方向にそのブームパイロット圧の大きさに対応したストロークで開弁し、これにより、ブームシリンダC1に対する作動油の供給の方向及び流量を変化させる。
 アーム制御弁V7は、一対のアームパイロットポートを有する油圧パイロット切換弁からなり、当該一対のアームパイロットポートのいずれかにアームパイロット圧が入力されることにより、そのアームパイロットポートに対応した方向にそのアームパイロット圧の大きさに対応したストロークで開弁し、これにより、アームシリンダC2に対する作動油の供給の方向及び流量を変化させる。
 バケット制御弁V8は、一対のバケットパイロットポートを有する油圧パイロット切換弁からなり、当該一対のバケットパイロットポートのいずれかにバケットパイロット圧が入力されることにより、そのバケットパイロットポートに対応した方向にそのバケットパイロット圧の大きさに対応したストロークで開弁し、これにより、バケットシリンダC3に対する作動油の供給の方向及び流量を変化させる。
 旋回制御弁V9は、一対の旋回パイロットポートを有する油圧パイロット切換弁からなり、当該一対の旋回パイロットポートのいずれかに旋回パイロット圧が入力されることにより、その旋回パイロットポートに対応した方向にその旋回パイロット圧の大きさに対応したストロークで開弁し、これにより、旋回モータM1に対する作動油の供給の方向及び流量を変化させる。
 走行制御弁V10L,V10Rは、それぞれ、一対の走行パイロットポートを有する油圧パイロット切換弁からなり、当該一対の走行パイロットポートのいずれかに走行パイロット圧が入力されることにより、その走行パイロットポートに対応した方向にその走行パイロット圧の大きさに対応したストロークで開弁し、これにより、走行モータM2L,M2Rに対する作動油の供給の方向及び流量を変化させる。
 一対のブーム電磁弁V1は、パイロットポンプとブーム制御弁V6の一対のブームパイロットポートとの間にそれぞれ介在する電磁弁であり、電気信号であるブーム指令信号の入力を受けて開閉動作を行う。一対のブーム電磁弁V1は、ブーム指令信号の入力を受けるとそのブーム指令信号に応じた度合いにブームパイロット圧を調節する。
 一対のアーム電磁弁V2は、パイロットポンプとアーム制御弁V7の一対のアームパイロットポートとの間にそれぞれ介在する電磁弁であり、電気信号であるアーム指令信号の入力を受けて開閉動作を行う。一対のアーム電磁弁V2は、アーム指令信号の入力を受けるとそのアーム指令信号に応じた度合いにアームパイロット圧を調節する。
 一対のバケット電磁弁V3は、パイロットポンプとバケット制御弁V8の一対のアームパイロットポートとの間にそれぞれ介在する電磁弁であり、電気信号であるバケット指令信号の入力を受けて開閉動作を行う。一対のバケット電磁弁V3は、バケット指令信号の入力を受けるとそのバケット指令信号に応じた度合いにバケットパイロット圧を調節する。
 一対の旋回電磁弁V4は、パイロットポンプと旋回制御弁V9の一対の旋回パイロットポートとの間にそれぞれ介在する電磁弁であり、電気信号である旋回指令信号の入力を受けて開閉動作を行う。旋回電磁弁V4は、旋回指令信号の入力を受けるとその旋回指令信号に応じた度合いに旋回パイロット圧を調節する。
 一対の走行電磁弁V5Lは、パイロットポンプと走行制御弁V10Lの一対の走行パイロットポートとの間にそれぞれ介在する電磁弁であり、電気信号である旋回指令信号の入力を受けて開閉動作を行う。一対の走行電磁弁V5Lは、走行指令信号の入力を受けるとその走行指令信号に応じた度合いに走行パイロット圧を調節する。
 一対の走行電磁弁V5Rは、パイロットポンプと走行制御弁V10Rの一対の走行パイロットポートとの間にそれぞれ介在する電磁弁であり、電気信号である旋回指令信号の入力を受けて開閉動作を行う。走行電磁弁V5Rは、走行指令信号の入力を受けるとその走行指令信号に応じた度合いに走行パイロット圧を調節する。
 形状センサ101は、油圧ショベル1の周囲の地形の形状を示す形状データを取得する。形状センサ101は、油圧ショベル1の周囲の地形の距離分布を示す形状データを検出する。形状センサ101は、例えば、LIDAR(light detection and ranging)などの3次元の測距センサを含む。形状センサ101はLIDARの他、赤外線を用いた測距センサ及び超音波を用いた測距センサなど、距離分布を計測できるセンサであれば、どのようなセンサを含んでいてもよい。本実施の形態では、形状センサ101は、例えば上部旋回体12、作業装置14又は下部走行体10において、画角の中心線が下斜め前方を向くように取り付けられている。以下の説明では、形状センサ101は、上部旋回体12の上部に取り付けられているものとして説明する。形状データは、例えば形状センサ101からの地形までの深度を示す深度データがマトリックス状に配列された距離画像データである。形状センサ101は、検出した形状データをコントローラ100に入力する。
 傾斜センサ102は、接地面(水平面)に対する下部走行体10の下面の傾斜角度である接地面角度を検出する。傾斜センサ102は、例えば加速度センサ及び角速度センサの機能を有する慣性センサを含む。傾斜センサ102は、慣性センサの検出信号に基づいてストラップダウン方式などにより接地面角度を検出する。傾斜センサ102は、検出した接地面角度をこれらに対応する電気信号である検出信号に変換してコントローラ100に入力する。
 姿勢センサ103は、作業装置14の姿勢を検出する。姿勢センサ103は、図1に示すブーム角度センサ61、アーム角度センサ62及びバケット角度センサ63を含む。ブーム角度センサ61は、上部旋回体12に対するブーム21の回転角度であるブーム角度を検出する。アーム角度センサ62は、ブーム21に対するアーム22の回転角度であるアーム角度を検出する。バケット角度センサ63は、アーム22に対するバケット23の回転角度であるバケット角度を検出する。ブーム角度センサ61、アーム角度センサ62及びバケット角度センサ63は、それぞれ、レゾルバ又はロータリーエンコーダなどで構成される。姿勢センサ103は、検出したブーム角度、アーム角度及びバケット角度をこれらに対応する電気信号である検出信号に変換してコントローラ100に入力する。
 旋回センサ104は、下部走行体10に対する上部旋回体12の旋回角度を検出する。旋回センサ104は、例えば、レゾルバ又はロータリーエンコーダなどで構成される。旋回センサ104は、検出した旋回角度をこれに対応する電気信号である検出信号に変換してコントローラ100に入力する。
 ブーム操作装置105は、ブーム上げ動作又はブーム下げ動作のためのオペレータからの操作を受け付けるブーム操作レバーと、ブーム操作レバーの操作量に応じたブーム操作信号をコントローラ100に入力する操作信号生成部とを含む電気レバー装置で構成されている。
 アーム操作装置106は、アーム引き動作又はアーム押し動作のためのオペレータからの操作を受け付けるアーム操作レバーと、アーム操作レバーの操作量に応じたアーム操作信号をコントローラ100に入力する操作信号生成部とを含む電気レバー装置で構成されている。
 バケット操作装置107は、バケット掬い動作又はバケット開き動作のためのオペレータからの操作を受け付けるバケット操作レバーと、バケット操作レバーの操作量に応じたバケット操作信号をコントローラ100に入力する操作信号生成部とを含む電気レバー装置で構成されている。
 旋回操作装置108は、上部旋回体12を右旋回又は左旋回させるためのオペレータからの操作を受け付ける旋回操作レバーと、旋回操作レバーの操作量に応じた旋回操作信号をコントローラ100に入力する操作信号生成部とを含む電気レバー装置で構成されている。
 走行操作装置109は、下部走行体10を前進又は後進させるためのオペレータからの操作を受け付ける走行操作レバーと、走行操作レバーの操作量に応じた走行操作信号をコントローラ100に入力する操作信号生成部とを含む電気レバー装置で構成されている。
 コントローラ100は、例えばマイクロコンピュータからなり、演算部110及び指令部120を備える。演算部110は、油圧ショベル1が周囲の特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たす場合に、作業装置14の先端部を斜面に向けて降下させる転倒防止制御を行う。指令部120は、油圧回路200に含まれる各要素の作動を制御する機能を担う。
 指令部120は、ブーム指令部121、アーム指令部122、バケット指令部123、旋回指令部124及び走行指令部125を備える。
 ブーム指令部121は、ブーム操作装置105の操作量に応じた値のブーム指令信号を一対のブーム電磁弁V1に入力することで該ブーム操作装置105の操作量に応じた開度にブーム電磁弁V1の開度を設定するが増大するほどブームシリンダC1へ供給される作動油の流量が増大する。
 アーム指令部122は、アーム操作装置106の操作量に応じた値のアーム指令信号を一対のアーム電磁弁V2に入力することで該アーム操作装置106の操作量に応じた開度にアーム電磁弁V2の開度を設定する。
 バケット指令部123は、バケット操作装置107の操作量に応じた値のバケット指令信号を一対のバケット電磁弁V3に入力することで該バケット操作装置107の操作量に応じた開度にバケット電磁弁V3の開度を設定する。
 旋回指令部124は、旋回操作装置108の操作量に応じた値の旋回指令信号を旋回電磁弁V4に入力することで該旋回操作装置108の操作量に応じた開度に旋回電磁弁V4の開度を設定する。
 走行指令部125は、走行操作装置109の操作量に応じた値の走行指令信号を一対の走行電磁弁V5L及び一対の走行電磁弁V5Rに入力することで該走行操作装置109の操作量に応じた開度に一対の走行電磁弁V5L及び一対の走行電磁弁V5Rそれぞれの開度を設定する。
 演算部110は、座標系変換部111、判断部112及び降下制御部113を備える。
 座標系変換部111は、形状センサ101で検出された形状データを、油圧ショベル1を基準とする機械座標系のデータに変換する。機械座標系は、例えば、長手方向(前後方向)をX軸、左右方向をY軸、上下方向をZ軸、上部旋回体12の旋回軸上における上部旋回体12と下部走行体10との接合部分を原点とする3次元の直交座標系である。なお、機械座標系のX軸、Y軸、Z軸及び原点は上記に限定されない。機械座標系の原点は、例えば、作業装置14の基端部(ブーム21の基端部)であってもよい。
 形状センサ101は上部旋回体12に取り付けられているため、機械座標系における形状センサ101の位置は上部旋回体12の旋回角度に応じて変化する。そこで、座標系変換部111は、旋回センサ104が検出した旋回角度を用いて、機械座標系における形状センサ101の位置を算出し、この位置から形状センサ101の座標系と機械座標系との相対的な位置関係を特定し、特定した相対的な位置関係に基づいて形状データを機械座標系のデータに変換する。形状センサ101は、マトリックス状の複数の検出地点の深度データにより地形を表す。そのため、座標系変換部111は、複数の検出地点までの深度(距離)から、機械座標系における各検出地点の座標を算出する。
 なお、形状センサ101が作業装置14に配置されている場合は、形状データを機械座標系のデータに変換するに際して、姿勢センサ103の検出信号と旋回角度とが必要となる。また、形状センサ101が下部走行体10に配置されている場合は、形状センサ101の機械座標系における位置は一定であるため、形状データを機械座標系に変換するに際して姿勢センサ103の検出信号と旋回角度とは不要である。
 判断部112は、形状データに基づいて、油圧ショベル1が周囲の特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かを判断する。本実施の形態における転倒防止制御は、作業装置14の先端部を斜面に向けて降下させる制御である。判断部112は、傾斜角度算出部114、作動条件判断部115及び状態判定部116を備える。
 傾斜角度算出部114は、形状データに基づいて油圧ショベル1の接地面に対する斜面の傾斜角度を算出する。
 図3は、本実施の形態において、油圧ショベルが斜面の路肩近傍で作業している場面の一例を示す図である。以下、図3を用いて傾斜角度算出部114の処理について説明する。油圧ショベル1は、斜面301の路肩302で作業をしている。なお、斜面301は、例えば法面であり、法面は、切土又は盛土により作られる人工的な斜面である。路肩302は、斜面301の上端に連なる面である。路肩302は水平である。傾斜角度θ1は、油圧ショベル1の接地面SAに対する斜面301の傾斜角度である。ここでは、油圧ショベル1は路肩302に位置するため、接地面SAは路肩302となる。斜面301は、油圧ショベル1が作業装置14により切土又は盛土等の作業を行う面である。
 傾斜角度算出部114は、機械座標系に変換した形状データから傾斜角度θ1を算出する。この場合、傾斜角度算出部114は、下部走行体10の接地面SAと斜面301との境界線を形状データから検出し、境界線を挟んで接地面SAの反対側の所定範囲の領域を斜面候補領域として抽出する。次に、傾斜角度算出部114は、境界線に対して直交する方向を斜面301の傾斜方向として設定し、斜面候補領域から傾斜方向と平行な1ラインの座標データ群を抽出し、抽出したデータ群の回帰直線を求める。次に、傾斜角度算出部114は、この回帰直線のXY平面に対する角度、すなわち、接地面SAに対する角度を傾斜角度として算出する。このとき、傾斜角度算出部114は、回帰直線の決定係数が所定の値以下であれば、形状データには、斜面301は含まれていないと判定し、決定係数が所定の値より大きければ、斜面301が含まれていると判定してもよい。
 あるいは、傾斜角度算出部114は、斜面候補領域から傾斜方向に平行な複数ラインの座標データ群を抽出し、複数ラインのそれぞれについて回帰直線を求め、複数の回帰直線のそれぞれについて接地面SAに対する角度を算出し、各角度が一定の角度範囲にあり、且つ、複数の回帰直線のそれぞれの決定係数が所定の閾値より大きければ、形状データには斜面301が含まれていると判定してもよい。そして、この場合、傾斜角度算出部114は、接地面SAに対する各回帰直線の角度の平均値を傾斜角度θ1として算出してもよい。
 状態判定部116は、油圧ショベル1が安定状態と不安定状態とのいずれであるかを判定する。下部走行体10の下面全体が接地面SAに接している場合、油圧ショベル1は安定状態となる。しかしながら、図3において、油圧ショベル1の足場部分303が斜面301に向かって崩落し、下部走行体10の下面の一部のみが接地面SAに接する場合、油圧ショベル1は前方に傾き、不安定状態となる。
 図4は、本実施の形態において、油圧ショベルの足場部分が崩落した場面の一例を示す図である。
 図4に示すように、油圧ショベル1の足場部分303が斜面301に向かって崩落した場合、油圧ショベル1は前方に傾く。このとき、傾斜センサ102は、下部走行体10の接地面(水平面)SAに対する傾斜角度である接地面角度θ2を検出する。油圧ショベル1が前方に傾くことにより、油圧ショベル1の鉛直方向の加速度が増加する。そこで、状態判定部116は、油圧ショベル1の加速度を取得し、取得した加速度が閾値より大きい場合、油圧ショベル1が不安定状態であると判定する。状態判定部116は、傾斜センサ102によって検出された接地面角度θ2を微分することにより、油圧ショベル1の加速度を算出する。状態判定部116は、算出した加速度が閾値より大きいか否かを判断する。そして、状態判定部116は、算出した加速度が閾値より大きいと判断した場合、油圧ショベル1が不安定状態であると判定する。
 なお、本実施の形態では、傾斜センサ102によって検出された接地面角度θ2から加速度を算出しているが、本開示は特にこれに限定されず、油圧ショベル1に加速度センサを設け、加速度センサが油圧ショベル1の加速度を検出してもよい。
 作動条件判断部115は、傾斜角度算出部114によって算出された傾斜角度が閾値よりも大きく、かつ状態判定部116によって油圧ショベル1が不安定状態であると判定された場合、油圧ショベル1が前方の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすと判断する。
 降下制御部113は、判断部112によって作動条件を満たすと判断された場合、作業装置14の先端部を斜面に向けて降下させる転倒防止制御を作動させる。降下制御部113は、作業装置14の先端部と斜面との間の距離が最短となる経路に沿って作業装置14の先端部を斜面に向けて降下させる。
 すなわち、降下制御部113は、姿勢センサ103によって検出されたブーム角度、アーム角度及びバケット角度と、ブーム21、アーム22及びバケット23それぞれの基端部から先端部までの長さとに基づいて、機械座標系における作業装置14の先端部の座標を算出する。作業装置14の先端部は、バケット23の先端部231である。ブーム21、アーム22及びバケット23それぞれの基端部から先端部までの長さは、不図示のメモリに予め記憶されている。降下制御部113は、斜面候補領域内の座標データ群の中から、バケット23の先端部231の座標からの距離が最短となる斜面上の地点304の座標を特定する。そして、降下制御部113は、バケット23の先端部231の座標と、バケット23の先端部231の座標からの距離が最短となる斜面上の地点304の座標とを結ぶ直線を、バケット23の先端部231が移動する経路401として算出する。降下制御部113は、算出した経路401に沿ってバケット23の先端部231を移動させるためのブーム制御信号、アーム制御信号及びバケット制御信号を生成し、生成したブーム制御信号、アーム制御信号及びバケット制御信号を指令部120へ出力する。
 なお、ブーム指令部121は、降下制御部113の制御量に応じた値のブーム指令信号を一対のブーム電磁弁V1に入力する。また、アーム指令部122は、降下制御部113の制御量に応じた値のアーム指令信号を一対のアーム電磁弁V2に入力する。また、バケット指令部123は、降下制御部113の制御量に応じた値のバケット指令信号を一対のバケット電磁弁V3に入力する。
 図5は、本実施の形態において、油圧ショベルの作業装置の先端部を斜面に向けて降下させた場面の一例を示す図である。
 降下制御部113は、作業装置14の先端部231の位置と斜面の位置との距離が所定の範囲内になる到達位置まで作業装置14の先端部を降下させる。到達位置は、作業装置14の先端部231が斜面301を超える位置である。降下制御部113は、作業装置14の先端部231が斜面301を超える位置まで、作業装置14の先端部231を降下させる。これにより、作業装置14の先端部231が斜面301に突き刺さり、より確実に油圧ショベル1を安定させることができる。
 なお、到達位置は、斜面301よりも手前の位置であってもよい。降下制御部113は、斜面301よりも手前の位置まで、作業装置14の先端部231を降下させてもよい。これにより、作業装置14の先端部231が到達位置に到達するまでの時間がより短くなり、より早く油圧ショベル1を安定させることができる。
 また、油圧ショベル1は、ブームシリンダC1の圧力値を検出するブームシリンダ圧センサと、アームシリンダC2の圧力値を検出するアームシリンダ圧センサとをさらに備えてもよい。そして、降下制御部113は、ブームシリンダ圧センサ又はアームシリンダ圧センサによって所定値以上の圧力値が検出されるまで、作業装置14の先端部を降下させてもよい。作業装置14の先端部が地面に押し付けられることにより、ブームシリンダC1又はアームシリンダC2の圧力値が上昇する。そのため、ブームシリンダ圧センサ又はアームシリンダ圧センサによって検出される圧力値が所定値以上になるまで、作業装置14の先端部を降下させることにより、作業装置14の先端部を地面に充分に押し付けることができ、確実に油圧ショベル1を安定させることができる。
 また、降下制御部113は、判断部112によって作動条件を満たすと判断された場合、オペレータによる操作を受け付けずに作業装置14の先端部を斜面に向けて自動的に降下させ、作業装置14の先端部を到達位置まで降下させた後、オペレータによる操作を受け付ける。すなわち、降下制御部113は、判断部112によって作動条件を満たすと判断された場合、ブーム操作装置105、アーム操作装置106、バケット操作装置107、旋回操作装置108及び走行操作装置109からの各操作信号を受け付けない。そして、降下制御部113は、作業装置14の先端部を到達位置まで降下させた後、ブーム操作装置105、アーム操作装置106、バケット操作装置107、旋回操作装置108及び走行操作装置109からの各操作信号を受け付ける。これにより、作業装置14の先端部が斜面に到達した後、オペレータによる操作が受け付けられるので、油圧ショベル1を安定させた後、例えば、バケット23の先端部を斜面に押し付けた状態で、油圧ショベル1を後方に移動させる等のオペレータによる転倒回避操作を行うことができる。
 図6は、図2に示す油圧ショベルの動作を示すフローチャートである。なお、図6に示す処理は、油圧ショベル1の稼働中、所定の周期で繰り返し実行される。
 まず、ステップS1において、形状センサ101は、油圧ショベル1の周囲の地形の距離分布を示す形状データを取得する。
 次に、ステップS2において、旋回センサ104は、下部走行体10に対する上部旋回体12の旋回角度を取得する。
 次に、ステップS3において、座標系変換部111は、取得された旋回角度を用いて、取得された形状センサ101を基準とする座標系で表される形状データを、油圧ショベル1を基準とする機械座標系で表される形状データに変換する。
 次に、ステップS4において、傾斜角度算出部114は、座標系変換部111によって変換された機械座標系の形状データに基づいて、油圧ショベル1の接地面に対する前方の斜面の傾斜角度を算出する。
 次に、ステップS5において、傾斜センサ102は、接地面(水平面)に対する下部走行体10の下面の傾斜角度である接地面角度を取得する。
 次に、ステップS6において、状態判定部116は、傾斜センサ102によって取得された接地面角度から加速度を算出する。
 次に、ステップS7において、状態判定部116は、算出した加速度に基づいて、油圧ショベル1が安定状態と不安定状態とのいずれであるかを判定する。ここで、状態判定部116は、算出した加速度が閾値より大きいか否かを判断する。そして、状態判定部116は、算出した加速度が閾値以下であると判断した場合、油圧ショベル1が安定状態であると判定する。また、状態判定部116は、算出した加速度が閾値より大きいと判断した場合、油圧ショベル1が不安定状態であると判定する。
 次に、ステップS8において、作動条件判断部115は、傾斜角度算出部114によって算出された傾斜角度が閾値よりも大きく、かつ状態判定部116によって判定された油圧ショベル1の状態が不安定状態であるか否かを判断する。
 ここで、傾斜角度が閾値以下である、又は油圧ショベル1の状態が安定状態であると判断された場合(ステップS8でNO)、処理が終了する。
 一方、傾斜角度が閾値よりも大きく、かつ油圧ショベル1の状態が不安定状態であると判断された場合(ステップS8でYES)、ステップS9において、降下制御部113は、オペレータによる操作を禁止する。すなわち、降下制御部113は、ブーム操作装置105、アーム操作装置106、バケット操作装置107、旋回操作装置108及び走行操作装置109からの各操作信号を受け付けずに破棄する。
 次に、ステップS10において、姿勢センサ103は、作業装置14の姿勢を検出する。姿勢センサ103は、ブーム角度、アーム角度及びバケット角度を作業装置14の姿勢として検出する。
 次に、ステップS11において、降下制御部113は、姿勢センサ103によって検出されたブーム角度、アーム角度及びバケット角度と、ブーム21、アーム22及びバケット23それぞれの基端部から先端部までの長さとに基づいて、機械座標系における作業装置14の先端部の座標を算出する。
 次に、ステップS12において、降下制御部113は、斜面候補領域内の座標データ群の中から、作業装置14の先端部の座標からの距離が最短となる斜面上の地点の座標を特定する。
 次に、ステップS13において、降下制御部113は、作業装置14の先端部の移動経路を算出する。すなわち、降下制御部113は、作業装置14の先端部の座標と、作業装置14の先端部の座標からの距離が最短となる斜面上の地点の座標とを結ぶ直線を、作業装置14の先端部の移動経路として算出する。
 次に、ステップS14において、降下制御部113は、算出した移動経路に沿って作業装置14の先端部を斜面に向けて降下させるように、指令部120に各指令信号を出力させる。ここで、降下制御部113は、算出した移動経路に沿って作業装置14の先端部を斜面に向けて降下させるためのブーム制御信号、アーム制御信号及びバケット制御信号を生成し、生成したブーム制御信号、アーム制御信号及びバケット制御信号を指令部120へ出力する。ブーム指令部121は、降下制御部113から入力されたブーム制御信号に応じた値のブーム指令信号を一対のブーム電磁弁V1に入力する。アーム指令部122は、降下制御部113から入力されたアーム制御信号に応じた値のアーム指令信号を一対のアーム電磁弁V2に入力する。バケット指令部123は、降下制御部113から入力されたバケット制御信号に応じた値のバケット指令信号を一対のバケット電磁弁V3に入力する。これにより、ブームシリンダC1、アームシリンダC2及びバケットシリンダC3が駆動され、作業装置14の先端部が斜面に向けて降下する。
 次に、ステップS15において、降下制御部113は、オペレータによる操作を受け付ける。すなわち、降下制御部113は、ブーム操作装置105、アーム操作装置106、バケット操作装置107、旋回操作装置108及び走行操作装置109からの各操作信号を受け付ける。
 このように、油圧ショベル1が前方の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かが判断され、当該作動条件を満たすと判断された場合、作業装置14の先端部が斜面に向けて降下するので、作業装置14の先端部が斜面に押し付けられ、作業装置14の先端部により油圧ショベル1を支えることにより、油圧ショベル1が転倒するのを自動的に防止することができるとともに、確実に油圧ショベル1の安全を確保することができる。
 なお、本実施の形態は、下部走行体10の前方が斜面301に向けられた状態での転倒防止制御を行うものを開示したが、本開示はこれに限定されず、下部走行体10の前方が斜面301に向けられていない状態での転倒防止制御を行うものであってもよい。この場合、図3のように油圧ショベル1が作業装置14により切土又は盛土等の作業を行う斜面301に対する油圧ショベル1の相対方向を特定方向として記憶すればよい。このようにすれば、下部走行体10が斜面301に向けられていない状態であり、上部旋回体12が下部走行体10に対して旋回しており、作業装置14により斜面301で作業を行うことで、油圧ショベル1が斜面301に向かって転倒するおそれがあるときに、転倒防止制御を作用させるこができる。
 なお、本実施の形態では、形状センサ101が検出した形状データを用いて斜面301が検出されていたが、本開示はこれに限定されず、予め計測された形状データをメモリから取得する、或いは、外部サーバから通信により形状データを取得することで斜面301を検出してもよい。この場合、傾斜角度算出部114は、不図示のGPSセンサから油圧ショベル1の現在位置を取得し、取得した形状データに油圧ショベル1の現在位置をプロットすることで、形状データから油圧ショベル1の周囲の斜面301を検出すればよい。
 また、油圧ショベル1は、油圧ショベル1が転倒するのを防止するために作業装置14の先端部を自動的に降下させたことをオペレータに通知するための情報を提示する情報提示装置をさらに備えてもよい。情報提示装置は、例えば、表示装置又はスピーカである。
 また、本実施の形態では、判断部112は、傾斜角度算出部114、作動条件判断部115及び状態判定部116を備えているが、本開示は特にこれに限定されず、判断部112は、状態判定部116を備えず、傾斜角度算出部114及び作動条件判断部115を備えてもよい。この場合、作動条件判断部115は、傾斜角度算出部114によって算出された傾斜角度が閾値よりも大きいか否かを判断してもよい。作動条件判断部115は、傾斜角度が閾値よりも大きい場合、作動条件を満たすと判断してもよい。
 (実施の形態の纏め)
 本実施の形態の技術的特徴は下記のように纏められる。
 本開示の一態様に係る安全装置は、機体と、前記機体に取り付けられる作業装置とを備える建設機械の安全を確保する安全装置であって、前記建設機械の周囲の地形の形状を示す形状データを取得する取得部と、前記形状データに基づいて、前記建設機械が前記周囲の特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かを判断する判断部と、前記判断部によって前記作動条件を満たすと判断された場合、前記作業装置の先端部を前記斜面に向けて降下させる降下制御部と、を備える。
 この構成によれば、建設機械が特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かが判断され、当該作動条件を満たすと判断された場合、作業装置の先端部が斜面に向けて降下するので、作業装置の先端部が斜面に押し付けられ、作業装置の先端部により建設機械を支えることにより、建設機械が転倒するのを自動的に防止することができるとともに、確実に建設機械の安全を確保することができる。
 また、上記の安全装置において、前記判断部は、前記形状データに基づいて前記建設機械の接地面に対する前記斜面の傾斜角度を算出し、前記傾斜角度が閾値よりも大きい場合、前記作動条件を満たすと判断してもよい。
 この構成によれば、建設機械の特定方向の斜面の傾斜角度が閾値よりも大きい場合、作動条件を満たすと判断され、作業装置の先端部が斜面に向けて降下するので、建設機械が転倒する可能性が高い場合に、未然に建設機械が転倒するのを防止することができる。
 また、上記の安全装置において、前記判断部は、前記形状データに基づいて前記建設機械の接地面に対する斜面の傾斜角度を算出し、前記建設機械が不安定状態であるかを判定し、前記傾斜角度が閾値よりも大きく、かつ前記建設機械が不安定状態であると判定した場合、前記作動条件を満たすと判断してもよい。
 この構成によれば、建設機械の接地面に対する斜面の傾斜角度が閾値よりも大きく、かつ建設機械が不安定状態となった場合に、建設機械が転倒するのを自動的に防止することができる。
 また、上記の安全装置において、前記判断部は、前記建設機械の加速度を取得し、取得した前記加速度が閾値より大きい場合、前記建設機械が不安定状態であると判定してもよい。
 この構成によれば、例えば、建設機械の足場が斜面に向かって崩落し、建設機械が特定方向に傾いた場合に、建設機械の加速度が閾値より大きくなるので、確実に建設機械が不安定状態であると判定することができる。
 また、上記の安全装置において、前記降下制御部は、前記作業装置の先端部と前記斜面との間の距離が最短となる経路に沿って前記作業装置の先端部を前記斜面に向けて降下させてもよい。
 この構成によれば、作業装置の先端部と斜面との間の距離が最短となる経路に沿って作業装置の先端部が斜面に向けて降下するので、作業装置の先端部を最短距離で斜面に向けて降下させることができ、より迅速に建設機械が転倒するのを自動的に防止することができる。
 また、上記の安全装置において、前記降下制御部は、前記作業装置の先端部の位置と前記斜面の位置との距離が所定の範囲内になる到達位置まで前記作業装置の先端部を降下させてもよい。
 この構成によれば、作業装置の先端部の位置と斜面の位置との距離が所定の範囲内になる到達位置まで作業装置の先端部が降下するので、例えば、建設機械を作業装置で支えることが可能な位置まで作業装置の先端部を降下させることにより、確実に建設機械が転倒するのを防止することができる。
 また、上記の安全装置において、前記到達位置は、前記作業装置の先端部が前記斜面を超える位置であってもよい。
 この構成によれば、作業装置の先端部が斜面を超える位置まで作業装置の先端部を降下させることにより、作業装置の先端部が斜面に突き刺さり、より確実に建設機械を安定させることができる。
 また、上記の安全装置において、前記降下制御部は、前記判断部によって前記作動条件を満たすと判断された場合、オペレータによる操作を受け付けずに前記作業装置の先端部を前記斜面に向けて降下させ、前記作業装置の先端部を前記到達位置まで降下させた後、前記オペレータによる操作を受け付けてもよい。
 この構成によれば、作動条件を満たすと判断された場合、オペレータによる操作を受け付けずに作業装置の先端部が斜面に向けて降下し、作業装置の先端部が到達位置まで降下した後、オペレータによる操作が受け付けられるので、建設機械を安定させた後、例えば、作業装置の先端部を斜面に押し付けた状態で、建設機械を後方に移動させる等のオペレータによる転倒回避操作を行うことができる。
 本開示の他の態様に係る建設機械は、上記のいずれかに記載の安全装置と、機体と、前記機体に取り付けられた作業装置と、を備える。
 この構成によれば、建設機械が特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かが判断され、当該作動条件を満たすと判断された場合、作業装置の先端部が斜面に向けて降下するので、作業装置の先端部が斜面に押し付けられ、作業装置の先端部により建設機械を支えることにより、建設機械が転倒するのを自動的に防止することができるとともに、確実に建設機械の安全を確保することができる。
 なお、発明を実施するための形態の項においてなされた具体的な実施態様又は実施例は、あくまでも、本開示の技術内容を明らかにするものであって、そのような具体例にのみ限定して狭義に解釈されるべきものではなく、本開示の精神と特許請求事項との範囲内で、種々変更して実施することができるものである。
 本開示に係る安全装置及び建設機械は、建設機械が転倒するのを自動的に防止することができるとともに、確実に建設機械の安全を確保することができるので、建設機械の安全を確保する安全装置及び建設機械として有用である。

Claims (9)

  1.  機体と、前記機体に取り付けられる作業装置とを備える建設機械の安全を確保する安全装置であって、
     前記建設機械の周囲の地形の形状を示す形状データを取得する取得部と、
     前記形状データに基づいて、前記建設機械が前記周囲の特定方向の斜面に向かって転倒するのを防止するための転倒防止制御を作動させる作動条件を満たすか否かを判断する判断部と、
     前記判断部によって前記作動条件を満たすと判断された場合、前記作業装置の先端部を前記斜面に向けて降下させる降下制御部と、
     を備える安全装置。
  2.  前記判断部は、前記形状データに基づいて前記建設機械の接地面に対する前記斜面の傾斜角度を算出し、前記傾斜角度が閾値よりも大きい場合、前記作動条件を満たすと判断する、
     請求項1記載の安全装置。
  3.  前記判断部は、前記形状データに基づいて前記建設機械の接地面に対する斜面の傾斜角度を算出し、前記建設機械が不安定状態であるかを判定し、前記傾斜角度が閾値よりも大きく、かつ前記建設機械が不安定状態であると判定した場合、前記作動条件を満たすと判断する、
     請求項1記載の安全装置。
  4.  前記判断部は、前記建設機械の加速度を取得し、取得した前記加速度が閾値より大きい場合、前記建設機械が不安定状態であると判定する、
     請求項3記載の安全装置。
  5.  前記降下制御部は、前記作業装置の先端部と前記斜面との間の距離が最短となる経路に沿って前記作業装置の先端部を前記斜面に向けて降下させる、
     請求項1~4のいずれか1項に記載の安全装置。
  6.  前記降下制御部は、前記作業装置の先端部の位置と前記斜面の位置との距離が所定の範囲内になる到達位置まで前記作業装置の先端部を降下させる、
     請求項1~5のいずれか1項に記載の安全装置。
  7.  前記到達位置は、前記作業装置の先端部が前記斜面を超える位置である、
     請求項6記載の安全装置。
  8.  前記降下制御部は、前記判断部によって前記作動条件を満たすと判断された場合、オペレータによる操作を受け付けずに前記作業装置の先端部を前記斜面に向けて降下させ、前記作業装置の先端部を前記到達位置まで降下させた後、前記オペレータによる操作を受け付ける、
     請求項6又は7記載の安全装置。
  9.  請求項1~8のいずれかに記載の安全装置と、
     機体と、
     前記機体に取り付けられた作業装置と、
     を備える建設機械。
PCT/JP2020/001805 2019-02-19 2020-01-21 安全装置及び建設機械 WO2020170687A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
EP20759411.0A EP3892781A4 (en) 2019-02-19 2020-01-21 SAFETY DEVICE AND CONSTRUCTION MACHINE
US17/427,373 US20220018095A1 (en) 2019-02-19 2020-01-21 Safety device and construction machine
CN202080008702.8A CN113272499A (zh) 2019-02-19 2020-01-21 安全装置以及工程机械

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019027259A JP2020133223A (ja) 2019-02-19 2019-02-19 安全装置及び建設機械
JP2019-027259 2019-02-19

Publications (1)

Publication Number Publication Date
WO2020170687A1 true WO2020170687A1 (ja) 2020-08-27

Family

ID=72144213

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/001805 WO2020170687A1 (ja) 2019-02-19 2020-01-21 安全装置及び建設機械

Country Status (5)

Country Link
US (1) US20220018095A1 (ja)
EP (1) EP3892781A4 (ja)
JP (1) JP2020133223A (ja)
CN (1) CN113272499A (ja)
WO (1) WO2020170687A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023032970A1 (ja) * 2021-08-31 2023-03-09 株式会社小松製作所 制御システム、制御方法および制御プログラム

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020133223A (ja) * 2019-02-19 2020-08-31 コベルコ建機株式会社 安全装置及び建設機械
US20220119228A1 (en) * 2020-10-21 2022-04-21 Cashman Dredging And Marine Contracting, Co., Llc Lidar loading system
JPWO2022210620A1 (ja) * 2021-03-29 2022-10-06
WO2023105944A1 (ja) * 2021-12-10 2023-06-15 日立建機株式会社 作業機械

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08269998A (ja) 1995-03-31 1996-10-15 Hitachi Constr Mach Co Ltd 建設機械の領域制限制御装置
JP2003090729A (ja) * 2001-09-20 2003-03-28 Mitsubishi Electric Corp ナビゲーション装置
JP2005104625A (ja) * 2003-09-29 2005-04-21 Komatsu Ltd 作業車両の転倒防止制御装置

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2618250B2 (ja) * 1987-12-22 1997-06-11 富士重工業株式会社 トラクション制御装置
US5854988A (en) * 1996-06-05 1998-12-29 Topcon Laser Systems, Inc. Method for controlling an excavator
US7532967B2 (en) * 2002-09-17 2009-05-12 Hitachi Construction Machinery Co., Ltd. Excavation teaching apparatus for construction machine
US8139108B2 (en) * 2007-01-31 2012-03-20 Caterpillar Inc. Simulation system implementing real-time machine data
JP5789279B2 (ja) * 2013-04-10 2015-10-07 株式会社小松製作所 掘削機械の施工管理装置、油圧ショベルの施工管理装置、掘削機械及び施工管理システム
ES2537895B1 (es) * 2013-11-14 2016-05-17 Empresa De Transf Agraria S A (Tragsa) Sistema y metodo para control de estabilidad en maquinaria pesada
US20170121930A1 (en) * 2014-06-02 2017-05-04 Komatsu Ltd. Construction machine control system, construction machine, and method of controlling construction machine
US9256227B1 (en) * 2014-09-12 2016-02-09 Caterpillar Inc. System and method for controlling the operation of a machine
US9617709B2 (en) * 2015-02-02 2017-04-11 Komatsu Ltd. Work vehicle and method of controlling work vehicle
CN105971050A (zh) * 2015-03-13 2016-09-28 住友重机械工业株式会社 挖掘机
CN107532400A (zh) * 2015-03-19 2018-01-02 住友建机株式会社 挖土机
DE112016000015B4 (de) * 2016-03-17 2017-10-26 Komatsu Ltd. Steuersystem für Arbeitsfahrzeug, Steuerverfahren und Arbeitsfahrzeug
JP6046320B1 (ja) * 2016-05-31 2016-12-14 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP7122802B2 (ja) * 2016-08-05 2022-08-22 株式会社小松製作所 作業車両の制御システム、制御方法、及び作業車両
JPWO2018062374A1 (ja) * 2016-09-30 2019-07-25 住友建機株式会社 ショベル
JP6723184B2 (ja) * 2017-03-28 2020-07-15 日立建機株式会社 稼働データ記憶装置
CA2990943C (en) * 2017-03-31 2020-06-16 Komatsu Ltd. Control system of transporter vehicle, transporter vehicle, and control method of transporter vehicle
JP6824830B2 (ja) * 2017-06-19 2021-02-03 株式会社神戸製鋼所 転倒防止装置及び作業機械
KR102055222B1 (ko) * 2017-06-30 2019-12-12 가부시키가이샤 고마쓰 세이사쿠쇼 촬상 장치, 건설 기계 및 촬상 시스템
JP2020133223A (ja) * 2019-02-19 2020-08-31 コベルコ建機株式会社 安全装置及び建設機械

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08269998A (ja) 1995-03-31 1996-10-15 Hitachi Constr Mach Co Ltd 建設機械の領域制限制御装置
JP2003090729A (ja) * 2001-09-20 2003-03-28 Mitsubishi Electric Corp ナビゲーション装置
JP2005104625A (ja) * 2003-09-29 2005-04-21 Komatsu Ltd 作業車両の転倒防止制御装置

Non-Patent Citations (1)

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

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023032970A1 (ja) * 2021-08-31 2023-03-09 株式会社小松製作所 制御システム、制御方法および制御プログラム

Also Published As

Publication number Publication date
CN113272499A (zh) 2021-08-17
EP3892781A4 (en) 2022-03-02
EP3892781A1 (en) 2021-10-13
JP2020133223A (ja) 2020-08-31
US20220018095A1 (en) 2022-01-20

Similar Documents

Publication Publication Date Title
WO2020170687A1 (ja) 安全装置及び建設機械
JP7358349B2 (ja) 掘削機、情報処理装置
JP5654144B1 (ja) 建設機械の制御システム及び制御方法
KR101907938B1 (ko) 건설 기계의 제어 장치 및 건설 기계의 제어 방법
KR101821470B1 (ko) 굴삭 기계의 제어 시스템 및 굴삭 기계
JP6872945B2 (ja) 建設機械
KR102430343B1 (ko) 건설 기계
KR20210089676A (ko) 쇼벨, 쇼벨의 제어장치
WO2020166241A1 (ja) 監視装置及び建設機械
CN113039327B (zh) 挖土机、挖土机的控制装置
EP3862491B1 (en) Excavator
JP2019108722A (ja) 建設機械
KR20210089673A (ko) 쇼벨, 쇼벨의 제어장치
JP2021059945A (ja) ショベル
KR102579791B1 (ko) 건설 기계
JP7449314B2 (ja) ショベル、遠隔操作支援装置
KR20240011803A (ko) 굴삭 기계의 가동 범위 설정 시스템 및 그 제어 방법
JP2020133225A (ja) 安全装置及び建設機械
JP2021156078A (ja) ショベル
JP6781068B2 (ja) 作業機械の制御システム、作業機械及び作業機械の制御方法
WO2024111434A1 (ja) ショベルの制御装置
JP2022154674A (ja) ショベル
JP2021055433A (ja) ショベル
JP2022046978A (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: 20759411

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2020759411

Country of ref document: EP

Effective date: 20210709

NENP Non-entry into the national phase

Ref country code: DE