WO2011148946A1 - 作業機械の安全装置 - Google Patents

作業機械の安全装置 Download PDF

Info

Publication number
WO2011148946A1
WO2011148946A1 PCT/JP2011/061886 JP2011061886W WO2011148946A1 WO 2011148946 A1 WO2011148946 A1 WO 2011148946A1 JP 2011061886 W JP2011061886 W JP 2011061886W WO 2011148946 A1 WO2011148946 A1 WO 2011148946A1
Authority
WO
WIPO (PCT)
Prior art keywords
zmp
work machine
stability
work
warning
Prior art date
Application number
PCT/JP2011/061886
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 KR1020127030464A priority Critical patent/KR101790150B1/ko
Priority to US13/699,094 priority patent/US8768581B2/en
Priority to JP2012517279A priority patent/JP5491627B2/ja
Priority to EP11786645.9A priority patent/EP2578757B1/en
Priority to CN201180024959.3A priority patent/CN102906347B/zh
Publication of WO2011148946A1 publication Critical patent/WO2011148946A1/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/24—Safety devices, e.g. for preventing overload
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
    • B66C23/88—Safety gear
    • B66C23/90—Devices for indicating or limiting lifting moment
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
    • B66C23/88—Safety gear
    • B66C23/90—Devices for indicating or limiting lifting moment
    • B66C23/905—Devices for indicating or limiting lifting moment electrical
    • 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
    • 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/26—Indicating devices
    • E02F9/264—Sensors and their calibration for indicating the position of the work tool

Definitions

  • the present invention relates to a safety device for a work machine, and more particularly to a safety device for notifying an operator of information related to machine stability in a self-propelled work machine used for dismantling work, construction work, civil engineering work, and the like.
  • a revolving body is pivotably mounted on the upper part of a traveling body that is driven by a power system, and an articulated work front is attached to the revolving body.
  • a work machine used for structure demolition work, waste demolition work, civil engineering construction work, etc.
  • a revolving body is pivotably mounted on the upper part of a traveling body that is driven by a power system, and an articulated work front is attached to the revolving body.
  • An example of such a work machine is a demolition work machine based on a hydraulic excavator. This demolition work machine connects the work front consisting of a boom and an arm to the swivel so that it can swing up and down, and attaches work tools such as grapple, bucket, breaker, crusher to the tip of the arm, Work such as waste demolition work can be done.
  • Such a work machine performs work by changing various postures with the boom, arm, and work tool constituting the work front projecting outward from the revolving structure. May fall out of balance. For this reason, the operator needs to work safely while accurately grasping the current stability of the work machine or the possibility of falling.
  • the stability refers to the extent to which the work machine can continue working on the work surface stably without falling down.
  • the center of gravity position and the load load of the crawler crane are calculated from the output values of the load meter installed in the outrigger portion of the crawler crane and the inclinometer installed in the crawler, In the figure, it is determined whether the calculated center of gravity position is in a predetermined region, and the center of gravity position is displayed on a monitor using a color determined for each region.
  • Patent Document 2 includes an outrigger extension width sensor and an outrigger reaction force sensor, calculates a fall limit from an output value of the outrigger extension width sensor, and falls in front, rear, left and right from an output value of the outrigger reaction force sensor.
  • the calculated center of gravity of the crane is calculated from the output values of the outrigger extension width sensor and the outrigger reaction force sensor, and these are displayed on the display device. If there is a risk of falling, a warning is given. And a device that prevents the fall by fixing the passive joint of the outrigger is shown.
  • the work machine is used for various work, and there is a case where a quick operation is required or a change of operation occurs.
  • inertial force is generated by the movement of the work front or the work machine itself, which is relatively limited in operations such as crane work, compared to quasi-static work with little change in operation.
  • the inertial force due to the dynamic (rapid) movement of the machine has a great influence on the stability.
  • the influence of such dynamic motion is not taken into consideration.
  • the present invention has been made in view of the above-described problems, and provides a safety device for a work machine that can make an operator easily and accurately recognize the current stability at the time of work including a work front operation or turning. For the purpose.
  • the present invention employs the following means in order to solve the above problems.
  • a safety device for a work machine comprising a traveling body, a work machine body mounted on the travel body, a work front swingably attached to the work machine body in a vertical direction, and a control device for controlling the work front
  • the control device includes a plurality of ZMP calculating means for calculating the coordinates of the ZMP using position information, acceleration information, and external force information of the movable parts of the main body and the traveling body including the work front, and a plurality of grounds of the work machine.
  • a display device for displaying the ZMP position of the work machine relative to the support polygon, wherein the ZMP calculating means and the stability calculating means include the ZMP position and the warning area.
  • the present invention has the above-described configuration, it is possible to provide a safety device for a work machine capable of allowing an operator to easily and accurately recognize the current stability during work including operation front operation or turning. it can.
  • 1 is a side view showing a work machine according to a first embodiment. It is a block diagram which shows the safety device of the working machine concerning 1st Embodiment. It is a side view which shows the sensor structure of the working machine concerning 1st Embodiment. It is a side view which shows the working machine model for ZMP calculation concerning 1st Embodiment. It is a schematic diagram which shows the support polygon and fall warning area
  • FIG. 1 is a side view of a work machine to which the present invention is applied.
  • the swing body 3 is attached to the upper part of the traveling body 2 so as to be capable of swinging, and the swing body 3 is driven to swing around the central shaft 3 c by the swing motor 7.
  • An engine 5 that constitutes a cab 4 and a power system is attached to the revolving structure 3.
  • a counterweight 8 is provided behind the revolving structure 3.
  • 30 is the ground surface.
  • the swing body 3 further includes an operation control device that controls the start / stop of the work machine 1 and the overall operation.
  • the boom cylinder 11 is a drive actuator that rotates the boom 10 around the fulcrum 40, and is connected to the swing body 3 and the boom 10.
  • the arm cylinder 13 is a drive actuator that rotates the arm 12 around a fulcrum 41, and is connected to the boom 10 and the arm 12.
  • the work tool cylinder 15 is a drive actuator that rotates the bucket 23 around the fulcrum 42, and is connected to the bucket 23 via the link 16 and is connected to the arm 12 via the link 17.
  • the bucket 23 can be arbitrarily replaced with other work tools (not shown) such as grapples, cutters, and breakers.
  • an operation lever 50 for inputting a movement instruction for each drive actuator from the operator, and the stability of the work machine 1.
  • a display device 61d for displaying information, fall warning information, etc., an alarm device 63d for emitting a fall warning sound of the work machine 1, and a user setting input means 55 for an operator to set a safety device are provided.
  • FIG. 2 is a block diagram showing a schematic configuration related to the safety device.
  • the safety device includes a state quantity detection means (sensor) 49 attached to each part of the work machine 1 to detect the posture of the work machine 1, a user setting input means 55 for the operator to set the safety device, a state A control device 60 that performs a predetermined calculation based on a detection value of the amount detection means 49, a display device 61d that presents stability information to an operator, and an alarm device 63d are provided.
  • the control device 60 indicates a part related to the safety device among the control devices of the work machine 1.
  • the control device 60 further includes an input unit 60x to which signals of the state quantity detection unit 49 and the user setting input unit 55 are input, a ZMP calculation unit 60f that receives the signal input to the input unit 60x and calculates the ZMP position 70, From the ZMP storage unit 60g that stores the calculation result of the ZMP calculation unit 60f for a predetermined period, the stability calculation unit 60d that calculates the stability and the possibility of falling from the calculation result of the ZMP calculation unit 60f, and the stability calculation unit 60d
  • the display control means 61c and the alarm control means 63c for determining the output to the display device 61d and the alarm device 63d, respectively, and the output signals from the display control means 61c and the alarm control means 63c are respectively displayed on the display device 61d and the alarm device 63d.
  • An output unit 60y that outputs to the device 63d is provided.
  • the ZMP calculating means 60f
  • the control device 60 includes a microcomputer (not shown) including a CPU, a ROM, a RAM, a storage unit including a flash memory, and the like, and a computer program and peripheral circuits stored in the ROM, and operates the computer program on the CPU. To perform arithmetic processing.
  • a microcomputer including a CPU, a ROM, a RAM, a storage unit including a flash memory, and the like, and a computer program and peripheral circuits stored in the ROM, and operates the computer program on the CPU. To perform arithmetic processing.
  • the present invention supports safe work by presenting the results of ZMP position calculation and stability determination calculated by the control device 60 so that the operator can instantly and accurately recognize the results via the display device 61d and the alarm device 63d. To do.
  • the upper swing body 3 is provided with an attitude sensor 3b for detecting the inclination of the machine reference coordinate system with respect to the world coordinate system with the Z axis as the direction opposite to gravity, which will be described later.
  • the posture sensor 3b is, for example, an inclination angle sensor, and detects the inclination of the machine reference coordinate system with respect to the world coordinate system by detecting the inclination angle of the upper swing body 3.
  • a turning angle sensor 3 s for detecting the turning angle of the lower traveling body 2 and the upper turning body 3 is provided on the turning center line 3 c of the upper turning body 3.
  • a boom angle sensor (angle sensor) 40 a for measuring the rotation angle of the boom 10 is provided at the fulcrum 40 of the upper swing body 3 and the boom 10.
  • the fulcrum 41 of the boom 10 and the arm 12 is provided with an arm angle sensor (angle sensor) 41 a for measuring the rotation angle of the arm 12.
  • a bucket angle sensor 42a for measuring the rotation angle of the bucket 23 is provided.
  • ⁇ Acceleration sensor> Near the center of gravity of the lower traveling body 2, the upper swing body 3, the boom 10, and the arm 12, a lower traveling body acceleration sensor 2a, an upper swing body acceleration sensor 3a, a boom acceleration sensor 10a, and an arm acceleration sensor 12a are provided. Yes.
  • Pin force sensors 43a and 44a are provided on the pin 43 connecting the arm 12 and the bucket 23 and the pin 44 connecting the link 16 and the bucket 23, respectively.
  • the pin force sensors 43a and 44a detect the magnitude and direction of the force (external force) applied to the pins 43 and 44 by, for example, inserting a strain gauge inside a cylindrical shape and measuring the strain generated in the strain gauge. .
  • FIG. 4 shows a ZMP calculation work model (side surface), a world coordinate system (OX'Y'Z '), and a machine reference coordinate system (O-XYZ).
  • the world coordinate system (OX'Y'Z ') is based on the direction of gravity and the direction opposite to gravity is the Z axis.
  • the machine reference coordinate system (O-XYZ) is based on the lower traveling body 2, and the origin is in contact with the ground surface 30 on the turning center line 3c of the upper rotating body 3 as shown in FIG.
  • the X axis is set in the front-rear direction of the lower traveling body 2
  • the Y axis is set in the left-right direction
  • the Z axis is set in the direction of the turning center line 3c.
  • the relationship between the world coordinate system and the machine reference coordinate system is detected using the above-described attitude sensor, and the ZMP calculation means 60f performs an operation based on the machine reference coordinate system.
  • a concentrated mass model in which mass is concentrated on the center of gravity of each component is used as a model for calculating the ZMP 70 in consideration of simplicity of mounting.
  • the mass points 2P, 3P, 10P, 12P of the lower traveling body 2, the upper swing body 3, the boom 10, and the arm 12 are set to the gravity center positions of the respective constituent members, and the masses of the respective mass points are m2, m3, m10, m12.
  • the position vectors of the respective mass points are r2, r3, r10, r12, and the acceleration vectors are r ′′ 2, r ′′ 3, r ′′ 10, r ′′ 12.
  • the mass point setting method is not limited to this, and for example, a portion where the mass is concentrated (such as the engine 5 and the counterweight 8 shown in FIG. 1) may be added.
  • the external force is applied to the tip of the bucket 23 by working with the bucket 23. Since the bucket 23 is connected to the work front 6 via the pins 43 and 44, the gravity and inertia force of the bucket 23 and all external forces applied to the bucket 23 in the X-axis direction and the Z-axis direction are As the external force vectors F43 and F44 applied to 44, ZMP coordinates are calculated. Here, it is assumed that the position vectors of the pin 43 and the pin 44 which are external force action points are s43 and s44.
  • the ZMP stability criterion is based on the D'Alembert principle. Note that the concept of ZMP and the ZMP stability criterion are described in "LEGGED LOCOMATION ROBOTS: Miomir Vukobratovic (" Walking Robot and Artificial Feet: Translated by Ichiro Kato, Nikkan Kogyo Shimbun ").
  • the ZMP equation is derived as follows from the balance of moments generated by gravity, inertial force, and external force.
  • rzmp ZMP position vector mi: mass of the i-th mass point ri: position vector of the i-th mass point r "i: acceleration vector applied to the i-th mass point (including gravitational acceleration) Mj: j-th external force moment sk: k-th external force action point position vector Fk: k-th external force vector
  • mi mass of the i-th mass point
  • ri position vector of the i-th mass point
  • i acceleration vector applied to the i-th mass point (including gravitational acceleration)
  • Mj j-th external force moment
  • sk k-th external force action point position vector
  • Fk k-th external force vector
  • the vector is a three-dimensional vector composed of an X component, a Y component, and a Z component.
  • the first term on the left side of the above equation (1) is the sum of moments around the ZMP 70 (see FIG. 3) (radius ri-rzmp) generated by the acceleration component (including gravitational acceleration) applied at each mass point mi. Show.
  • the second term on the left side of the above formula (1) indicates the total sum of the external force moments Mj acting on the work machine 1.
  • the third term on the left side of the above equation (1) represents the sum of moments around ZMP 70 (radius sk ⁇ rzmp) generated by external force Fk (where the point of action of k-th external force vector Fk is sk).
  • Expression (1) is obtained by adding the sum of moments around the ZMP 70 (radius ri-rzmp) generated by the acceleration component (including gravitational acceleration) applied at each mass point mi, the sum of the external force moments Mj, and the external force Fk. It is described that the sum of moments around the ZMP 70 (radius sk ⁇ rzmp) generated by the k-th external force Fk acting point is sk.
  • the ZMP 70 on the ground surface 30 can be calculated from the ZMP equation shown in Equation (1).
  • the ZMP equation when the object is stopped and only gravity works is obtained by using the gravitational acceleration vector g. And coincides with the projection point of the static center of gravity on the ground surface. Therefore, ZMP can be treated as a projected point of the center of gravity considering dynamic state and static state, and when ZMP is used as an index, the object is stationary and when it is moving Both can be handled uniformly.
  • the stability area and the current stability are projected onto the ground surface of the work machine. It can be shown on the top view and is easy to understand visually.
  • a user setting input means 55 is composed of a plurality of input buttons, etc., and an operator sets a warning method, a safety factor, and the like via the user setting input means 55 according to work contents and individual preference.
  • the ZMP calculating means 60f includes a link calculating means 60a for calculating the position vector, acceleration vector and external force vector of each mass point based on the machine reference coordinate system (O-XYZ) from the detection value of the state quantity detecting means 49, and a machine reference. It comprises ZMP calculation means 60b for calculating the ZMP 70a using the position vector, acceleration vector and external force vector of each mass point converted into the coordinate system.
  • the link calculation means 60a the values of the attitude sensor 3b provided in the revolving structure 3 shown in FIG. 3, the turning angle sensors 3s, the boom angle sensor 40a, the arm angle sensor 41a, and the bucket angle sensor 42a provided in each part of the work machine 1 are used. Using the detected value, kinematics calculation is sequentially performed for each link. Then, the position vectors r2, r3, r10, r12 of the mass points 2P, 3P, 10P, 12P shown in FIG. 4 and detection of the traveling body acceleration sensor 2a, the turning body acceleration sensor 3a, the boom acceleration sensor 10a, and the arm acceleration sensor 12a.
  • the vectors F43 and F44 are converted into values based on the machine reference coordinate system (O-XYZ).
  • a well-known method can be used as the kinematic calculation method. For example, the method described in “Robot Control Basics: Yoshikawa Tsuneo, Corona (1988)” can be used.
  • the data sent from the link calculation means 60a to the ZMP calculation means 60b is the position vector, acceleration vector and external force vector of each mass point with reference to the machine reference coordinate system (O-XYZ).
  • the ZMP calculating means 60 b calculates the ZMP 70 a using the position vector, acceleration vector, and external force vector of each mass point converted to the machine reference coordinate system, and outputs the ZMP 70 a as the ZMP position 70.
  • Equation (1) is solved under such conditions, and the X coordinate rzmpx of the ZMP 70a is calculated as follows.
  • the Y coordinate rzmpy of the ZMP 70a is calculated as follows.
  • m is the mass of each mass point 2P, 3P, 10P, and 12P shown in FIG. 4, and the mass m2, m3, m10, and m12 of each mass point is substituted.
  • r ′′ is the acceleration of each mass point, and the accelerations r ′′ 2, r ′′ 3, r ′′ 10, r ′′ 12 of each mass point are substituted.
  • s shows the position vector of the pins 43 and 44 which are external force action points, and s43 and s44 are substituted.
  • F represents an external force vector applied to the pins 43 and 44, which are external force action points, and F43 and F44 are substituted.
  • the ZMP computing unit 60b can calculate the coordinates of the ZMP 70a.
  • the calculated ZMP 70a is sent as the ZMP position 70 to the stability calculation means 60d and the ZMP storage means 60g.
  • the ZMP storage unit 60g stores the ZMP position 70 calculated by the ZMP calculation unit 60f as a ZMP position history 72 for a predetermined period, and discards data that has passed the predetermined period.
  • the stability calculation means 60d in the first embodiment is a support polygon calculation means 60m that calculates a support polygon L formed at the contact point between the work machine 1 and the ground surface 30 as shown in FIG.
  • a normal region J having a sufficiently low possibility of falling and a fall warning region N having a higher possibility of falling are set, and the ZMP position 70 is It comprises stability evaluation means 60n for evaluating the stability by determining which region it is in.
  • the support polygon L is substantially equal to the planar shape of the traveling body 2. Therefore, when the planar shape of the traveling body 2 is rectangular, the support polygon L is rectangular as shown in FIG. More specifically, the support polygon L in the case of having a crawler as the lower traveling body 2 is a line connecting the center point of the left and right sprockets with the front boundary line and the center point of the left and right idlers. Is a quadrangle with a rear boundary line and left and right track link outer ends as left and right boundary lines. The front and rear boundaries may be the ground contact points of the frontmost lower roller and the rearmost lower roller.
  • the work machine 1 shown in FIG. 1 has the blade 18, and when the blade 18 is in contact with the ground surface 30, the support polygon L expands to include the blade bottom. Further, in the jack-up operation in which the bucket 23 is pressed against the ground surface to lift the traveling body 2, the support polygon L is formed by the two end points on the grounding side of the traveling body 2 and the grounding point of the bucket 23. It becomes a polygon. Thus, since the shape of the support polygon L changes discontinuously depending on the ground contact state of the work machine 1, the support polygon calculation means 60m monitors the ground contact state of the work machine 1, and the support polygon according to the ground contact state. Set L.
  • the boundary K between the normal region J and the fall warning region N is set inside the support polygon L.
  • the boundary K is a polygon that is reduced to the center point side according to the ratio determined by the support polygon L according to the safety factor, or the length that is determined by the support polygon L according to the safety factor. Set to polygon moved inward.
  • the stability evaluation means 60n when the ZMP position 70 calculated by the ZMP calculation means 60f is in the normal region J, it is determined that the stability of the work machine 1 is sufficiently high, while the ZMP position 70 is a fall warning. If it is in the area N, it is determined that the work machine may fall over.
  • the safety factor may be a predetermined value (for example, 80%) set in advance, or may be changed depending on the proficiency level of the operator who operates the work machine 1, the work content road surface, the surrounding conditions, and the like. It may be a value. In this case, a configuration in which the safety factor is automatically set from information given in advance, output values of various sensors, or a configuration in which the operator or work manager arbitrarily sets the safety factor using the user setting input device 55 is conceivable.
  • the safety factor may be changed during the work according to the work state of the work machine 1, or a different value may be used for the front, rear, left and right.
  • the ZMP position 70 tends to move to the valley side of the inclined surface, and tends to easily fall to the valley side compared to the mountain side. Therefore, according to the inclination angle, as shown in FIG. 5, the fall warning area N is set so that the valley side becomes wider.
  • a method of using the detected value of the attitude sensor 3b in addition to the input by the operator is conceivable as the inclination angle.
  • the fall warning area N is set so that the other direction is wider than the direction of the work front 6.
  • an operator or a work manager may manually change the setting as needed, and a configuration using GPS, map information, work CAD drawings, and the like may be considered.
  • a configuration using GPS, map information, work CAD drawings, and the like may be considered.
  • the ZMP position history 72 stored in the ZMP storage means 60g is used, and if any one of the ZMP position 70 and the ZMP position history 72 is in the fall warning area N, a fall is possible. You may comprise so that it may determine with the property. In other words, since it is difficult for the operator to grasp the fluctuating information one by one in an operation in which the ZMP position fluctuates in a relatively short time, history information of about several seconds is recorded and a determination is made based on this.
  • the necessity of warning is determined from the positional relationship between the ZMP position 70 and the ZMP position history 72 in order to reduce a decrease in work efficiency due to excessive warning and to support the stability recovery operation by the operator. It may be configured.
  • the ZMP history value 72 in addition to the ZMP position 70 as an evaluation index, it is possible to determine whether the current operation of the work machine 1 is an operation that restores stability or an operation that degrades the stability. Safe work can be supported by more appropriate commands. Moreover, since the case where recovery
  • the boundary K between the normal area J and the fall warning area N is configured to divide the fall warning area N into two or more areas by setting two or more boundaries K step by step. Also good.
  • the fall warning area N is divided into the fall warning area N1 and the fall warning area N2 as shown in FIG. 5B, for example, when the ZMP position 70 is in the fall warning area N2, a preliminary warning is given. Can be ordered to avoid risks at an early stage.
  • FIG. 7 is a diagram for explaining a method used in the determination by calculating the stability numerically in addition to the determination of the possibility of falling by the region determination in the stability evaluation means 60n.
  • the stability can be grasped quantitatively and continuously.
  • a case where the support polygon is rectangular will be described as an example.
  • a straight line Lz passing through the center Lc (Xlc, Ylc) of the support polygon L and the ZMP position 70, and an intersection C (Xc, Yc) between the straight line Lz and the sides of the support polygon are calculated.
  • the stability ⁇ is (See FIG. 7A).
  • the stability ⁇ takes a value between 0 and 1, and the larger the value, the closer the ZMP position is to the center of the support polygon, which means higher stability.
  • the stability ⁇ may be defined as an evaluation of the ratio between the maximum value that can be taken in the support polygon and the ZMP position 70 for each of the X and Y coordinates (FIG. 7). (See (b)). At this time, the ratio in the X-axis direction And Y axis direction ratio A smaller value is selected as the stability ⁇ .
  • Xmax is the maximum value of the X coordinate that can be taken within the support polygon
  • Ymax is the maximum value of the Y coordinate that can be taken within the support polygon.
  • the stability evaluation means 60n determines that the stability is sufficiently high for the display device and the alarm means, the stability evaluation means 60n outputs the ZMP position 70, the ZMP position history 72 and the stability ⁇ , and determines that there is a possibility of falling. In such a case, a warning command is output in addition to the ZMP position 70, the ZMP position history 72, and the stability ⁇ .
  • the display means 61 is a display control means 61c that determines display contents according to a command from the stability calculation means 60d, and a device that includes a cathode ray tube, a liquid crystal panel, and the like.
  • the display device 61d displays stability information and the possibility of falling.
  • the display device 61d displays a top view 61b of the work machine 1 as shown in FIG. 8, and displays a fall warning area N, a ZMP position 70, and a ZMP position history 72 on the top view 61b.
  • a shape or a different color from the ZMP position 70 may be used, or old data may be displayed smaller than new data.
  • ZMP position history 72 displayed in FIG. 8A.
  • a shape or a different color from the ZMP position 70 may be used, or old data may be displayed smaller than new data.
  • an arrow from the ZMP position history 72 to the ZMP position 70 may be displayed.
  • the stability ⁇ calculated by the stability calculating means 60d is displayed using a bar 61h as shown in FIG.
  • FIG. 9 shows an example in which the bar 61h showing the stability ⁇ is arranged at the lower part of the display device 61d and the indicating unit is moved to the right as the stability decreases, the indicating unit moves in the vertical direction according to the stability.
  • the bar 61h may be displayed on the upper side, the left side, or the right side of the display device 61d.
  • the traveling body 2 in the top view 61 b is rotated reversely with respect to the turning body 3 by the turning angle and displayed.
  • the front of the operator's field of view and the upper part of the display device 61d can always be matched, and the traveling direction can be easily confirmed.
  • the display device 61d notifies the possibility of falling according to a command from the stability calculating means 60d.
  • a warning message 61m using characters or illustrations is displayed on the upper or lower portion of the display device 61d.
  • a three-dimensional illustration showing an overview of the work machine 1 is displayed instead of the top view 61b. May be displayed as follows.
  • the background color of the display device 61d is changed when there is a possibility of falling. For example, the normal background color (stable state) is set to white, and is changed to red when a warning command is issued.
  • the background color can be changed in several stages. For example, the normal time is set to white, yellow when the stability ⁇ is slightly low, orange close to red as the stability ⁇ is low, and red when a warning command is issued. By changing the background color in this way, the operator can instantly grasp the possibility of falling without gazing at the display screen.
  • the example of changing the background color of the display has been described above, but the display colors of the fall warning area N, the ZMP position 70, and the ZMP position history 72 may be changed in the same manner as the background color.
  • the display device 61d may also be configured to serve as user setting input means 55 for the operator to set warning levels, alarms, and the like.
  • the display device 61d has input means such as a touch panel, and displays a setting input icon 61k as shown in FIG.
  • the work machine 1 includes an alarm unit 63 that issues an alarm according to the stability ⁇ .
  • the warning means 63 is a warning control means 63c that determines and outputs a warning method based on a command from the stability calculation means 60d, and a device that generates a warning sound such as a buzzer.
  • the warning means 63 is a command from the warning control means 63c.
  • an alarm device 63d that issues an alarm such as a warning sound.
  • the alarm device 63d is provided in the cab 4.
  • the warning control means 63c instructs to change the warning sound according to the stability ⁇ . For example, the sound volume increases as the stability ⁇ decreases, the warning sound interval decreases as the stability ⁇ decreases, and the pitch of the warning sound changes according to the stability ⁇ I do.
  • the alarm device 63d may be installed outside the work machine 1. With such a configuration, it is possible to notify a worker who performs work around the work machine 1 of the possibility of the work machine 1 toppling over.
  • FIG. 9 shows an example in which the traveling body 2 in the top view is rotated backward with respect to the turning body 3 by the turning angle and the direction of the work front is always directed upward, as shown in FIG.
  • the direction of the traveling body 2 in the top view may be fixed, and the revolving body 3 may be rotated and displayed with respect to the traveling body 2 by the turning angle.
  • This display method is particularly effective when it is necessary to grasp the positional relationship with surrounding objects.
  • the operation lever is usually provided at an operation place of the operator other than on the work machine 1.
  • a display device and an alarm device may also be installed at a place where an operator operates.
  • ZMP calculation and stability calculation it is possible to reduce the amount of communication data and make it less susceptible to communication delays.
  • the display device As another form of use of the display device, a case where the work manager confirms the status of the work machine 1 from a remote place is conceivable.
  • a manager display device is provided in a place other than on the work machine 1 and the status of the work machine 1 is displayed by performing data transfer using wireless or the like. be able to.
  • the display on the manager display device may be the same as that on the driver, or may be displayed with information such as the command amount to each actuator added.
  • the work content determination means 61i preliminarily sets and stores characteristic operation patterns in a plurality of work such as suspended load work, excavation work, dismantling work, and traveling, and a fall warning area N suitable for each work content.
  • a lever operation amount sensor 51 for detecting an input command amount to each of the drive actuators 11, 13, and 15 is installed, and a work front posture calculated by the ZMP calculation means, a bucket external force, and a history of detection values of the lever operation amount sensor 51 are used.
  • the closest one of the preset operation patterns is selected, and the corresponding fall warning area N is output.
  • the recovery operation calculation means 60l determines which of the operation levers 50 is operated in which direction to restore the stability.
  • the recovery operation calculating means 60l can determine the operation method for recovering the stability and output it to the display device 61d, thereby supporting the stability recovery operation and reducing the possibility of falling.
  • each operation lever 50 moves from the ZMP position 70 toward the center of the support polygon L from the attitude of the work machine 1 and the ZMP position 70.
  • the operation method for moving the ZMP position 70 in the center direction is output to the display means 61.
  • the display means 61 For example, when the direction of the work front is in front of the traveling body 2 and the ZMP position 70 is in front of the normal area N, the arm is slowly pulled forward or the direction of the work front is obliquely inclined with respect to the traveling body. It is preferable to perform an operation such as turning so that
  • the display unit 61 displays the calculation result of the recovery operation calculation unit 60l on the display device 61d as necessary.
  • the ZMP position 70 is displayed on the display device 61d, and the display device 61d and the alarm device 63d warn of a decrease in stability, thereby presenting the machine stability information to the operator.
  • a method for presenting stability information a method using the operation lever 50 or the driver's seat 4 can be considered. For example, when a warning command is issued in the stability calculation means, the warning can be issued by vibrating the operation lever 50 or the driver's seat 4. Further, by increasing the operational feeling of the operation direction of the operation lever 50 in the direction of deteriorating the stability, it is possible to notify the possibility of falling and support the stable recovery operation.
  • the stability information of the machine by a method other than the display device 61d and the alarm device 63d, the stability can be obtained even when the operator is not looking at the display device 61d or in an environment where the noise is loud and the alarm is difficult to hear. Recognize information and lead to safe operation.
  • the alarm device 63d may be installed in a plurality of directions and locations such as front, rear, left and right with respect to the driver's seat 4 to generate a warning sound or the like from the alarm device in the direction of the ZMP position 70.
  • a warning in accordance with the direction of the ZMP position 70, it is possible to recognize the stability information including the direction to be carefully watched even when the operator is not looking at the display device 61d.
  • the state quantity detection means 49 of the second embodiment includes an attitude sensor 3b, a boom angle sensor 40a, an arm angle sensor 41a, a bucket angle sensor 42a, and pin force sensors 43a and 44a among the sensors shown in the first embodiment. Is provided.
  • ⁇ ZMP calculation means Link calculation is performed as in the first embodiment.
  • the detected values of the attitude sensor 3b, the turning angle sensor 3s, the boom angle sensor 40a, and the pin force sensors 43a and 44a arranged in each part of the work machine 1 are sent to the link calculation means 60a.
  • the position vectors r2, r3, r10, r12 of the mass points 2P, 3P, 10P, 12P shown in FIG. 4 the position vectors s43, s44 of the pins 43, 44, and the external force vectors F43, F44 acting on the pins 43, 44 are machine-based. Conversion to a value based on the coordinate system (O-XYZ).
  • the mass center 70b of the work machine 1 is calculated using the position vector and the external force vector of each mass point converted into the machine reference coordinate system based on the detection value of each sensor. To do.
  • the center of mass 70b of the work machine 1 is derived as follows.
  • r cog mass center vector m i : mass of the i-th mass point
  • r i position vector of the i-th mass point
  • the vector is a three-dimensional vector composed of an X component, a Y component, and a Z component.
  • the X and Y coordinates of the center of mass 70b are evaluated. Therefore, the X coordinate rcogx of the center of mass 70b is calculated as follows.
  • the Y coordinate rcogy of the center of mass 70b is calculated as follows.
  • m is the mass of each mass point 2P, 3P, 10P, 12P and attachment 23 shown in FIG. 4 and is added to the mass m2, m3, m10, m12 of each mass point and the pins 43, 44.
  • the mass of the attachment calculated from the external force vectors F43 and F44 is substituted.
  • the ZMP calculation means 60b can calculate the center of mass 70b by using the detection values of the sensors provided in the respective parts of the work machine 1.
  • the ZMP 70a shown in the first embodiment is calculated, and the two are stabilized. It can also be evaluated as a sex indicator.
  • the ZMP calculating means 60f calculates the ZMP 70a using the equations (3) and (4) and calculates the center of mass 70b using the equations (9) and (10).
  • the stability calculating means 60d can also be configured to use the ZMP 70a and the center of mass 70b and issue different warning commands to both.
  • the display unit 61 may be configured to display using different shapes and colors in the ZMP 70a and the mass center 70b as shown in FIG.
  • a third embodiment of the present invention will be described with reference to FIGS. Unlike the first and second embodiments, the third embodiment predicts near-future behavior of the ZMP position 70, and performs display and warning using the predicted value. This enables a quicker and more flexible response. In the following, differences from the second embodiment will be mainly described.
  • the ZMP prediction means 60c calculates a predicted value 71 of the near future ZMP position.
  • a method for calculating the predicted ZMP position 71 using the current ZMP position 70 and the ZMP position history 72 will be described by taking the case where the center of mass 70b is used as the ZMP position 70 as an example.
  • the moving speed of the ZMP position can be considered to be almost constant. Therefore, by calculating the moving speed of the ZMP position 70 from the current ZMP position 70 (mass center 70b) calculated by the ZMP calculating means 60f and the past ZMP position history 72 stored in the ZMP storage means 60g, the near future.
  • the predicted ZMP position 71 can be predicted.
  • the predicted ZMP position 71 after dt seconds can be calculated by the following equation.
  • x cog [p] is the ZMP position at the p-th calculation point
  • t [p] is the time at the p-th calculation point
  • x cogp is the predicted ZMP position 71 dt seconds after t [p].
  • the stability calculating means 60d Based on the calculated value 70 of the ZMP calculating means 60f and the calculated value 71 of the ZMP predicting means 60c, the stability calculating means 60d performs stability determination.
  • the stability calculation means 60d is composed of a support polygon calculation means 60m and a stability evaluation means 60n as in the first embodiment.
  • the support polygon calculation means 60m is the same as that of the first embodiment, and the setting of the fall warning area N and the calculation of stability of the stability evaluation means 60n are the same as those of the first embodiment.
  • the ZMP position 70 calculated by the ZMP calculating means 60f is used.
  • the determination of the possibility of falling in the stability evaluation means 60n uses both the current ZMP position 70 calculated in the ZMP calculation means 60f and the predicted ZMP position 71 calculated in the ZMP prediction means 60c as indices. The determination of the possibility of falling and the warning command will be described with reference to the flowchart of FIG.
  • the work machine 1 determines that there is stability and does not output a warning command (steps 131, 132, 134).
  • the work machine 1 determines that the possibility of fall has increased, and a preliminary warning command for performing a preliminary warning. Is output (steps 131, 132, 135).
  • Steps 131, 133, 136 If the ZMP position 70 is in the fall warning area N, but the ZMP predicted position 71 is in the normal area J, it is determined that the recovery operation from the low stability state is being performed, and a command indicating that the recovery operation is being performed is output ( Steps 131, 133, 136).
  • the work machine 1 determines that there is a possibility of fall and issues a normal warning command (steps 131, 133, and 137).
  • the predicted ZMP position 71 as an evaluation index in addition to the ZMP position 70, it is possible to evaluate the stability when the current operation is continued, and it is possible to deal with at an earlier stage. In addition, it is possible to determine a case where stability is expected to be restored by the current operation, change the warning method, and reduce operator discomfort due to excessive warning.
  • the stability evaluation means 60n described above determines that there is a possibility of a fall when both the ZMP position 70 and the ZMP predicted position 71 are in the fall warning area N. However, even when both are in the fall warning area N, When the stability of the predicted ZMP position 71 is higher than the stability of the ZMP position 70, it is determined that the stability recovery operation is being performed, and the ZMP position 70 is in the fall warning area N and the predicted ZMP position 71 is in the normal area J You may comprise so that the same instruction
  • the display means 61 displays stability information and tipping warning information as in the first embodiment.
  • the ZMP prediction position 71 which is a difference with 1st Embodiment is demonstrated.
  • the ZMP position 70 and the predicted ZMP position 71 are displayed on the top view 61b of the display device 61d using different colors and different shapes.
  • an arrow may be displayed from the ZMP position 70 to the ZMP predicted position 71.
  • the display device 61d has at least four background colors of normal time, preliminary warning time, recovery operation time, and normal warning time, and the display control means 61c changes the background color in accordance with a command from the stability calculation means 60d.
  • the display device 61d is instructed.
  • the alarm means 63 issues an alarm such as a warning sound in response to a command from the stability calculation means 60d as in the first embodiment.
  • the alarm device 63d of the third embodiment has at least three warning sounds, that is, at the time of preliminary warning, at the time of warning, and at the time of recovery operation, and the alarm control means 63c determines the type of warning command from the stability calculation means 60d. A command is issued to the alarm device 63d so as to generate a corresponding warning sound.
  • the current ZMP position 70 and the predicted ZMP position 71 are used in the stability calculation means 60d and the display means 61 .
  • the ZMP history stored in the ZMP storage means 60g The value 72 may be used.
  • the possibility of falling can be determined by replacing the ZMP position 70 in the flowchart of FIG.
  • the actuator speed is converted into the angular speed of each rotation angle by link calculation, and the mass position after dt seconds is calculated from the current posture and the calculated angular speed.
  • the predicted ZMP position 71 after dt seconds can be calculated.
  • the lever operation amount sensor 51 for detecting the lever operation amount is required.
  • the predicted value can be calculated in conjunction with the operator's input, and the warning is given as the operator's operation feeling. Can be better matched.
  • FIG. 16 is a schematic configuration diagram illustrating the fourth embodiment.
  • recording / reproducing means 60h for recording / reproducing the work content and the ZMP position during the work is provided.
  • a lever operation amount sensor 51 for detecting the input amount from the operator to each drive actuator 11, 13, 15 of the work machine 1 is provided.
  • the lever operation amount sensor 51 for example, an angle sensor that detects the inclination of the operation lever 50 or a pressure sensor that detects a pilot pressure determined by a pressure reducing valve provided inside the operation lever 50 is used.
  • the recording / reproducing means 60h includes a display switching input means 56 for an operator to give a display switching command between a display during operation and a display during reproduction, a work recording means 60j for recording work contents and a ZMP position during work, and a display switching input.
  • the display control means 61c and the display switching means 60k for instructing the alarm control means 63d in response to an input from the means 56 are configured.
  • the work recording means 60j records work contents and ZMP positions for a predetermined period.
  • the period for storing the record may be a preset time such as 10 minutes or 1 day, or may be determined from engine start to engine stop.
  • the work recording means 60j records the work radius calculated from the detection value of the lever operation amount sensor 51, the rotation angle of each rotary joint, the bucket external force calculated by the link calculation means 60a, and the posture of the work front as work contents. Further, as the stability information, the ZMP position 70 calculated by the ZMP calculating means 60f and the stability ⁇ calculated by the stability calculating means 60d are recorded. As warning information, various setting information such as a warning command and a fall warning area N is recorded. The warning command and various setting information may be recorded at all times during a predetermined period like the work contents and ZMP position, or before and after the warning command is issued or before and after the setting is changed. Only recording may be performed. The amount of data to be recorded can be reduced by limiting the recording period.
  • the display switching means 60k Based on the input from the display switching input means 56, the display switching means 60k recognizes which of the display during operation and the display during reproduction is selected, and displays the display during operation with respect to the display control means 61c and the alarm control means 63d. Command to switch display during playback.
  • the display means 61 switches between the display during operation and the display during reproduction according to a command from the display switching means 60k.
  • the display during operation is the same as in the first embodiment. Hereinafter, display during playback will be described.
  • FIG. 17 shows an example of display during playback.
  • the stability information and the fall warning information similar to those during driving are displayed.
  • the screen background color and warning message are the same as those displayed during operation.
  • FIG. 17 shows an example in which the work machine 1 is operated using two levers. For each lever, the input direction of the operation lever is represented by the direction of the arrow, and the operation amount is represented by the size or length of the arrow. Bucket external force, work radius, road surface inclination, etc. are displayed as work environment information.
  • the operation of the work machine 1 is expressed by displaying the lever operation amount and the turning radius.
  • a three-dimensional illustration showing an overview of the work machine 1 is displayed, and the illustration is based on the recorded rotation angle. You may comprise so that an actual operation
  • the ZMP position history 72 in the reproduction period is displayed as a work result as shown in FIG.
  • the stability display bar 61h displays an average value of stability during the reproduction period.
  • the stability information is mainly displayed during the operation shown in FIG. 5, the operator can accurately grasp the past work state by displaying additional information such as the lever operation amount and the turning radius during reproduction. be able to. Moreover, the stability in a series of work can be evaluated by displaying the work result.
  • the recording / reproducing means As another use form of the recording / reproducing means, a case where the work status is confirmed in a place other than on the work machine 1 can be considered. In such a case, the information recorded in the work recording means 60j is taken out from the work machine 1 using an external recording medium or wireless, and is reproduced on a display device provided in a place other than the work machine 1. May be.
  • the display at the time of reproduction can be used not only for grasping and investigating the occurrence situation and cause in the event of an accident, but also for work management, education, enlightenment activities, etc. by operation safety evaluation.
  • the safety device of the present invention includes a control device including a state quantity detection unit that detects the posture of the work machine, a ZMP calculation unit that calculates the ZMP position of the work machine, and a display device.
  • a top view of the machine is displayed, and a support polygon formed by a contact point between the work machine and the ground surface and the ZMP position are displayed on the top view.
  • the display device of the present invention displays the information by rotating between the traveling body and the revolving body in the top view according to the turning angle. Thereby, it is possible to recognize the relationship between the support polygon and the ZMP position and the work front direction during the work including the turning operation. In addition, the traveling direction can be recognized.
  • the safety device of the present invention has ZMP storage means for storing the history of the ZMP position for a predetermined time set in advance, and displays the ZMP position history. As a result, a change in the ZMP position can be recognized, and an increase or decrease in stability due to the current operation can be recognized.
  • the display device of the present invention displays the current ZMP position calculated by the ZMP calculating means and the ZMP position history in different forms. As a result, the relationship between the past and present ZMP positions can be more easily recognized.
  • the safety device of the present invention has a ZMP prediction means for predicting the behavior of the ZMP position, and displays the calculation result of the ZMP prediction means. As a result, the operator can recognize the ZMP position when the current operation is continued, and it is possible to cope with it at an earlier stage.
  • the display device of the present invention displays the current ZMP position calculated by the ZMP calculating means and the ZMP predicted position calculated by the ZMP predicting means in different forms. This makes it possible to more easily recognize the relationship between the current and future ZMP positions.
  • the normal region is set in the center of the support polygon formed by the contact point between the work machine and the ground surface
  • the fall warning region is set in the periphery
  • the ZMP position is in the fall warning region.
  • a stability calculation means for issuing a warning command in the case, the fall warning area is displayed on a top view displayed on the display device, and a warning display or background color is displayed when a warning command is issued from the stability calculation means. Make changes. Thereby, even if an operator does not watch a display screen, it becomes possible to grasp
  • the stability calculation means of the present invention uses the current ZMP position calculated by the ZMP calculation means and the ZMP history position stored in the ZMP storage means. Thereby, it is possible to evaluate whether or not the stability is improved by the current work, and it is possible to avoid an excessive warning.
  • the stability calculation means of the present invention uses the current ZMP position calculated by the ZMP calculation means and the ZMP prediction position calculated by the ZMP prediction means. This makes it possible to evaluate the stability when the current operation is continued, to enable warning at an earlier stage, and to avoid excessive warning.
  • the stability calculation means of the present invention calculates the stability of the work machine from the ratio of the distance from the center of the support polygon to the ZMP position and the distance from the center of the support polygon to the periphery of the support polygon, The calculated stability is displayed on the display device. This makes it possible to easily recognize the increase or decrease in stability.
  • the safety device of the present invention includes work content determination means for determining which of the plurality of preset work patterns the current work corresponds to from a change in posture of the work machine, and the stability calculation means includes: A fall warning area preset for each work pattern based on the judgment result of the work content judgment means is used. Thereby, it is possible to set a fall warning area suitable for each work, and it is possible to keep the work efficiency higher.
  • the safety device of the present invention has an alarm means, and outputs a sound or a sound when a warning command is issued from the stability calculation means. Thereby, even when the operator is not looking at the display device, it is possible to recognize the possibility of falling, and it is possible to allow surrounding workers to recognize the possibility of falling.
  • the alarm means of the present invention changes the sound or voice according to the stability calculated by the stability calculation means. Therefore, even when the operator is not looking at the display device, the stability can be accurately recognized, and the surrounding workers can be accurately recognized.
  • the safety device of the present invention has a detecting means for detecting a command value to the drive actuator, stores the command value to the drive actuator and the ZMP position for a predetermined time, and records and reproduces the work situation. Means for displaying a command value at the time of reproduction, and performing a display different from that during work. As a result, it becomes possible to grasp the situation and cause of the accident and to investigate and investigate it, and to perform work management, education, and enlightenment activities by evaluating the safety of operation.
  • the fall warning area of the work machine and the current ZMP position are displayed on the top view of the display device, so that it is unified even during work in which various postures change. It is possible to evaluate the stability with a typical index, and to make the operator easily and accurately recognize the stability of the work machine instantaneously.

Landscapes

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

Abstract

【課題】作業フロント操作および旋回を含む作業時において現在の安定性をオペレータに瞬時に容易かつ的確に認識させる。 【解決手段】作業機械の安全装置において、制御装置は、作業フロントを含む本体および走行体の各可動部の位置情報、加速度情報、外力情報をそれぞれ用いてＺＭＰの座標を算出するＺＭＰ算出手段６０ｆと、前記作業機械の地面との複数の接地点が形成する支持多角形を算出し、前記ＺＭＰが前記支持多角形の周縁の内側に形成した警告領域に含まれるとき転倒警告を発する安定性演算手段６０ｄを備え、作業機械の上面図および支持多角形に対する作業機械のＺＭＰ位置を表示する表示装置６１ｄを備え、前記ＺＭＰ算出手段および安定性演算手段は、前記ＺＭＰおよび前記警告領域を含む支持多角形を演算して表示するとともに、算出したＺＭＰ位置が前記支持多角形の周縁の内側に形成した警告領域に含まれるとき転倒警告を発する。

Description

作業機械の安全装置
　本発明は、作業機械の安全装置にかかり、特に、解体工事、建設工事、土木工事等に使用される自走式の作業機械において、機械の安定性に関する情報をオペレータに報知する安全装置に関する。
　構造物解体工事、廃棄物解体工事、土木建設工事等に使用される作業機械として、動力系により走行する走行体の上部に旋回体を旋回自在に取付け、旋回体に多関節型の作業フロントを上下揺動自在に取付けアクチュエータで駆動するものが知られている。このような作業機械の一例として油圧ショベルをベースとした解体作業機械がある。この解体作業機械は、旋回体にブーム、アームからなる作業フロントを上下揺動自在に連結し、アームの先端にグラップル、バケット、ブレーカ、クラッシャ等の作業具を装着して、構造物解体工事、廃棄物解体工事等の作業を行えるようにしている。
　このような作業機械は、作業フロントを構成するブーム、アーム、作業具を旋回体の外方に突出した状態で種々姿勢を変えて作業を行うため、無理な操作を行った場合に作業機械がバランスを崩して転倒することがある。このため、オペレータは作業機械の現在の安定性あるいは転倒可能性を的確に把握しながら安全に作業を行う必要がある。ここで安定性とは、作業機械が転倒することなく安定して作業面上で作業を継続できる程度をいう。
　このような要求に対し、例えば特許文献１では、クローラクレーンのアウトリガ部に設置した荷重計と、クローラに設置した傾斜計との出力値からクローラクレーンの重心位置および負荷荷重を算出し、また、算出された重心位置が予め設定された領域のいずれにあるかを判定し、領域ごとに定められた色を用いて、モニタ上に重心位置を表示するようにしたものが示されている。
　また、その他の例としては特許文献２に、アウトリガ張出し幅センサおよびアウトリガ反力センサを備え、アウトリガ張出し幅センサの出力値から転倒限界を算出し、アウトリガ反力センサの出力値から前後左右における転倒にいたる危険度を算出し、また、アウトリガ張出し幅センサとアウトリガ反力センサとの出力値からクレーンの合成重心を算出し、これらを表示装置に表示し、転倒の危険性がある場合には警告を行うとともに、アウトリガの受動関節部を固定することによって転倒を防止する装置が示されている。
特開昭６１－２８７６９６号公報 特開平１０－２９１７７９号公報
　ここで実際の作業に鑑みると、作業機械は様々な作業に用いられており、素早い動作が必要とされる場合、あるいは動作の切り替えが発生する場合がある。このような作業においては、作業フロントの運動あるいは作業機械自身の運動によって慣性力が発生しており、クレーン作業等の比較的動作が限定され、動作の切替の少ない準静的な作業に比して、機械の動的（急速）な運動による慣性力が安定性に与える影響が大きい。しかし、前記従来技術においては、このような動的な運動による影響は考慮されていない。
 また、動的な運動を行っている場合には、安定性の変動が大きいため、現在の重心位置を表示するだけでは、オペレータは常に表示画面を注視する必要があり、作業効率が劣化する可能性がある。また、オペレータは安定性を正確に認識できない場合がある。
　本発明は、前記問題点に鑑みたもので、作業フロント操作あるいは旋回を含む作業時において現在の安定性をオペレータに瞬時に容易かつ的確に認識させることが可能な作業機械の安全装置を提供することを目的とする。
　本発明は上記課題を解決するため、次のような手段を採用した。
　走行体、該走行体上に取り付けた作業機械本体、該作業機械本体に対し上下方向に揺動自在に取り付けた作業フロント、およびこれらを制御する制御装置を備えた作業機械の安全装置において、前記制御装置は、前記作業フロントを含む前記本体および走行体の各可動部の位置情報、加速度情報、外力情報をそれぞれ用いてＺＭＰの座標を算出するＺＭＰ算出手段と、前記作業機械の地面との複数の接地点が形成する支持多角形を算出し、前記ＺＭＰが前記支持多角形の周縁の内側に形成した警告領域に含まれるとき転倒警告を発する安定性演算手段とを備え、作業機械の上面図および支持多角形に対する作業機械のＺＭＰ位置を表示する表示装置を備え、前記ＺＭＰ算出手段および安定性演算手段は、前記ＺＭＰ位置、および前記警告領域を含む支持多角形を演算して表示するとともに、前記算出したＺＭＰ位置が前記支持多角形の周縁の内側に形成した警告領域に含まれるとき転倒警告を発する。
　本発明は、以上の構成を備えるため、作業フロント操作あるいは旋回を含む作業時において現在の安定性をオペレータに瞬時に容易かつ的確に認識させることが可能な作業機械の安全装置を提供することができる。
第１の実施形態にかかる作業機械を示す側面図である。 第１の実施形態にかかる作業機械の安全装置を示すブロック図である。 第１の実施形態にかかる作業機械のセンサ構成を示す側面図である。 第１の実施形態にかかるＺＭＰ演算用作業機械モデルを示す側面図である。 第１の実施形態にかかる支持多角形と転倒警告領域を示す模式図である。 第１の実施形態にかかる安定性演算手段の判定方法の一例を示すフローチャートである。 第１の実施形態にかかる安定性算出方法を示す模式図である。 第１の実施形態にかかる表示装置の一例を示す説明図である。 第１の実施形態にかかる表示装置の一例を示す説明図である。 第１の実施形態にかかる表示装置の一例を示す説明図である。 第１の実施形態にかかる表示装置の一例を示す説明図である。 第２の実施形態にかかる表示装置を示す説明図である。 第３の実施形態にかかる作業機械の安全装置を示すブロック図である。 第３の実施形態にかかる安定性演算手段の判定方法を示すフローチャートある。 第３の実施形態にかかる表示装置を示す説明図である。 第４の実施形態にかかる作業機械の安全装置を示すブロック図である。 第４の実施形態にかかる作業機械の表示装置を示す説明図である。 第４の実施形態にかかる作業機械の表示装置を示す説明図である。
 （第１の実施形態）
　 以下、本発明の第１の実施形態について、図を参照しながら説明する。
＜対象装置＞
　図１は、本発明が適用される作業機械の側面図である。作業機械１には、走行体２上部に旋回体３が旋回可能に取付けられ、旋回体３は旋回モータ７によって中心軸３ｃを中心に旋回駆動される。旋回体３には、運転室４と動力系を構成するエンジン５が取付けられている。また、旋回体３の後方には、カウンタウエイト８が設けられている。３０は地表面である。旋回体３はさらに作業機械１の起動停止および動作全般を制御する運転制御装置を備えている。
　作業機械１の前面に設けられた作業フロント６において、ブームシリンダ１１は、ブーム１０を支点４０の回りに回動する駆動アクチュエータであり、旋回体３とブーム１０とに連結されている。アームシリンダ１３は、アーム１２を支点４１の回りに回動する駆動アクチュエータであり、ブーム１０とアーム１２とに連結されている。作業具シリンダ１５はバケット２３を支点４２の回りに回動する駆動アクチュエータであり、リンク１６を介してバケット２３と連結され、リンク１７を介してアーム１２に連結されている。バケット２３は、グラップル、カッタ、ブレーカ等の、図示しない他の作業具に任意に交換可能である。
　旋回体３に取り付けられた、作業機械１を操作するオペレータ用の運転室４の中には、オペレータからの各駆動アクチュエータに対する動きの指示を入力するための操作レバー５０、作業機械１の安定性情報や転倒警告情報等を表示する表示装置６１ｄ、作業機械１の転倒警告音等を発する警報装置６３ｄ、オペレータが安全装置の設定を行うためのユーザ設定入力手段５５が設けてある。
＜安全装置＞
　図２は、安全装置に関する概略構成を示すブロック図である。安全装置は、作業機械１の姿勢等を検出するために作業機械１の各部に取付けられた状態量検出手段（センサ）４９、オペレータが安全装置の設定を行うためのユーザ設定入力手段５５、状態量検出手段４９の検出値により所定の演算を行う制御装置６０、オペレータに安定性の情報を提示する表示装置６１ｄ、および警報装置６３ｄを備える。
　制御装置６０は、作業機械１の制御装置のうち特に安全装置に関係する部分を示している。制御装置６０は、さらに状態量検出手段４９およびユーザ設定入力手段５５の信号が入力される入力部６０ｘ、入力部６０ｘに入力される信号を受けてＺＭＰ位置７０の算出を行うＺＭＰ算出手段６０ｆ、ＺＭＰ算出手段６０ｆの算出結果を所定の期間記憶するＺＭＰ記憶手段６０ｇ、ＺＭＰ算出手段６０ｆの算出結果より安定性の算出および転倒可能性の判定を行う安定性演算手段６０ｄ、安定性演算手段６０ｄからの出力信号に基づきそれぞれ表示装置６１ｄおよび警報装置６３ｄへの出力を決定する表示制御手段６１ｃおよび警報制御手段６３ｃ、並びに表示制御手段６１ｃおよび警報制御手段６３ｃからの出力信号をそれぞれ表示装置６１ｄおよび警報装置６３ｄに出力する出力部６０ｙを備える。ＺＭＰ算出手段６０ｆはさらに、リンク演算手段６０ａとＺＭＰ演算手段６０ｂを備える。
　制御装置６０は、図示しないＣＰＵ、ＲＯＭ、ＲＡＭ、及びフラッシュメモリ等からなる記憶部などを備えるマイクロコンピュータ、並びにＲＯＭに格納されるコンピュータプログラム及び周辺回路を有し、ＣＰＵ上でコンピュータプログラムを作動させて演算処理を行う。
　本発明は、制御装置６０で演算したＺＭＰ位置算出および安定性判定の結果を、表示装置６１ｄおよび警報装置６３ｄを介してオペレータが瞬時に的確に認識できるように提示することによって安全な作業を支援するものである。
＜状態量検出手段＞
　作業機械１の各部に取付けられた状態量検出手段（センサ）４９について図３を参照しながら説明する。
＜姿勢センサ＞
　上部旋回体３には、後述する重力と逆方向をＺ軸としたワールド座標系に対する機械基準座標系の傾きを検出するための姿勢センサ３ｂが設けられている。姿勢センサ３ｂは、例えば傾斜角センサであり、上部旋回体３の傾斜角を検出することで、ワールド座標系に対する機械基準座標系の傾きを検出する。
＜角度センサ＞
　上部旋回体３の旋回中心線３ｃ上には、下部走行体２と上部旋回体３の旋回角度を検出するための旋回角度センサ３ｓが設けられている。
　上部旋回体３とブーム１０の支点４０には、ブーム１０の回動角度を計測するためのブーム角度センサ（角度センサ）４０ａが設けられている。
　ブーム１０とアーム１２の支点４１には、アーム１２の回動角度を計測するためのアーム角度センサ（角度センサ）４１ａが設けられている。
　アーム１２とバケット２３の支点４２には、バケット２３の回動角度を計測するためのバケット角度センサ４２ａが設けられている。
＜加速度センサ＞
　下部走行体２、上部旋回体３、ブーム１０、及びアーム１２の重心近傍には、それぞれ下部走行体加速度センサ２ａ、上部旋回体加速度センサ３ａ、ブーム加速度センサ１０ａ、アーム加速度センサ１２ａが設けられている。
＜ピン力センサ＞
　アーム１２とバケット２３を繋ぐピン４３、リンク１６とバケット２３を繋ぐピン４４には、それぞれピン力センサ４３ａ、４４ａが設けられている。ピン力センサ４３ａ、４４ａは、例えば円筒状の内部にひずみゲージが挿入され、このひずみゲージに発生するひずみを計測することによって、ピン４３、４４にかかる力（外力）の大きさと方向を検出する。
＜座標系の設定＞
　図４にＺＭＰ算出用作業モデル（側面）、ワールド座標系（Ｏ－Ｘ’Ｙ’Ｚ’）、機械基準座標系（Ｏ－ＸＹＺ）を示す。図４に示すようにワールド座標系（Ｏ－Ｘ’Ｙ’Ｚ’）は重力方向を基準とし、重力と逆方向をＺ軸としたものである。一方、機械基準座標系（Ｏ－ＸＹＺ）は下部走行体２を基準としたものであり、図４に示すように、原点を上部旋回体３の旋回中心線３ｃ上で、地表面３０と接する点Ｏとし、下部走行体２の前後方向にＸ軸、左右方向にＹ軸、旋回中心線３ｃ方向にＺ軸を設定する。ワールド座標系と機械基準座標系との関係は上述した姿勢センサを用いて検出し、ＺＭＰ算出手段６０ｆにおいては機械基準座標系に基づいて演算を行う。
＜モデル＞
　また、第１の実施形態では、実装の簡易性を考慮しＺＭＰ７０を演算するためのモデルとして、各構成部材の重心に質量が集中している集中質点モデルを用いる。下部走行体２、上部旋回体３、ブーム１０、アーム１２のそれぞれの質点２Ｐ、３Ｐ、１０Ｐ、１２Ｐを各構成部材の重心位置に設定し、それぞれの質点の質量をｍ２、ｍ３、ｍ１０、ｍ１２とする。そして、それぞれの質点の位置ベクトルをｒ２、ｒ３、ｒ１０、ｒ１２、加速度ベクトルをｒ´´２、ｒ´´３、ｒ´´１０、ｒ´´１２とする。
　なお、質点の設定方法はこの限りではなく、例えば、質量が集中している部位（図１に示すエンジン５、カウンタウエイト８など）を追加してもよい。
　また、外力は、バケット２３で作業行うことにより、バケット２３の先端に加わる。バケット２３はピン４３、４４を介して作業フロント６と繋がっていることから、バケット２３の重力および慣性力と、バケット２３に加わるＸ軸方向およびＺ軸方向の外力の全てを、ピン４３とピン４４に加わる外力ベクトルＦ４３とＦ４４として算出し、ＺＭＰ座標の演算を行う。ここで、外力作用点であるピン４３とピン４４の位置ベクトルをｓ４３、ｓ４４とする。
＜安定性評価指標＞
　ここで、安全装置の各構成要素の詳細を説明する前に、本発明における安定性の評価方式について説明する。第１の実施形態においては作業機械１の安定性を判定するための安定性評価指標としてＺＭＰ（Zero Moment Point）を用いる。
ＺＭＰ安定判別規範はダランベールの原理に基づいたものである。なお、ＺＭＰの概念ならびにＺＭＰ安定判別規範については「ＬＥＧＧＥＤ　ＬＯＣＯＭＯＴＩＯＮ　ＲＯＢＯＴＳ：Ｍｉｏｍｉｒ　Ｖｕｋｏｂｒａｔｏｖｉｃ著（「歩行ロボットと人工の足：加藤一郎訳、日刊工業新聞社」）」に記載されている。
　図１に示す作業機械１から地表面３０には重力、慣性力、外力およびこれらのモーメントが作用するが、ダランベールの原理によればこれらは地表面３０から作業機械１への反作用としての床反力および床反力モーメントとつりあう。
　したがって、作業機械１が地表面３０に安定に接地している場合、作業機械１と地表面３０との接地点を凹にならないように結んだ支持多角形の辺上あるいはその内側にピッチ軸およびロール軸方向のモーメントがゼロになる点（ＺＭＰ）が存在する。逆に言えば、ＺＭＰが支持多角形内に存在し、作業機械１から地表面３０に作用する力が地表面３０を押す向き、つまり床半力が正である場合、作業機械１は安定に接地しているといえる。
　つまり、ＺＭＰが支持多角形の中心に近いほど安定性は高く、支持多角形の内側にあれば作業機械１は転倒することなく作業を行うことができる、一方、ＺＭＰが支持多角形上に存在する場合には作業機械１は転倒を開始する可能性がある。したがって、ＺＭＰと作業機械１と地表面３０が形成する支持多角形とを比較することによって安定性を判定することができる。
＜ＺＭＰ方程式＞
　ＺＭＰ方程式は、重力、慣性力、外力によって発生するモーメントの釣り合いから、以下のように導出される。
Figure JPOXMLDOC01-appb-M000001
　ここで
 ｒｚｍｐ：ＺＭＰ位置ベクトル
 ｍｉ：ｉ番目の質点の質量
 ｒｉ：ｉ番目の質点の位置ベクトル
 ｒ”ｉ：ｉ番目の質点に加わる加速度ベクトル（重力加速度含む）
 Ｍｊ：ｊ番目の外力モーメント
 ｓｋ：ｋ番目の外力作用点位置ベクトル
 Ｆｋ：ｋ番目の外力ベクトル
なお、ベクトルはＸ成分、Ｙ成分、Ｚ成分で構成される３次元ベクトルである。
　上式（１）の左辺の第１項は、各質点ｍｉにおいて印加された加速度成分（重力加速度を含む）により生成されるＺＭＰ７０（図３参照）回り（半径ｒｉ－ｒｚｍｐ）のモーメントの総和を示す。上式（１）の左辺の第２項は、作業機械１に作用する外力モーメントＭｊの総和を示す。上式（１）の左辺の第３項は、外力Ｆｋ（ｋ番目の外力ベクトルＦｋの作用点をｓｋとする）により生成されるＺＭＰ７０回り（半径ｓｋ－ｒｚｍｐ）のモーメントの総和を示す。
　そして、式（１）は、各質点ｍｉにおいて印加された加速度成分（重力加速度を含む）により生成されるＺＭＰ７０回り（半径ｒｉ－ｒｚｍｐ）のモーメントの総和と、外力モーメントＭｊの総和と、外力Ｆｋ（ｋ番目の外力Ｆｋの作用点をｓｋとする）により生成されるＺＭＰ７０回り（半径ｓｋ－ｒｚｍｐ）のモーメントの総和が釣り合うということを記述している。
　式（１）に示すＺＭＰ方程式より、地表面３０におけるＺＭＰ７０を算出することが可能となる。
　ここで、対象物が停止しており、重力のみが働く場合のＺＭＰ方程式は、重力加速度ベクトルｇを用いて
Figure JPOXMLDOC01-appb-M000002
 と表され、静的重心の地表面への投影点と一致する。したがって、ＺＭＰは動的状態および静的状態を考慮した重心の投影点として扱うことが可能であり、ＺＭＰを指標として用いることによって対象物が静止している場合と、動作を行っている場合との両方を統一的に扱うことができる。
　また、支持多角形は作業機械の接地面形状と一致するため、安定性の確保される領域と現在の安定性（支持多角形内のＺＭＰ位置）とを作業機械の輪郭を地表面に投影した上面図上に示すことができ、視覚的にわかりやすい。
　＜ユーザ設定入力手段＞
　図１において、ユーザ設定入力手段５５は複数個の入力ボタンなどから構成され、オペレータはユーザ設定入力手段５５を介して作業内容や個々人の好みに応じて警告方法や安全率などの設定を行う。
　＜ＺＭＰ算出手段＞
　ＺＭＰ算出手段６０ｆは、状態量検出手段４９の検出値から機械基準座標系（Ｏ－ＸＹＺ）を基準とした各質点の位置ベクトル、加速度ベクトルおよび外力ベクトルを算出するリンク演算手段６０ａと、機械基準座標系に変換された各質点の位置ベクトル、加速度ベクトルおよび外力ベクトルを用いてＺＭＰ７０ａを算出するＺＭＰ演算手段６０ｂとから構成される。
　＜リンク演算＞
　図３において、作業機械１の各部に配された姿勢センサ３ｂ、旋回角度センサ３ｓ、ブーム角度センサ４０ａ、アーム角度センサ４１ａ、バケット角度センサ４２ａ、走行体加速度センサ２ａ、旋回体加速度センサ３ａ、ブーム加速度センサ１０ａ、アーム加速度センサ１２ａ、ピン力センサ４３ａ、４４ａの検出値がＺＭＰ算出手段６０ｆのリンク演算手段６０ａに送られる。
　リンク演算手段６０ａでは、図３に示す旋回体３に設けた姿勢センサ３ｂの値と、作業機械１各部に設けた旋回角度センサ３ｓ、ブーム角度センサ４０ａ、アーム角度センサ４１ａ、バケット角度センサ４２ａの検出値を用いて、各リンクについて順次運動学計算を行う。そして、図４に示す各質点２Ｐ、３Ｐ、１０Ｐ、１２Ｐの位置ベクトルｒ２、ｒ３、ｒ１０、ｒ１２、および走行体加速度センサ２ａ、旋回体加速度センサ３ａ、ブーム加速度センサ１０ａ、アーム加速度センサ１２ａの検出結果から算出される各質点の加速度ベクトルｒ´´２、ｒ´´３、ｒ´´１０、ｒ´´１２、ピン４３、４４に対する位置ベクトルｓ４３、ｓ４４、ピン４３、４４に作用する各外力ベクトルＦ４３、Ｆ４４を、機械基準座標系（Ｏ－ＸＹＺ）を基準とした値に変換する。ここで、運動学計算の方法は周知の方法を用いることができるが、例えば「ロボット制御基礎論：吉川恒夫著、コロナ社（１９８８）」に記載されている方法を用いることができる。リンク演算手段６０ａからＺＭＰ演算手段６０ｂに送られるデータは、機械基準座標系（Ｏ－ＸＹＺ）を基準とした各質点の位置ベクトル、加速度ベクトルおよび外力ベクトルである。
　＜ＺＭＰ演算＞
　ＺＭＰ演算手段６０ｂでは、機械基準座標系に変換された各質点の位置ベクトル、加速度ベクトルおよび外力ベクトルを用いてＺＭＰ７０ａを算出し、ＺＭＰ７０ａをＺＭＰ位置７０として出力する。
　第１の実施形態では、機械基準座標系の原点Ｏを下部走行体２と地表面３０の接する点に設定しているため、ＺＭＰのＺ軸座標が地表面３０上にあると仮定すると、ｒｚｍｐｚ＝０である。また、作業機械１では通常、バケット２３以外の部分には外力や外力モーメントはほとんど作用しないため、その影響を無視し、外力モーメントＭ＝０とみなす。このような条件のもとで式（１）を解き、ＺＭＰ７０ａのＸ座標ｒｚｍｐｘを以下のように算出する。
Figure JPOXMLDOC01-appb-M000003
また、同様にＺＭＰ７０ａのＹ座標ｒｚｍｐｙは以下のように算出する。
Figure JPOXMLDOC01-appb-M000004
　式（３）、（４）において、ｍは、図４に示す各質点２Ｐ、３Ｐ、１０Ｐ、１２Ｐの質量であり、各質点の質量ｍ２、ｍ３、ｍ１０、ｍ１２を代入する。ｒ´´は各質点の加速度であり、各質点の加速度ｒ´´２、ｒ´´３、ｒ´´１０、ｒ´´１２を代入する。ｓは外力作用点であるピン４３、４４の位置ベクトルを示しており、ｓ４３、ｓ４４を代入する。Ｆは外力作用点であるピン４３、４４に加わる外力ベクトルを表しており、Ｆ４３、Ｆ４４を代入する。
　以上のように、作業機械１の各部に設けた各センサの検出値を用いることによって、ＺＭＰ演算手段６０ｂは、ＺＭＰ７０ａの座標を算出することができる。算出されたＺＭＰ７０ａをＺＭＰ位置７０として安定性演算手段６０ｄおよびＺＭＰ記憶手段６０ｇに送る。
　＜ＺＭＰ記憶手段＞
　ＺＭＰ記憶手段６０ｇは、ＺＭＰ算出手段６０ｆにおいて算出されるＺＭＰ位置７０を所定の期間、ＺＭＰ位置履歴７２として保存し、所定の期間が過ぎたデータは破棄する。
　＜安定性演算手段＞
　次に、安定性演算手段６０ｄがＺＭＰ位置７０に基づいて行う領域判定による安定性算出と転倒可能性の判定について図５を用いて説明する。
　前記のように、ＺＭＰ位置７０が、作業機械１と地表面３０とで形成する支持多角形Ｌの十分内側の領域に存在する場合、図１に示す作業機械１は転倒する可能性はほとんどなく、安全に作業を行うことが可能である。
　第１の実施形態における安定性演算手段６０ｄは、図５（ａ）に示すように作業機械１と地表面３０との接地点で形成される支持多角形Ｌを算出する支持多角形算出手段６０ｍと、支持多角形算出手段６０ｍによって算出された支持多角形Ｌに対し、転倒の可能性が十分低い通常領域Ｊと、転倒の可能性がより高い転倒警告領域Ｎを設定し、ＺＭＰ位置７０がいずれの領域にあるかの判定によって安定性を評価する安定性評価手段６０ｎとから構成される。
　走行体２が地表面３０に正立している場合、支持多角形Ｌは、走行体２の平面形状と略等しくなる。したがって、走行体２の平面形状が矩形の場合、支持多角形Ｌは図５（ａ）に示すように矩形となる。より具体的には、下部走行体２としてクローラを有している場合の支持多角形Ｌは、左右のスプロケットの中心点を結んだ線を前方境界線、左右のアイドラの中心点を結んだ線を後方境界線、左右それぞれのトラックリンク外側端を左右の境界線とした四角形である。なお、前方および後方の境界は最も前方の下部ローラおよび最も後方の下部ローラの接地点としてもよい。
　一方、図１に示した作業機械１ではブレード１８を有しており、ブレード１８が地表面３０に接地している場合には、支持多角形Lは、ブレード底部を含むように拡大する。また、バケット２３を地表面に押し付けて走行体２を持ち上げるジャッキアップ動作においては、支持多角形Lは、走行体２の接地している側の２つの端点とバケット２３の接地点とによって形成される多角形となる。このように、作業機械１の接地状態によって支持多角形Lの形状が不連続に変化するため、支持多角形算出手段６０ｍは作業機械１の接地状況を監視し、接地状況に応じて支持多角形Lを設定する。
　安定性評価手段６０ｎにおいて通常領域Ｊと転倒警告領域Ｎの境界Ｋを支持多角形Ｌの内側に設定する。具体的には、境界Ｋは支持多角形Ｌを安全率にしたがって決定される比率に応じて、中心点側に縮小した多角形あるいは、支持多角形Ｌを安全率にしたがって決定される長さだけ内側に移動した多角形に設定される。
　安定性評価手段６０ｎでは、ＺＭＰ算出手段６０ｆにおいて算出されるＺＭＰ位置７０が通常領域Ｊにある場合には、作業機械１の安定性は十分に高いと判定し、一方、ＺＭＰ位置７０が転倒警告領域Ｎにある場合には作業機械が転倒の可能性ありと判定する。
　ＺＭＰ位置７０が転倒警告領域Ｎにある場合に警告を発する構成としたことから、転倒警告領域Ｎの面積が大きいほど、早期に警告を発することになる。したがって、転倒警告領域Ｎの大きさは、作業機械１に求められる安全性などを考慮して決定すればよい。なお、安全率は、あらかじめ設定される所定の値（例えば、８０％など）であってもよいし、作業機械１を操作するオペレータの習熟度や作業内容路面や周囲の状況などによって変更される値であってもよい。この場合、あらかじめ与えられた情報や各種センサの出力値等から自動で設定する構成やオペレータや作業管理者がユーザ設定入力装置５５を用いて安全率を任意に設定する構成などが考えられる。
　また、安全率は作業機械１の作業状態に応じて作業中に変更されても良いし、前後左右について異なる値を用いる構成としても良い。例えば、傾斜地における作業では、ＺＭＰ位置７０は傾斜面の谷側に移動しやすく、山側に比べ谷側への転落が発生しやすい傾向にある。そこで、傾斜角度に応じ、図５に示すように、転倒警告領域Ｎを谷側が広くなるように設定する。傾斜角度はオペレータによる入力のほか姿勢センサ３ｂの検出値を用いる方法が考えられる。また、転倒が発生してしまった場合、作業フロント６の存在する方向以外への転倒は作業フロント６の方向への転倒に比べ、より重大な事故につながりやすい。そこで、作業フロント６の方向に応じ、作業フロント６の方向に対しそれ以外の方向が広くなるように転倒警告領域Ｎを設定する。支持多角形Ｌに対する作業フロント６の方向は旋回角度センサ３ｓによって検出する方法が考えられる。
　転倒警告領域Ｎを設定方法として、オペレータや作業管理者が随時手動で設定を変更するほか、ＧＰＳ、地図情報、作業のＣＡＤ図面などを用いる構成が考えられる。上記の情報を用いることによって転倒が発生しやすい方向や転倒時の被害の大きい方向を自動で判別し、その方向の転倒警告領域Ｎが広くなるよう通常領域Ｊと転倒警告領域Ｎの境界Ｋを自動で変更をすることができる。
 このように安全率を適正な値とすることによって作業効率を低下させることなく安全な作業を行うことができる。
　より高い安全性を確保するためにＺＭＰ記憶手段６０ｇに記憶されているＺＭＰ位置履歴７２を用い、ＺＭＰ位置７０およびＺＭＰ位置履歴７２のうち１つでも転倒警告領域Ｎにある場合には転倒の可能性ありと判定するように構成してもよい。すなわち比較的短時間にＺＭＰ位置が変動するような作業ではオペレータが変動する情報を逐一把握することは困難であるため、数秒間程度の履歴情報を記録してこれに基づいて判断する。
　また、過度な警告による作業効率の低下を低減し、また、オペレータによる安定性回復動作を支援するために、ＺＭＰ位置７０とＺＭＰ位置履歴７２との位置関係から警告の必要性を判定するように構成しても良い。
　具体的な転倒可能性の判定および警告方法について、図６のフローチャートを用いて説明する。ＺＭＰ位置７０およびＺＭＰ履歴値７２がともに通常領域Ｊにある場合には、作業機械１は十分に安定であると判定し、警告指令は出力しない（ステップ６１、６２、６４）。ＺＭＰ位置７０が通常領域Ｊにあり、ＺＭＰ履歴値７２が転倒警告領域Ｎにある場合には、安定性の低い状態からの復帰完了と判定し、回復完了を示す指令を出力する（ステップ６１、６２、６５）。ＺＭＰ位置７０が転倒警告領域Ｎにある場合には、ＺＭＰ位置７０とＺＭＰ履歴値７２の位置関係によって指令を変更する。ＺＭＰ位置７０がＺＭＰ履歴値７２に対して通常領域Ｊに近い場合には回復動作を試みている最中と考えられる。ただし、依然として転倒の可能性のある状態であり、安定性の低い状態からの復帰は完了していないため、回復動作中を示す指令を出力する（ステップ６１、６３、６６）。ＺＭＰ位置７０が転倒警告領域ＮかつＺＭＰ履歴値７２よりも支持多角形Ｌに近い場合には転倒の可能性が高まっており、警告の必要性が非常に高い。そこで、この場合には緊急警告指令を行う（ステップ６１、６３、６７）。
　このようにＺＭＰ位置７０加え、ＺＭＰ履歴値７２を評価指標として用いることにより、現在の作業機械１の動作が安定性を回復させる動作であるのかあるいは劣化させる動作であるのかを判断することができ、より適切な指令によって安全な作業を支援することができる。また、安定性の回復が見込まれる場合を判定し、警告方法を変更することができるため、過度な警報による不快感や作業効率の低下を防ぐことができる。
　通常領域Ｊと転倒警告領域Ｎとの境界Ｋは、図５（ｂ）に示すように境界Ｋを段階的に２つ以上設定することによって転倒警告領域Ｎを２つ以上の領域に分ける構成としても良い。図５（ｂ）のように転倒警告領域Ｎを転倒警告領域Ｎ１と転倒警告領域Ｎ２とに分けた場合においては、例えば、ＺＭＰ位置７０が、転倒警告領域Ｎ２にある場合には予備的な警告を行うように指令を行い、リスクを早期に回避させることができる。
　図７は、安定性評価手段６０ｎにおいて領域判定による転倒可能性の判定に加え、安定性を数値化して算出し判定に用いる方式を説明する図である。
　この方式を用いることにより、安定性を定量的かつ連続的に把握することができる。支持多角形が矩形の場合を例にとり説明する。支持多角形Ｌの中心Ｌｃ（Ｘｌｃ、Ｙｌｃ）とＺＭＰ位置７０とを通る直線Ｌｚおよび直線Ｌｚと支持多角形の辺との交点Ｃ（Ｘｃ、Ｙｃ）を算出する。安定度αを中心Ｌｃから交点Ｃまでの距離と中心ＬｃからＺＭＰ位置７０までの距離との比率を用いて
Figure JPOXMLDOC01-appb-M000005
 と定義する（図７（ａ）参照）。安定度αは０から１の間の値を取り、値が大きいほどＺＭＰ位置が支持多角形の中心に近いことを示し、安定性が高いことを意味する。
　より簡易な演算とするために、安定度αをＸ座標、Ｙ座標それぞれに対し支持多角形内でとりうる最大値とＺＭＰ位置７０との比率を評価するものとして定義しても良い（図７（ｂ）参照）。このとき、Ｘ軸方向の比率
Figure JPOXMLDOC01-appb-M000006
 とＹ軸方向の比率
Figure JPOXMLDOC01-appb-M000007
 のうち小さい値を安定度αとして選定する。ここで、Ｘｍａｘは支持多角形内でとりうるＸ座標の最大値であり、Ｙｍａｘは支持多角形内でとりうるＹ座標の最大値である。また、以上では、支持多角形の辺部とＺＭＰ位置との距離の比率を用いて安定度を算出する方法を示したが、距離の比率を対数で評価し、安定度を算出しても良い。このようにすることにより、支持多角形近傍における安定性変化をより詳細に表現することができる。
　表示装置および警報手段に対し、安定性評価手段６０ｎは、安定性が十分に高いと判定した場合にはＺＭＰ位置７０、ＺＭＰ位置履歴７２および安定度αを出力し、転倒の可能性ありと判定した場合はＺＭＰ位置７０、ＺＭＰ位置履歴７２および安定度αに加え、警告指令を出力する。
　＜表示装置＞
　表示手段６１は、安定性演算手段６０ｄからの指令により表示内容を決定する表示制御手段６１ｃと、ブラウン管や液晶パネルなどからなる装置であって、運転室４内に設けられ、安定性演算手段６０ｄからの制御により、安定性情報や転倒可能性を表示する表示装置６１ｄとから構成される。
　表示装置６１ｄには、図８に示すように作業機械１の上面図６１ｂを表示し、上面図６１ｂ上に転倒警告領域ＮとＺＭＰ位置７０とＺＭＰ位置履歴７２とを表示する。ＺＭＰ位置履歴７２の表示においては図８（ａ）に示すようにＺＭＰ位置７０と異なる形状や異なる色を用い、あるいは、古いデータを新しいデータに対し小さく表示するように構成しても良い。ＺＭＰ位置履歴が複数個ある場合には、最も安定性の低い値のみを表示してもよいし、適度に間引いて表示しても良い。また、図８（ｂ）に示すようにＺＭＰ位置履歴７２からＺＭＰ位置７０への矢印を表示するように構成しても良い。
　安定性演算手段６０ｄにおいて算出される安定度αは、図９に示すようにバー６１ｈを用いて表示する。図９においては安定度αを現すバー６１ｈを表示装置６１ｄの下部に配置し、安定度が小さくなるほど指示部を右に移動させる例を示したが、指示部が安定度に応じて上下方向に移動するように表してもよく、また、バー６１ｈを表示する場所は表示装置６１ｄの上方、左方、右方であっても良い。
　旋回時には図９に示すように上面図６１ｂの走行体２を旋回体３に対して旋回角度分逆回転して表示する。このように旋回姿勢を図示することによってオペレータの視界前方と表示装置６１ｄの上部を常に一致させることができ、また、走行方向の確認も容易である。
　表示装置６１ｄは安定性演算手段６０ｄからの指令によって、転倒可能性の通知を行う。表示装置６１ｄの上部あるいは下部に文字やイラスト図を用いた警告メッセージ６１ｍを表示する。また、図１０に示すように上面図６１ｂのかわりに作業機械１の概観を示す３次元イラストを表示し、転倒可能性がある場合には、３次元イラストを傾ける等して転倒する様子を示すように表示しても良い。他の転倒可能性の通知方法として、転倒可能性がある場合に表示装置６１ｄの背景色を変更する。例えば、通常時（安定状態）の背景色を白色とし、警告指令時には赤色に変更する。
　安定度αを用いれば背景色を数段階に変化させるように構成することもできる。例えば、通常時を白色に、安定度αがやや低い場合には黄色に、安定度αが低くなるにしたがって赤色に近い橙色とし、警告指令時には赤色に設定する。このように背景色を変更することにより、オペレータは表示画面を注視しなくても瞬時に転倒可能性を把握することができる。以上では表示の背景色を変更する例を示したが、背景色と同様に転倒警告領域Ｎ、ＺＭＰ位置７０、ＺＭＰ位置履歴７２の表示色を変更しても良い。
　表示装置６１ｄはオペレータが警告レベルやアラームなどの設定を行うためのユーザ設定入力手段５５を兼ねる構成としても良い。この場合、表示装置６１ｄはタッチパネルなどの入力手段を有するものとし、図９に示すように設定入力アイコン６１ｋの表示を行う。
　＜警報手段＞
　さらに第１の実施形態にかかる作業機械１においては、安定度αに応じて警報を発する警報手段６３を有する。警報手段６３は安定性演算手段６０ｄからの指令に基づいて警報の方法を決定し出力する警報制御手段６３ｃと、例えばブザーなどの警告音を発生する装置であって警報制御手段６３ｃからの指令により警告音などの警報を発する警報装置６３ｄとから構成される。警報装置６３ｄは運転室４内に設けられる。警報制御手段６３ｃは安定度αに応じて警告音を変更するように指令を行う。例えば、安定度αが低くなるにしたがって音の大きさを大きくする、安定度αが低くなるにしたがって警告音の間隔を短くする、安定度αに応じて警告音の音程を変化させるなどの変更を行う。
　運転室４に備わる警報装置６３ｄが発する警報により、オペレータや周囲の作業員に転倒の可能性を認知させることによって、安全性の高い作業を行うことが可能となる。また、安定度に応じて警告音を変化させることによって、オペレータが表示装置６１ｄを見ていない場合にも正確に安定性を認識させることができる。
　また、警報装置６３ｄを作業機械１の外部にも設置する構成としてもよい。このような構成とすることによって作業機械１の周囲で作業を行う作業員に対し作業機械１の転倒可能性を通知することができる。
　＜旋回表示の変更＞
　図９には、上面図の走行体２を旋回体３に対して旋回角度分逆回転して表示し、作業フロントの方向を常に表示装置の上向きとする例を示したが、図１１に示すように上面図の走行体２の方向を固定し、走行体２に対し旋回体３を旋回角度分回転して表示するように構成しても良い。この表示方法は特に周囲の物体との位置関係を把握する必要がある場合に特に有効である。
　＜表示装置・警報手段の場所＞
　以上の例においては、オペレータは作業機械１上に備えた運転席４に搭乗し、作業機械１の操作を行うことを想定して説明した。一方、作業機械１の操作は無線等を用いた遠隔操作が行われるケースがある。遠隔操作時には、搭乗時に比べ作業機械の姿勢や路面の傾斜等を正確に把握するのが困難であり、また、熟練したオペレータでも作業機械の安定性を感覚的に把握することが困難である。したがって、遠隔操作時においては、オペレータに対する安定性情報の表示および警告は一層優れた効果を奏する。
　遠隔操作型の作業機械においては、操作レバーは作業機械１上以外の通常はオペレータの操作場所に設けられる。表示装置、警報装置もオペレータの操作を行う場所に設置すればよい。また、ＺＭＰ算出や安定性算出の演算をオペレータ側で行うことにより、通信データ量を少なくして通信遅れの影響を受けにくい構成とすることが可能である。
　また、他の表示装置の利用形態として、作業管理者が遠隔地より作業機械１の状況の確認を行うケースが考えられる。このような場合はオペレータ用の表示装置に加え、作業機械１上以外の場所に管理者用の表示装置を設け、無線等を用いてデータ転送を行うことにより、作業機械１の状況を表示することができる。管理者用表示装置の表示は運転者用のものと同一としても良いし、各アクチュエータへの指令量などの情報を付加して表示しても良い。
　＜簡易表示装置の追加＞
　以上では、安定度演算手段６０ｄにおいて算出される安定度αについて表示装置６１ｄ上にバー６１ｈを用いて表示する例を示したが、表示装置６１ｄに加えて安定度αを表示のみを行う簡易表示装置６１ｘを設置し、簡易表示装置６１ｘ上にバー６１ｈを表示するように構成しても良い。簡易表示装置６１ｘの設置場所としては、運転席前方、作業機械１の外壁などが考えられる。また、表示装置６１ｄを設けず、簡易表示装置６１ｘのみを設置する構成としても良い。このような構成とすることによってより安価かつ簡易な構成で作業機械１の安定性を通知することが可能になる。
　＜作業内容判定手段の追加＞
　転倒警告領域Ｎの設定方法として、現在行っている作業の内容を認識し、その作業内容によって転倒警告領域Ｎの大きさや形状を変更することが考えられる。
　作業内容判定手段６１ｉでは、あらかじめ吊荷作業、掘削作業、解体作業、走行などの複数の作業における特徴的な操作パターンとそれぞれの作業内容に適合した転倒警告領域Ｎを設定し記憶する。各駆動アクチュエータ１１、１３、１５への入力指令量を検出するレバー操作量センサ５１を設置し、ＺＭＰ算出手段において算出される作業フロント姿勢やバケット外力とレバー操作量センサ５１の検出値の履歴からあらかじめ設定された操作パターンのうち最も近いものを選択し、対応する転倒警告領域Ｎを出力する。このように作業内容判定を行うことによりそれぞれの作業に即した転倒警告領域を設定することが可能となり、作業効率を高く保ったまま安全性を向上させることができる。
　＜回復動作算出手段の追加＞
　回復動作算出手段６０ｌは、操作レバー５０のうちどのレバーをどちらの方向に操作すれば安定性を回復することができるか判定する。
　安定性演算手段６０ｄにおいて警告指令が発せられた場合、操作レバーを適切に操作し、安定性を回復させることが望ましい。しかし、路面の傾斜等の周囲の状況やオペレータの熟練度によってはどのように操作すれば安定性が回復できるかがわからず、誤った操作によって転倒の可能性を増大させてしまうことが考えられる。そこで、回復動作算出手段６０ｌにおいて、安定性を回復させるための操作方法を判定し、表示装置６１ｄに出力することによって安定性回復動作を支援し転倒の可能性を低下させることができる。
　具体的には、安定性演算手段６０ｄにおいて警告指令が発せられた場合に、作業機械１の姿勢およびＺＭＰ位置７０より各操作レバー５０の操作がＺＭＰ位置７０を支持多角形Ｌの中心方向に移動させるか否かを判定し、ＺＭＰ位置７０を中心方向に移動させる操作方法を表示手段６１に対し出力する。例えば、作業フロントの方向が走行体２の前方にあり、ＺＭＰ位置７０が通常領域Ｎの前方にある場合にはゆっくりとアームを手前に引くあるいはゆっくりと作業フロントの方向が走行体に対して斜めとなるように旋回する等の動作を行うと良い。表示手段６１は、必要に応じて回復動作算出手段６０ｌの算出結果を表示装置６１ｄに表示する。
　＜警告提示方法の変更＞
　以上では、ＺＭＰ位置７０を表示装置６１ｄに表示し、また、表示装置６１ｄおよび警報装置６３ｄによって安定性の低下を警告することによってオペレータに機械の安定性情報を提示する例を示した。安定性情報のその他の提示方法として、操作レバー５０や運転席４を用いる方法が考えられる。例えば、安定性演算手段において警告指令が発せられた場合には、操作レバー５０や運転席４を振動させることによって警告を行うことができる。また、操作レバー５０の操作方向のうち安定性を劣化させる方向の操作感を重くすることによって、転倒可能性の通知および安定回復動作支援を行うことができる。このように、表示装置６１ｄおよび警報装置６３ｄ以外の方法で機械の安定性情報を提示することによって、オペレータが表示装置６１ｄを見ていない場合や、騒音が大きく警報が聞こえ辛い環境においても安定性情報を認識させ、安全な操作へ導くことができる。
　また、警報装置６３ｄを運転席４に対し前後左右など複数の方向および箇所に設置し、ＺＭＰ位置７０の方向にある警報装置から警告音等を発生させるようにしてもよい。ＺＭＰ位置７０の方向に応じて警告を行うことによって、オペレータが表示装置６１ｄを見ていない場合にも正確に注意すべき方向を含んだ安定性情報を認識させることができる。
　＜外力計測方法＞
　以上では、バケットに加わる外力の検出にピン力センサ４３ａ、４４ａを設ける例を示したが、その他の検出方法としてブームシリンダに圧力センサ１１ａ、１１ｂを設ける方法がある。この方法では、ブームシリンダに設けた圧力センサ１１ａ、１１ｂの検出値からバケット外力と作業フロント自重とを含んだモーメントＭｌを算出し、また、ブーム、アーム、バケットの各角度センサの検出値とブーム、アーム、バケットの各重心パラメータとから作業フロントの自重モーメントＭｏｃを算出する。次いで前記モーメントＭｌとＭｏｃとの差分およびブーム回動支点４０からバケット２３までの距離からバケット外力を算出する。
 （第２の実施形態）
　次に本発明の第２の実施形態を説明する。第２の実施形態では第１の実施形態のＺＭＰに代えて、作業機械１の質量中心である重心位置を用いる。以下では、図１２を参照し主に第１の実施形態との相違点を説明する。
　＜状態量検出手段＞
　第２の実施形態の状態量検出手段４９は、第１の実施形態に示されるセンサのうち、姿勢センサ３ｂ、ブーム角度センサ４０ａ、アーム角度センサ４１ａ、バケット角度センサ４２ａ、ピン力センサ４３ａ、４４ａが設けられる。
　＜ＺＭＰ演算手段＞
　第１の実施形態と同様にリンク演算を行う。第２の実施形態においては、作業機械１の各部に配された姿勢センサ３ｂ、旋回角度センサ３ｓ、ブーム角度センサ４０ａ、ピン力センサ４３ａ、４４ａの検出値がリンク演算手段６０ａに送られ、図４に示す各質点２Ｐ、３Ｐ、１０Ｐ、１２Ｐの位置ベクトルｒ２、ｒ３、ｒ１０、ｒ１２、ピン４３、４４の位置ベクトルｓ４３、ｓ４４、ピン４３、４４に作用する各外力ベクトルＦ４３、Ｆ４４を機械基準座標系（Ｏ－ＸＹＺ）を基準とした値に変換する。
　ＺＭＰ演算手段６０ｂでは、各センサの検出値をもとに機械基準座標系に変換された各質点の位置ベクトルと外力ベクトルを用いて、作業機械１の質量中心７０ｂを算出し、ＺＭＰ位置７０とする。作業機械１の質量中心７０ｂは以下のように導出される。
Figure JPOXMLDOC01-appb-M000008
　ここで、
　 ｒcog：質量中心ベクトル
　 ｍｉ：ｉ番目の質点の質量
　 ｒｉ：ｉ番目の質点の位置ベクトル
であり、ベクトルはＸ成分、Ｙ成分、Ｚ成分で構成される３次元ベクトルである。
　本発明の安全装置では、質量中心７０ｂのＸ座標およびＹ座標を評価する。したがって、質量中心７０ｂのＸ座標ｒｃｏｇｘは以下のように算出する。
Figure JPOXMLDOC01-appb-M000009
また、同様に質量中心７０ｂのＹ座標ｒｃｏｇｙは以下のように算出する。
Figure JPOXMLDOC01-appb-M000010
　式（９）および（１０）においてｍは図４に示す各質点２Ｐ、３Ｐ、１０Ｐ、１２Ｐおよびアタッチメント２３の質量であり、各質点の質量ｍ２、ｍ３、ｍ１０、ｍ１２およびピン４３、４４に加わる外力ベクトルＦ４３、Ｆ４４より算出されるアタッチメントの質量を代入する。
　以上のように、作業機械１の各部に設けた各センサの検出値を用いることによってＺＭＰ演算手段６０ｂは質量中心７０ｂを算出することができる。
　＜質量中心のＺ方向成分の利用＞
　以上では質量中心ベクトルｒcogのＸ成分、Ｙ成分、Ｚ成分のうちＸ成分（Ｘ座標）およびＹ成分（Ｙ座標）を用いる例を示したが、これらに加え、Ｚ成分を安定性評価および表示に用いるように構成しても良い。
Figure JPOXMLDOC01-appb-M000011
　＜質量中心とＺＭＰの併用＞
　以上では、ＺＭＰ位置７０として作業機械１の質量中心７０ｂのみを用いる例を示したが、質量中心７０ｂの算出に加え、第１の実施形態に示したＺＭＰ７０ａの算出を行い、この二つを安定性の指標として評価することもできる。この場合、ＺＭＰ算出手段６０ｆは式（３）および（４）を用いたＺＭＰ７０ａの算出と、式（９）および（１０）を用いた質量中心７０ｂの算出とが行われる。また、安定性演算手段６０ｄにおいてもＺＭＰ７０ａと質量中心７０ｂとを用い、両者で異なる警告指令を行うように構成することもできる。表示手段６１においては、図１２に示すようにＺＭＰ７０ａと質量中心７０ｂとで異なる形状、色を用いて表示を行うように構成しても良い。
 （第３の実施形態）
　本発明の第３の実施形態を図１３から図１４を参照して説明する。第３の実施形態は第１、第２の実施形態と異なり、ＺＭＰ位置７０の近未来の挙動の予測を行い、予測値を用いた表示および警告を行う。これによりさらに迅速で柔軟な対応が可能となる。以下では、第２の実施例との相違点を主に説明する。
　＜ＺＭＰ予測手段＞
　ＺＭＰ予測手段６０ｃでは、近未来のＺＭＰ位置の予測値７１を算出する。以下では、質量中心７０ｂをＺＭＰ位置７０として用いる場合を例にとり、現在のＺＭＰ位置７０とＺＭＰ位置履歴７２とを用いてＺＭＰ予測位置７１を算出する方式について説明する。
　ごく短時間のＺＭＰ位置の変化を考える場合、ＺＭＰ位置の移動速度はほぼ一定と考えることができる。したがって、ＺＭＰ算出手段６０ｆにおいて算出された現在のＺＭＰ位置７０（質量中心７０ｂ）とＺＭＰ記憶手段６０ｇに記憶された過去のＺＭＰ位置履歴７２とからＺＭＰ位置７０の移動速度を算出することによって近未来のＺＭＰ予測位置７１を予測することができる。
　ｄｔ秒後のＺＭＰ予測位置７１は以下の式で算出できる。
Figure JPOXMLDOC01-appb-M000012
　ここで、ｘｃｏｇ［ｐ］はｐ番目の算出点におけるＺＭＰ位置を、ｔ［ｐ］はｐ番目の算出点の時刻を、ｘｃｏｇｐはｔ［ｐ］からｄｔ秒後のＺＭＰ予測位置７１を表す。
　＜安定性演算手段＞
　ＺＭＰ算出手段６０ｆの算出値７０およびＺＭＰ予測手段６０ｃの算出値７１に基づき、安定性演算手段６０ｄにおいて安定判別を行う。
　安定性演算手段６０ｄは第１の実施形態と同様に支持多角形算出手段６０ｍと安定性評価手段６０ｎとから構成される。支持多角形算出手段６０ｍは第１の実施形態と同様であり、また、安定性評価手段６０ｎの転倒警告領域Ｎの設定および安定性の算出についても第１の実施形態と同様である。なお、安定度αの算出においてはＺＭＰ算出手段６０ｆにおいて算出されるＺＭＰ位置７０を用いる。
　安定性評価手段６０ｎにおける転倒可能性の判定にはＺＭＰ算出手段６０ｆにおいて算出される現在のＺＭＰ位置７０とＺＭＰ予測手段６０ｃにおいて算出されるＺＭＰ予測位置７１との両方を指標として用いる。転倒可能性の判定および警告指令について図１４のフローチャートを用いて説明する。
　ＺＭＰ位置７０およびＺＭＰ予測位置７１がともに通常領域Ｊにある場合には作業機械１は安定性ありと判定し、警告指令は出力しない（ステップ１３１、１３２、１３４）。
　ＺＭＰ位置７０が通常領域Ｊにあり、ＺＭＰ予測位置７１が転倒警告領域Ｎにある場合には、作業機械１は転倒可能性が増大していると判定し、予備的な警告を行う予備警告指令を出力する（ステップ１３１、１３２、１３５）。
　ＺＭＰ位置７０は転倒警告領域Ｎにあるが、ＺＭＰ予測位置７１は通常領域Ｊにある場合には、安定性の低い状態からの復帰動作中と判定し、回復動作中を示す指令を出力する（ステップ１３１、１３３、１３６）。
　ＺＭＰ位置７０およびＺＭＰ予測位置７１がともに転倒警告領域Ｎにある場合には作業機械１は転倒の可能性ありと判定し、通常警告指令を行う（ステップ１３１、１３３、１３７）。
　このようにＺＭＰ位置７０に加え、ＺＭＰ予測位置７１を評価指標として用いることにより、現在の操作を継続した場合の安定性の評価ができ、より早い段階での対処が可能となる。また、現在の動作により安定性の回復が見込まれる場合を判定し、警告方法を変更することができ、過度な警報によるオペレータの不快感を低減することができる。
　以上説明した安定性評価手段６０ｎでは、ＺＭＰ位置７０およびＺＭＰ予測位置７１がともに転倒警告領域Ｎにある場合には転倒の可能性ありと判定したが、両者が転倒警告領域Ｎにある場合においてもＺＭＰ予測位置７１の安定性がＺＭＰ位置７０の安定性よりも高い場合には安定性回復動作中と判断し、ＺＭＰ位置７０が転倒警告領域Ｎに、ＺＭＰ予測位置７１が通常領域Ｊにある場合と同様の指令を行うように構成しても良い。これにより、全ての安定性回復動作中において警告方法の変更を行うことができ、過度な警報によるオペレータの不快感を低減することができる。
　＜表示装置＞
　表示手段６１では、第１の実施形態と同様に安定性情報および転倒警告情報の表示を行う。以下では、第１の実施形態との相違点であるＺＭＰ予測位置７１の利用方法についてのみ説明する。図１５（ａ）に示すように表示装置６１ｄの上面図６１ｂ上にＺＭＰ位置７０とＺＭＰ予測位置７１とを異なる色や異なる形状を用いて表示する。また、図１５（ｂ）に示すようにＺＭＰ位置７０からＺＭＰ予測位置７１へ矢印を表示するように構成しても良い。
　転倒警告指令時には第１の実施形態と同様に表示画面の背景色の変更を行う。表示装置６１ｄは少なくとも通常時、予備警告時、回復動作時、通常警告時の４通りの背景色を持ち、表示制御手段６１ｃは安定性演算手段６０ｄからの指令に応じて背景色を変更するように表示装置６１ｄに指令を行う。
　＜警報手段＞
　警報手段６３では、第１の実施形態と同様に安定性演算手段６０ｄからの指令により警告音などの警報を発する。第３の実施形態の警報装置６３ｄは、少なくとも予備警告時と警告時と回復動作時との３通りの警告音を有し、警報制御手段６３ｃは安定性演算手段６０ｄからの警告指令の種類に応じた警告音を発生するように警報装置６３ｄに指令を行う。
　以上では、安定性演算手段６０ｄおよび表示手段６１において現在のＺＭＰ位置７０とＺＭＰ予測位置７１とを用いる例を示したが現在のＺＭＰ位置７０に代えて、ＺＭＰ記憶手段６０ｇに記憶されたＺＭＰ履歴値７２を用いてもよい。ＺＭＰ履歴値７２とＺＭＰ予測値７１とを用いた場合には図１３のフローチャート中のＺＭＰ位置７０をＺＭＰ履歴値７２に置き換えることによって転倒可能性の判定が可能である。
　以上では、ＺＭＰ位置７０として作業機械の質量中心７０ｂを用いる例を示したが、ＺＭＰ７０ａを用いる場合も同様にして予測値を用いた評価を行うことができる。
　＜レバー操作量を用いた予測値算出＞
　以上では、ＺＭＰ予測位置７１を現在のＺＭＰ位置７０および過去のＺＭＰ位置履歴７２から算出する例を示したが、ＺＭＰ予測位置７１を算出する他の方法として作業機械１の各駆動アクチュエータ１１、１３、１５へのオペレータからの入力量（レバー操作量）を検出する方法がある。一般に作業機械では、レバー操作量によって各アクチュエータの速度が決定される。そこで、操作レバー５０にレバー操作量センサ５１を設け、駆動アクチュエータ１１、１３、１５の速度を推定する。アクチュエータ速度をリンク演算により各回転角の角速度へと変換し、現在の姿勢と算出された角速度からｄｔ秒後の質点位置を算出する。式（９）および（１０）に算出された質点位置を代入することによってｄｔ秒後のＺＭＰ予測位置７１を算出することができる。
　この方式を用いる場合にはレバー操作量を検出するレバー操作量センサ５１が必要となるが、オペレータの入力と連動して予測値の算出を行うことが可能であり、警告をオペレータの操作感覚とより良く一致させることができる。
 《第４の実施形態》記録再生
　本発明の第４の実施形態を図１６から図１８を参照して説明する。第４の実施形態は第１の実施形態に加え、さらに作業内容や作業中のＺＭＰ位置を記録し、作業後に再生可能としている。以下では、第１の実施形態との相違点を主に説明する。
　図１６は、第４の実施形態を説明する概略構成図である。第４の実施形態においては第１の実施形態の構成要素に加え、作業内容や作業中のＺＭＰ位置の記録再生を行う記録再生手段６０ｈを有している。
　＜状態量検出手段＞
　第１の実施形態を構成するセンサに加え、作業機械１の各駆動アクチュエータ１１、１３、１５へのオペレータからの入力量を検出するレバー操作量センサ５１を設ける。レバー操作量センサ５１には例えば操作レバー５０の傾きを検出する角度センサや操作レバー５０の内部に設けられた減圧弁によって決定されたパイロット圧を検出する圧力センサを用いる。
　＜記録再生手段＞
　記録再生手段６０ｈは、オペレータが運転時表示と再生時表示との表示切替指令を行う表示切替入力手段５６と、作業内容や作業中のＺＭＰ位置の記録を行う作業記録手段６０ｊと、表示切替入力手段５６からの入力に応じて表示制御手段６１ｃおよび警報制御手段６３ｄに指令を行う表示切替手段６０ｋとから構成される。
　＜作業記録手段＞
　作業記録手段６０ｊでは、所定の期間の作業内容やＺＭＰ位置の記録を行う。記録を保存する期間は、１０分あるいは１日などのあらかじめ設定した時間でも良いし、エンジン始動からエンジン停止までというように決定しても良い。
　作業記録手段６０ｊでは作業内容として、レバー操作量センサ５１の検出値、各回転関節の回転角度、リンク演算手段６０ａにおいて算出されたバケット外力、作業フロントの姿勢から算出される作業半径を記録する。また、安定性情報として、ＺＭＰ算出手段６０ｆにおいて算出されたＺＭＰ位置７０および安定性演算手段６０ｄにおいて算出された安定度αを記録する。警告情報として、警告指令および転倒警告領域Ｎ等の各種設定情報を記録する。警告指令および各種設定情報の記録は作業内容やＺＭＰ位置の記録と同様にあらかじめ定められた期間中常に記録するものとしても良いし、警告指令が発令された前後や設定が変更された前後の期間のみ記録するようにしても良い。記録期間を限定することにより記録するデータ量を削減することができる。
　＜表示切替手段＞
　表示切替手段６０ｋは表示切替入力手段５６からの入力に基づき、運転時表示と再生時表示とのどちらが選択されているかを認識し、表示制御手段６１ｃおよび警報制御手段６３ｄに対し、運転時表示と再生時表示とを切替えるように指令を行う。
　＜表示装置＞
　表示手段６１は、表示切替手段６０ｋからの指令により運転時表示と再生時表示を切替えて表示する。運転時表示については第１の実施形態と同様である。以下では再生時表示について説明する。
　図１７は、再生時の表示の一例である。作業記録手段６０ｊに記録されたＺＭＰ位置７０および安定度αを用いて運転時と同様の安定性情報および転倒警告情報の表示を行う。画面の背景色や警告メッセージは運転時に表示したものと同一とする。このように運転時と同一の表示を行うことによって、運転時にオペレータにどのような情報が提示されていたかを把握することができる。
　再生時においては運転時と同様の安定性情報の表示に加え、オペレータの操作情報と作業環境情報の表示を行う。オペレータの操作情報には作業記録手段６０ｊに記録されたレバー操作量センサ５１の検出値を用いる。図１７は２本のレバーを用いて作業機械１の操作を行う場合の例である。それぞれのレバーについて矢印の方向で操作レバーの入力方向を、矢印の大きさまたは長さで操作量を表す。作業環境情報としてバケット外力、作業半径、路面傾斜などを表示する。
　以上では、レバー操作量および旋回半径の表示をもって作業機械１の動作を表現したが、上面図６１ｂの代わりに作業機械１の概観を示す３次元イラストを表示し、記録された回転角度に基づきイラスト上で実際の動作を再現させるように構成しても良い。
　再生終了時には図１８に示すように作業結果として再生期間におけるＺＭＰ位置履歴７２を表示する。また安定度表示バー６１ｈには再生期間における安定度の平均値を表示する。
　図５に示した運転時では主に安定性情報を表示したのに対し、再生時にはレバー操作量や旋回半径などの付加的な情報を表示することによりオペレータは過去の作業状態を正確に把握することができる。また、作業結果の表示により一連の作業における安定性を評価することができる。
　以上の例においては、再生時表示を運転席４内に設けられた表示装置において行うことを想定して説明した。記録再生手段の他の利用形態として、作業機械１上以外の場所において作業状況の確認を行うケースが考えられる。このような場合は、作業記録手段６０ｊに記録された情報を外部記録媒体や無線等を用いて作業機械１から持ち出し、作業機械１以外の場所に設けられた表示装置において再生するように構成してもよい。
　再生時表示は、事故が発生した場合に発生状況および原因を把握・究明するための利用のほか、操作の安全性評価による作業管理、教育、啓蒙活動などへの利用が考えられる。
　以上説明したように、本発明の安全装置は、作業機械の姿勢を検出する状態量検出手段と、作業機械のＺＭＰ位置を算出するＺＭＰ算出手段と表示装置と備えた制御装置を有し、作業機械の上面図を表示し、前記上面図上に前記作業機械と地表面との接地点が形成する支持多角形と前記ＺＭＰ位置とを表示する。これにより、種々姿勢が変化する作業中においても統一的な指標で安定性を評価することができ、オペレータに具体的な安定性を容易かつ的確に認識させることが可能になる。
　また、本発明の表示装置は、上面図内の走行体と旋回体との間を旋回角度に応じて回転させて表示する。これにより、旋回動作を含む作業中において支持多角形およびＺＭＰ位置と作業フロント方向との関係を認識させることができる。また、走行方向を認識させることが可能になる。
　また、本発明の安全装置は、あらかじめ設定された所定時間分の前記ＺＭＰ位置の履歴を記憶するＺＭＰ記憶手段を有し、ＺＭＰ位置履歴を表示する。これにより、ＺＭＰ位置の変化を認識させることができ、現在の操作による安定性の増減を認識させることが可能になる。
　また、本発明の表示装置は、ＺＭＰ算出手段において算出された現在のＺＭＰ位置とＺＭＰ位置履歴とを互いに異なる形態で表示させる。これにより、過去および現在のＺＭＰ位置の関係をより容易に認識させることが可能になる。
　また、本発明の安全装置は、ＺＭＰ位置の挙動を予測するＺＭＰ予測手段を有し、ＺＭＰ予測手段の算出結果を表示する。これにより、オペレータに現在の操作を継続した場合のＺＭＰ位置を認識させることができ、より早い段階での対処が可能になる。
　また、本発明の表示装置は、ＺＭＰ算出手段において算出された現在のＺＭＰ位置とＺＭＰ予測手段において算出されたＺＭＰ予測位置とを互いに異なる形態で表示させる。これにより、現在および未来のＺＭＰ位置の関係をより容易に認識させることが可能になる。
　また、本発明の安全装置は、作業機械と地表面との接地点が形成する支持多角形の中央部に通常領域を、周辺部に転倒警告領域を設定し、ＺＭＰ位置が転倒警告領域にある場合に警告指令を行う安定性演算手段を有し、表示装置に表示される上面図上に前記転倒警告領域を表示し、安定性演算手段より警告指令が行なわれた場合に警告表示や背景色を変更を行う。これにより、オペレータが表示画面を注視しなくても瞬時に転倒可能性を把握させることが可能になる。
　また、本発明の安定性演算手段は、ＺＭＰ算出手段において算出された現在のＺＭＰ位置とＺＭＰ記憶手段に記憶されたＺＭＰ履歴位置とを用いる。これにより、現在の作業によって安定性が改善しているか否かの評価ができ、過度な警告の回避が可能になる。
　また、本発明の安定性演算手段は、ＺＭＰ算出手段において算出された現在のＺＭＰ位置とＺＭＰ予測手段において算出されたＺＭＰ予測位置とを用いる。これにより、現在の操作を継続した場合の安定性の評価ができ、より早い段階での警告が可能であり、また過度な警告の回避が可能になる。
　また、本発明の安定性演算手段は、支持多角形の中心からＺＭＰ位置までの距離と支持多角形の中心から支持多角形の周辺部までの距離の比率から作業機械の安定度を算出し、表示装置に算出された安定度を表示する。これにより、安定性の増減を容易に認識させることが可能になる。
　また、本発明の安全装置は、作業機械の姿勢変化から現在の作業があらかじめ設定された複数の作業パターンのうちいずれに該当するかを判断する作業内容判定手段を有し、安定性演算手段は前記作業内容判定手段の判定結果をもとに作業パターンごとにあらかじめ設定された転倒警告領域を用いる。これにより、それぞれの作業に即した転倒警告領域を設定することが可能となり、作業効率をより高く保つことが可能になる。
　また、本発明の安全装置は、警報手段を有し、安定性演算手段より警告指令が行なわれた場合に音または音声を出力する。これにより、オペレータが表示装置を見ていない場合においても転倒の可能性を認識させることが可能であり、また、周囲の作業員に転倒の可能性を認識させることが可能である。
　また、本発明の警報手段は、安定性演算手段において算出される安定性に応じて音または音声を変更させる。これにより、オペレータが表示装置を見ていない場合においても安定性を正確に認識させることが可能であり、また、周囲の作業員に安定性を正確に認識させることが可能である。
　また、本発明の安全装置は、駆動アクチュエータへの指令値を検出する検出手段を有し、駆動アクチュエータへの指令値とＺＭＰ位置とを所定の時間分記憶し、作業状況の再生を行う記録再生手段を有し、再生時には指令値を図示し、作業中とは異なる表示を行う。これにより、事故が発生した場合の発生状況および原因の把握、究明や、操作の安全性評価による作業管理、教育、啓蒙活動が可能になる。
　以上説明したように、本発明の実施形態によれば、作業機械の転倒警告領域と現在のＺＭＰ位置とを表示装置の上面図上に表示することによって、種々姿勢が変化する作業中においても統一的な指標で安定性を評価することができ、オペレータに作業機械の安定性を瞬時に容易かつ的確に認識させることができる。
　また、転倒の可能性があると判定された場合には早期に表示や警報による警告を行い、オペレータに注意喚起をすることによってより安全な操作へと導くことができ、安全で作業効率の良い作業が可能になる。
　なお、以上の説明では、ＺＭＰ算出手段において作業機械のＺＭＰを算出する例について説明したが、第２の実施形態として説明したような作業機械の質量中心を算出する場合においても同様な効果を奏するものである。
１　　　作業機械
２　　　走行体
２ａ　　加速度センサ（走行体）
３　　　旋回体
３ａ　　加速度センサ（旋回体）
３ｂ　　姿勢センサ（旋回体）
３ｃ　　中心線
３ｓ　旋回角センサ
４　　　運転室
５　　　エンジン
６　　　作業フロント
７　　　旋回モータ
８　　　カウンタウエイト
１０　　ブーム
１０ａ　加速度センサ（ブーム）
１１　　ブームシリンダ
１１ａ　圧力センサ（ブームボトム）
１１ｂ　圧力センサ（ブームロッド）
１２　　アーム
１２ａ　加速度センサ（アーム）
１３　　アームシリンダ
１５　　作業具シリンダ
１６　　リンク（Ａ）
１７　　リンク（Ｂ）
２３　　バケット
３０　　地表面
４０　　ブーム回動支点
４０ａ　角度センサ（ブーム回動支点）
４１　　アーム回動支点
４１ａ　角度センサ（アーム回動支点）
４２　　バケット回動支点
４２ａ　角度センサ（バケット回動支点）
４３　　ピン（バケット－アーム）
４３ａ　外力センサ（ピン４３）
４４　　ピン（バケット－リンク）
４４ａ　外力センサ（ピン４４）
４９　　状態量検出手段
５０　　操作レバー
５１　　レバー操作量センサ
５５　　ユーザ設定入力手段
５６　　表示切替入力手段
５９　　速度算出手段
６０　　制御装置
６０ａ　リンク演算手段
６０ｂ　ＺＭＰ演算手段
６０ｃ　ＺＭＰ予測手段
６０ｄ　安定性演算手段
６０ｆ　ＺＭＰ算出手段
６０ｇ　ＺＭＰ記憶手段
６０ｈ　記録再生手段
６０ｉ　作業内容判定手段
６０ｊ　作業記録手段
６０ｋ　表示切替手段
６０ｌ　回復動作算出手段
６０ｍ　支持多角形算出手段
６０ｎ　安定性評価手段
６０ｘ　入力部
６０ｙ　出力部
６１　　表示手段
６１ｄ　表示装置
６１ｂ　作業機械上面図
６１ｈ　安定度表示バー
６１ｋ　設定入力アイコン
６１ｍ　警告メッセージ
６１ｘ　簡易表示装置
６２　　駆動アクチュエータ
６３　　警報手段
６３ｄ　警報装置
７０　　ＺＭＰ位置
７０ａ　ＺＭＰ
７０ｂ　質量中心
７１　　ＺＭＰ予測位置
７２　　ＺＭＰ履歴値

Claims (8)

  1. 　走行体、該走行体上に取り付けた作業機械本体、該作業機械本体に対し上下方向に揺動自在に取り付けた作業フロント、およびこれらを制御する制御装置を備えた作業機械の安全装置において、
    　前記制御装置は、前記作業フロントを含む前記本体および走行体の各可動部の位置情報、加速度情報、外力情報をそれぞれ用いてＺＭＰの座標を算出するＺＭＰ算出手段と、
    　前記作業機械の地面との複数の接地点が形成する支持多角形を算出し、前記ＺＭＰが前記支持多角形の周縁の内側に形成した警告領域に含まれるとき転倒警告を発する安定性演算手段とを備え、
    　作業機械の上面図および支持多角形に対する作業機械のＺＭＰ位置を表示する表示装置を備え、
    　前記ＺＭＰ算出手段および安定性演算手段は、前記ＺＭＰ位置、および前記警告領域を含む支持多角形を演算して表示するとともに、
    　前記算出したＺＭＰ位置が前記支持多角形の周縁の内側に形成した警告領域に含まれるとき転倒警告を発することを特徴とする作業機械の安全装置。
  2. 　請求項１記載の作業機械の安全装置において、
    　前記制御装置は、あらかじめ設定された所定期間におけるＺＭＰ位置の履歴を記憶するＺＭＰ記憶手段を有し、前記表示装置によりＺＭＰ位置の履歴を表示することを特徴とする作業機械の安全装置。
  3. 　請求項１記載の作業機械の安全装置において、
    　前記制御装置は、ＺＭＰ位置の挙動を予測するＺＭＰ予測手段を有し、前記ＺＭＰ予測手段の予測結果を前記表示装置に表示することを特徴とする作業機械の安全装置。
  4. 　請求項１記載の作業機械の安全装置において、
    　前記制御装置は、あらかじめ設定された所定期間におけるＺＭＰ位置の履歴を記憶するＺＭＰ記憶手段とＺＭＰ位置の挙動を予測するＺＭＰ予測手段のうち少なくともいずれかを有し、
    　前記安定性演算手段は、前記ＺＭＰ算出手段において算出される現在のＺＭＰ位置に加え、前記ＺＭＰ記憶手段に記憶されたＺＭＰ位置履歴と前記ＺＭＰ予測手段において算出されるＺＭＰ予測位置の少なくともいずれかを用いて安定性の判定を行うことを特徴とする作業機械の安全装置。
  5. 　請求項１記載の作業機械の安全装置において、
    　前記制御装置は、支持多角形に対するＺＭＰ位置に基づいて作業機械の安定度を算出する安定性演算手段を有し、前記表示装置は前記安定性演算手段において算出された安定度を表示することを特徴とする作業機械の安全装置。
  6. 　請求項１記載の作業機械の安全装置において、
    　前記制御装置は、前記安定性演算手段より警告指令が行われた場合に安定性の回復する操作方法を算出する回復動作算出手段を有し、
    　前記表示装置は、前記安定性演算手段より警告指令が行われた場合に前記回復動作算出手段の算出結果を表示することを特徴とする作業機械の安全装置。
  7. 請求項１記載の作業機械の安全装置において、　
    　前記制御装置は、状態量検出手段により検出した駆動アクチュエータへの指令値と前記ＺＭＰ位置とを所定時間につき記憶して作業状況の再生を行う記録再生手段を有し、記録再生手段は、前記作業機械の作業状況の再生時には前記指令値を図示する表示を行うことを特徴とする作業機械の安全装置。
  8. 　請求項１乃至７記載の作業機械の安全装置において、
    　前記制御装置は、前記ＺＭＰ算出手段に代えて、前記作業フロントを含む前記本体および走行体の各可動部の位置情報とあらかじめ与えられた質量情報とから作業機械の質量中心を算出する重心算出手段を有し、各手段はＺＭＰに代えて質量中心を用いることを特徴とする作業機械の安全装置。
PCT/JP2011/061886 2010-05-24 2011-05-24 作業機械の安全装置 WO2011148946A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
KR1020127030464A KR101790150B1 (ko) 2010-05-24 2011-05-24 작업 기계의 안전 장치
US13/699,094 US8768581B2 (en) 2010-05-24 2011-05-24 Work machine safety device
JP2012517279A JP5491627B2 (ja) 2010-05-24 2011-05-24 作業機械の安全装置
EP11786645.9A EP2578757B1 (en) 2010-05-24 2011-05-24 Work machine comprising a safety device
CN201180024959.3A CN102906347B (zh) 2010-05-24 2011-05-24 作业机械的安全装置

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2010-118584 2010-05-24
JP2010118584 2010-05-24

Publications (1)

Publication Number Publication Date
WO2011148946A1 true WO2011148946A1 (ja) 2011-12-01

Family

ID=45003935

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2011/061886 WO2011148946A1 (ja) 2010-05-24 2011-05-24 作業機械の安全装置

Country Status (6)

Country Link
US (1) US8768581B2 (ja)
EP (1) EP2578757B1 (ja)
JP (1) JP5491627B2 (ja)
KR (1) KR101790150B1 (ja)
CN (1) CN102906347B (ja)
WO (1) WO2011148946A1 (ja)

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013073514A (ja) * 2011-09-28 2013-04-22 Sumitomo Heavy Ind Ltd 画像生成方法、画像生成装置、及び操作支援システム
CN103255786A (zh) * 2013-04-09 2013-08-21 常熟建工建设集团有限公司苏州分公司 一种新型单斗液压挖掘机的工作装置
EP2692684A1 (en) * 2012-08-01 2014-02-05 Tadano, Ltd. Working range diagram and working range diagram-display apparatus
EP2733110A1 (de) * 2012-11-16 2014-05-21 Kramer-Werke GmbH Fahrbare Maschine mit Ladenlage, Maschine betriebsfähig in zwei Notsteuermodi
US20150253151A1 (en) * 2012-08-29 2015-09-10 Ponsse Oyj Detector arrangement in connection with a mobile work machine
JP2015189528A (ja) * 2014-03-27 2015-11-02 三菱重工マシナリーテクノロジー株式会社 クレーン運転支援装置、クレーンシステム、クレーン運転支援方法及びプログラム
JP5851037B2 (ja) * 2012-07-20 2016-02-03 日立建機株式会社 作業機械
JP2016196064A (ja) * 2015-04-03 2016-11-24 コーワテック株式会社 遠隔操作ロボット
WO2017170555A1 (ja) * 2016-03-31 2017-10-05 住友重機械工業株式会社 ショベル
JP2018003282A (ja) * 2016-06-27 2018-01-11 住友建機株式会社 ショベルの表示装置
JPWO2016158539A1 (ja) * 2015-03-27 2018-01-25 住友建機株式会社 ショベル
JP2018021416A (ja) * 2016-08-05 2018-02-08 株式会社神戸製鋼所 転倒防止装置
JP2018145753A (ja) * 2017-03-09 2018-09-20 日立建機株式会社 作業機械の操作支援装置
JP2018192891A (ja) * 2017-05-16 2018-12-06 株式会社クボタ 作業機の状態管理システム
WO2019182042A1 (ja) * 2018-03-20 2019-09-26 住友重機械工業株式会社 ショベル、情報処理装置、情報処理方法、プログラム
JP2019183638A (ja) * 2015-03-19 2019-10-24 住友建機株式会社 ショベル及びショベルの表示装置
JP2020033815A (ja) * 2018-08-31 2020-03-05 コベルコ建機株式会社 建設機械
WO2020105614A1 (ja) * 2018-11-19 2020-05-28 住友建機株式会社 ショベル、ショベルの制御装置
JP2020143520A (ja) * 2019-03-07 2020-09-10 コベルコ建機株式会社 遠隔操作システム
WO2021100702A1 (ja) * 2019-11-21 2021-05-27 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
JP2021080788A (ja) * 2019-11-21 2021-05-27 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
JPWO2019244574A1 (ja) * 2018-06-19 2021-06-24 住友建機株式会社 掘削機、情報処理装置
JP2021152275A (ja) * 2020-03-24 2021-09-30 日立建機株式会社 作業機械
WO2021192349A1 (ja) * 2020-03-24 2021-09-30 株式会社日立製作所 情報提示装置、遠隔操作システムおよびプログラム
WO2021246190A1 (ja) * 2020-06-04 2021-12-09 コベルコ建機株式会社 実機状態監視システムおよび実機状態監視方法
WO2022190881A1 (ja) * 2021-03-08 2022-09-15 株式会社小松製作所 転倒評価システム、転倒評価方法及び作業機械
JP7516209B2 (ja) 2020-10-23 2024-07-16 日立建機株式会社 警報制御装置及び警報管理システム

Families Citing this family (49)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CL2012000933A1 (es) 2011-04-14 2014-07-25 Harnischfeger Tech Inc Un metodo y una pala de cable para la generacion de un trayecto ideal, comprende: un motor de oscilacion, un motor de izaje, un motor de avance, un cucharon para excavar y vaciar materiales y, posicionar la pala por medio de la operacion del motor de izaje, el motor de avance y el motor de oscilacion y; un controlador que incluye un modulo generador de un trayecto ideal.
CN103597147B (zh) * 2011-06-10 2016-05-25 日立建机株式会社 作业机械
US9206587B2 (en) 2012-03-16 2015-12-08 Harnischfeger Technologies, Inc. Automated control of dipper swing for a shovel
US9415976B2 (en) * 2012-05-10 2016-08-16 Trimble Navigation Limited Crane collision avoidance
DE102012014655A1 (de) * 2012-07-24 2014-03-06 Bomag Gmbh Bedieneinheit für eine Baumaschine und Verfahren zum Betreiben der Bedieneinheit
US9365398B2 (en) * 2012-10-31 2016-06-14 Manitowoc Crane Companies, Llc Outrigger pad monitoring system
JP6073168B2 (ja) * 2013-03-27 2017-02-01 住友建機株式会社 ショベル
JP6147062B2 (ja) * 2013-04-02 2017-06-14 株式会社タダノ 作業機の作業状態確認装置
US9126482B2 (en) 2013-07-24 2015-09-08 Caterpillar Inc. Attitude display system for remotely operated machine
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
US9593469B2 (en) 2013-12-20 2017-03-14 Cnh Industrial America Llc System and method for controlling a work vehicle based on a monitored tip condition of the vehicle
WO2016038525A1 (en) * 2014-09-11 2016-03-17 Jacques Tranchero Crane for lifting and transporting loads comprising a roll-over protection system
EP3020868B1 (en) * 2014-11-14 2020-11-04 Caterpillar Inc. Machine of a kind comprising a body and an implement movable relative to the body with a system for assisting a user of the machine
EP3021178B1 (en) * 2014-11-14 2020-02-19 Caterpillar Inc. System using radar apparatus for assisting a user of a machine of a kind comprising a body and an implement
CA2943939C (en) * 2015-09-30 2021-10-19 Deere & Company Stability warning and control intervention system for a forestry vehicle
JP6799789B2 (ja) * 2016-06-29 2020-12-16 パナソニックＩｐマネジメント株式会社 歩行支援ロボット及び歩行支援方法
JP6693842B2 (ja) * 2016-09-08 2020-05-13 住友重機械建機クレーン株式会社 クレーン
CN110799711A (zh) * 2016-09-09 2020-02-14 沃尔沃建筑设备公司 用于建筑机械的防翻覆系统和方法
KR102463068B1 (ko) * 2016-09-30 2022-11-02 스미토모 겐키 가부시키가이샤 쇼벨
US10132711B2 (en) * 2016-10-31 2018-11-20 International Business Machines Corporation Static and dynamic stability measurement and optimization system
US10467542B2 (en) 2016-11-22 2019-11-05 International Business Machines Corporation Embedded dynamic stability measurement, optimization and alarm system
US11142442B2 (en) 2017-02-10 2021-10-12 Arrow Acquisition, Llc System and method for dynamically controlling the stability of an industrial vehicle
JP6723184B2 (ja) 2017-03-28 2020-07-15 日立建機株式会社 稼働データ記憶装置
JP6714534B2 (ja) * 2017-03-29 2020-06-24 日立建機株式会社 建設機械
EP3604695B1 (en) * 2017-03-31 2021-07-28 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Shovel with display device and image display method in shovel
EP3680399B1 (en) * 2017-09-07 2023-11-15 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Excavator
US11885221B2 (en) 2018-02-27 2024-01-30 Joy Global Surface Mining Inc Shovel stabilizer appendage
JP6889675B2 (ja) * 2018-03-13 2021-06-18 ヤンマーパワーテクノロジー株式会社 旋回作業車、及び、旋回作業車における施工端部の位置検知方法
JP7127313B2 (ja) * 2018-03-19 2022-08-30 コベルコ建機株式会社 建設機械
JP7119457B2 (ja) 2018-03-19 2022-08-17 コベルコ建機株式会社 建設機械
US11408731B2 (en) * 2018-04-30 2022-08-09 Deere & Company Controlling a machine based on detected machine work cycles
CN112424111B (zh) 2018-07-25 2023-05-09 株式会社多田野 通知装置、作业机、以及通知方法
WO2020049623A1 (ja) * 2018-09-03 2020-03-12 日立建機株式会社 作業機械
DE102018129352A1 (de) * 2018-11-21 2020-05-28 Liebherr-Werk Biberach Gmbh Kran sowie Verfahren zum Überwachen des Betriebs eines solchen Krans
KR102249671B1 (ko) * 2018-12-31 2021-05-10 건설기계부품연구원 작업 차량의 전도/전복 방지 시스템 및 방법
JP7222775B2 (ja) * 2019-03-26 2023-02-15 日立建機株式会社 作業機械
DE102019207164A1 (de) * 2019-05-16 2020-11-19 Robert Bosch Gmbh Verfahren zum Ablegen eines Werkzeugs einer Baumaschine
JP7152370B2 (ja) * 2019-08-26 2022-10-12 日立建機株式会社 現場監視装置および現場監視システム
CN110642150A (zh) * 2019-09-02 2020-01-03 中国一冶集团有限公司 一种履带式起重机安全监控管理系统的功能扩展
US11421402B2 (en) * 2020-02-05 2022-08-23 Caterpillar Paving Products Inc. Operation-based object detection for a work machine
CN111761574B (zh) * 2020-05-28 2022-08-02 中联重科股份有限公司 判断臂架可进行的操作的安全性的方法和装置及工程机械
IT202000019597A1 (it) * 2020-08-07 2022-02-07 Soilmec Spa Macchina per l’esecuzione di scavi, in particolare per la perforazione, e metodo associato a tale macchina.
KR20220030098A (ko) * 2020-09-02 2022-03-10 현대두산인프라코어(주) 자율 작업 굴착기 및 그의 동작 방법
US20220107238A1 (en) * 2020-10-01 2022-04-07 Hyster-Yale Group, Inc. Dynamic load center-of-gravity detection
DE102020213674A1 (de) * 2020-10-30 2022-05-05 Zf Friedrichshafen Ag Verfahren und Steuereinrichtung zum Betreiben einer selbstfahrenden Arbeitsmaschine
JP7089569B2 (ja) * 2020-11-06 2022-06-22 日立建機株式会社 施工支援システム
GB2614737A (en) * 2022-01-17 2023-07-19 Bamford Excavators Ltd A Working Machine
JP2023169512A (ja) * 2022-05-17 2023-11-30 キヤノン株式会社 監視システム、監視システムの制御方法およびプログラム
GB2626379A (en) * 2023-01-23 2024-07-24 Bamford Excavators Ltd A Working Machine

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61287696A (ja) 1985-06-12 1986-12-18 株式会社日立製作所 クロ−ラクレ−ン転倒防止警告装置
JPH07247578A (ja) * 1990-12-03 1995-09-26 Yutani Heavy Ind Ltd 解体作業機の安全装置
JPH10291779A (ja) 1997-04-18 1998-11-04 Kensetsusho Kanto Chiho Kensetsu Kyokucho クレーンの転倒防止装置および方法
JP2006150567A (ja) * 2004-12-01 2006-06-15 Toyota Motor Corp ロボットの安定化制御装置
JP2008012642A (ja) * 2006-07-07 2008-01-24 Fujitsu Ltd 移動型ロボット

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4284987A (en) * 1979-09-07 1981-08-18 The United States Of America As Represented By The Secretary Of Agriculture Slope stability warning device for articulated tractors
GB8612424D0 (en) * 1986-05-22 1986-07-02 Arcubos Systems Ltd Weight sensing device
US5160055A (en) * 1991-10-02 1992-11-03 Jlg Industries, Inc. Load moment indicator system
US6437701B1 (en) * 2000-12-18 2002-08-20 Caterpillar Inc. Apparatus and method for a machine stability system for an articulated work machine
US6985795B2 (en) * 2001-09-21 2006-01-10 Schlage Lock Company Material handler with center of gravity monitoring system
US6991119B2 (en) * 2002-03-18 2006-01-31 Jlg Industries, Inc. Measurement system and method for assessing lift vehicle stability
KR100621979B1 (ko) * 2004-03-22 2006-09-14 볼보 컨스트럭션 이키프먼트 홀딩 스웨덴 에이비 조작레버 오작동 방지 시스템
KR20080069599A (ko) * 2005-10-18 2008-07-28 푸츠마이스터 콘크리트 펌프스 게엠베하 특히 대형 매니플레이터와 이동식 콘크리트 펌프용 작동 붐
US8086370B2 (en) * 2007-10-05 2011-12-27 Nacco Load controlled stabilizer system
TW200943565A (en) * 2008-04-21 2009-10-16 Angelantoni Ind Spa Concentration photovoltaic system and concentration method thereof
GB2471134B (en) * 2009-06-19 2012-10-10 Bamford Excavators Ltd Speed sensitive longitudinal load moment control of a working machine
CN102575457B (zh) * 2009-10-19 2014-12-17 日立建机株式会社 作业机械

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61287696A (ja) 1985-06-12 1986-12-18 株式会社日立製作所 クロ−ラクレ−ン転倒防止警告装置
JPH07247578A (ja) * 1990-12-03 1995-09-26 Yutani Heavy Ind Ltd 解体作業機の安全装置
JPH10291779A (ja) 1997-04-18 1998-11-04 Kensetsusho Kanto Chiho Kensetsu Kyokucho クレーンの転倒防止装置および方法
JP2006150567A (ja) * 2004-12-01 2006-06-15 Toyota Motor Corp ロボットの安定化制御装置
JP2008012642A (ja) * 2006-07-07 2008-01-24 Fujitsu Ltd 移動型ロボット

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
YOSHIKAWA, TSUNEO: "Japanese", 1988, CORONA PUBLISHING CO., LTD., article "Robotto Seigyo Kisoron (Fundamentals of Robot Control"

Cited By (51)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013073514A (ja) * 2011-09-28 2013-04-22 Sumitomo Heavy Ind Ltd 画像生成方法、画像生成装置、及び操作支援システム
JP5851037B2 (ja) * 2012-07-20 2016-02-03 日立建機株式会社 作業機械
EP2692684A1 (en) * 2012-08-01 2014-02-05 Tadano, Ltd. Working range diagram and working range diagram-display apparatus
CN103569915A (zh) * 2012-08-01 2014-02-12 株式会社多田野 作业范围图显示装置及作业范围图显示方法
US20150253151A1 (en) * 2012-08-29 2015-09-10 Ponsse Oyj Detector arrangement in connection with a mobile work machine
EP2733110A1 (de) * 2012-11-16 2014-05-21 Kramer-Werke GmbH Fahrbare Maschine mit Ladenlage, Maschine betriebsfähig in zwei Notsteuermodi
CN103255786A (zh) * 2013-04-09 2013-08-21 常熟建工建设集团有限公司苏州分公司 一种新型单斗液压挖掘机的工作装置
JP2015189528A (ja) * 2014-03-27 2015-11-02 三菱重工マシナリーテクノロジー株式会社 クレーン運転支援装置、クレーンシステム、クレーン運転支援方法及びプログラム
JP2019183638A (ja) * 2015-03-19 2019-10-24 住友建機株式会社 ショベル及びショベルの表示装置
JPWO2016158539A1 (ja) * 2015-03-27 2018-01-25 住友建機株式会社 ショベル
US10280597B2 (en) 2015-03-27 2019-05-07 Sumitomo(S.H.I)Construction Machinery Co., Ltd. Shovel
JP2016196064A (ja) * 2015-04-03 2016-11-24 コーワテック株式会社 遠隔操作ロボット
JPWO2017170555A1 (ja) * 2016-03-31 2019-02-07 住友重機械工業株式会社 ショベル
US10858808B2 (en) 2016-03-31 2020-12-08 Sumitomo Heavy Industries, Ltd. Excavator
WO2017170555A1 (ja) * 2016-03-31 2017-10-05 住友重機械工業株式会社 ショベル
JP2018003282A (ja) * 2016-06-27 2018-01-11 住友建機株式会社 ショベルの表示装置
JP2018021416A (ja) * 2016-08-05 2018-02-08 株式会社神戸製鋼所 転倒防止装置
JP2018145753A (ja) * 2017-03-09 2018-09-20 日立建機株式会社 作業機械の操作支援装置
JP2018192891A (ja) * 2017-05-16 2018-12-06 株式会社クボタ 作業機の状態管理システム
CN111919001A (zh) * 2018-03-20 2020-11-10 住友重机械工业株式会社 挖土机、信息处理装置、信息处理方法、程序
JPWO2019182042A1 (ja) * 2018-03-20 2021-03-11 住友重機械工業株式会社 ショベル、情報処理装置、情報処理方法、プログラム
US11913193B2 (en) 2018-03-20 2024-02-27 Sumitomo Heavy Industries, Ltd. Shovel, information processing device, information processing method, and non-transitory storage medium
WO2019182042A1 (ja) * 2018-03-20 2019-09-26 住友重機械工業株式会社 ショベル、情報処理装置、情報処理方法、プログラム
JPWO2019244574A1 (ja) * 2018-06-19 2021-06-24 住友建機株式会社 掘削機、情報処理装置
JP7358349B2 (ja) 2018-06-19 2023-10-10 住友建機株式会社 掘削機、情報処理装置
WO2020045579A1 (ja) * 2018-08-31 2020-03-05 コベルコ建機株式会社 建設機械
JP2020033815A (ja) * 2018-08-31 2020-03-05 コベルコ建機株式会社 建設機械
JP7146530B2 (ja) 2018-08-31 2022-10-04 コベルコ建機株式会社 建設機械
US11391016B2 (en) 2018-08-31 2022-07-19 Kobelco Construction Machinery Co., Ltd. Construction machine
JP7463291B2 (ja) 2018-11-19 2024-04-08 住友建機株式会社 ショベル、ショベルの制御装置、作業現場の管理方法
KR102708735B1 (ko) 2018-11-19 2024-09-20 스미토모 겐키 가부시키가이샤 쇼벨, 쇼벨의 제어장치
JPWO2020105614A1 (ja) * 2018-11-19 2021-11-04 住友建機株式会社 ショベル、ショベルの制御装置
WO2020105614A1 (ja) * 2018-11-19 2020-05-28 住友建機株式会社 ショベル、ショベルの制御装置
KR20210104669A (ko) * 2018-11-19 2021-08-25 스미토모 겐키 가부시키가이샤 쇼벨, 쇼벨의 제어장치
JP7225935B2 (ja) 2019-03-07 2023-02-21 コベルコ建機株式会社 遠隔操作システム
JP2020143520A (ja) * 2019-03-07 2020-09-10 コベルコ建機株式会社 遠隔操作システム
JP7264794B2 (ja) 2019-11-21 2023-04-25 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
WO2021100702A1 (ja) * 2019-11-21 2021-05-27 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
JP2021080786A (ja) * 2019-11-21 2021-05-27 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
JP2021080788A (ja) * 2019-11-21 2021-05-27 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
JP7264796B2 (ja) 2019-11-21 2023-04-25 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
WO2021100762A1 (ja) * 2019-11-21 2021-05-27 株式会社小松製作所 転倒リスク提示装置および転倒リスク提示方法
JP2021152275A (ja) * 2020-03-24 2021-09-30 日立建機株式会社 作業機械
JP7195289B2 (ja) 2020-03-24 2022-12-23 日立建機株式会社 作業機械
WO2021192349A1 (ja) * 2020-03-24 2021-09-30 株式会社日立製作所 情報提示装置、遠隔操作システムおよびプログラム
WO2021246190A1 (ja) * 2020-06-04 2021-12-09 コベルコ建機株式会社 実機状態監視システムおよび実機状態監視方法
JP7441733B2 (ja) 2020-06-04 2024-03-01 コベルコ建機株式会社 実機状態監視システムおよび実機状態監視方法
JP2021188469A (ja) * 2020-06-04 2021-12-13 コベルコ建機株式会社 実機状態監視システムおよび実機状態監視方法
JP7516209B2 (ja) 2020-10-23 2024-07-16 日立建機株式会社 警報制御装置及び警報管理システム
KR20230139435A (ko) 2021-03-08 2023-10-05 가부시키가이샤 고마쓰 세이사쿠쇼 전도 평가 시스템, 전도 평가 방법 및 작업 기계
WO2022190881A1 (ja) * 2021-03-08 2022-09-15 株式会社小松製作所 転倒評価システム、転倒評価方法及び作業機械

Also Published As

Publication number Publication date
EP2578757B1 (en) 2019-05-08
KR20130090763A (ko) 2013-08-14
JPWO2011148946A1 (ja) 2013-07-25
US20130066527A1 (en) 2013-03-14
CN102906347A (zh) 2013-01-30
US8768581B2 (en) 2014-07-01
KR101790150B1 (ko) 2017-10-25
JP5491627B2 (ja) 2014-05-14
EP2578757A1 (en) 2013-04-10
EP2578757A4 (en) 2017-04-05
CN102906347B (zh) 2015-04-22

Similar Documents

Publication Publication Date Title
JP5491627B2 (ja) 作業機械の安全装置
KR101755739B1 (ko) 작업 기계
KR101934017B1 (ko) 작업 기계
US11149404B2 (en) Work machine
CN201040850Y (zh) 液压挖掘机防倾翻装置
CN104487635A (zh) 作业机械
JP6877385B2 (ja) 作業機械
JP7022018B2 (ja) 作業機械
KR101776819B1 (ko) 굴삭기 전도 상태 판별 방법
WO2023143138A1 (zh) 作业机械遥控端力反馈控制方法、装置及系统
JPH07247578A (ja) 解体作業機の安全装置
JP7260502B2 (ja) 情報提示装置、遠隔操作システムおよびプログラム
US20240151007A1 (en) Fall evaluation system, fall evaluation method, and work machine
JPH11190042A (ja) 自動運転ショベル
WO2020044777A1 (ja) 建設機械
JP2012062681A (ja) 油圧ショベルの制御装置

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 201180024959.3

Country of ref document: CN

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

Ref document number: 11786645

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2012517279

Country of ref document: JP

WWE Wipo information: entry into national phase

Ref document number: 13699094

Country of ref document: US

ENP Entry into the national phase

Ref document number: 20127030464

Country of ref document: KR

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 2011786645

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE