JP2017194381A - Inclination detector of construction machine - Google Patents
Inclination detector of construction machine Download PDFInfo
- Publication number
- JP2017194381A JP2017194381A JP2016085459A JP2016085459A JP2017194381A JP 2017194381 A JP2017194381 A JP 2017194381A JP 2016085459 A JP2016085459 A JP 2016085459A JP 2016085459 A JP2016085459 A JP 2016085459A JP 2017194381 A JP2017194381 A JP 2017194381A
- Authority
- JP
- Japan
- Prior art keywords
- inclination
- traveling body
- level
- processor
- respect
- Prior art date
- Legal status (The legal status 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 status listed.)
- Granted
Links
- 238000010276 construction Methods 0.000 title claims abstract description 15
- 238000001514 detection method Methods 0.000 claims abstract description 51
- 238000006073 displacement reaction Methods 0.000 abstract 3
- 238000010586 diagram Methods 0.000 description 8
- 238000000034 method Methods 0.000 description 8
- 230000001133 acceleration Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 1
Landscapes
- Component Parts Of Construction Machinery (AREA)
Abstract
Description
本発明は、建設機械において走行体の傾斜を検出する傾斜検出装置に関する。 The present invention relates to an inclination detection device that detects an inclination of a traveling body in a construction machine.
特許文献１では、建設機械である油圧ショベルにおいて、水準器が取付けられている。水準器の水平面に対する傾斜に基づいて、作業者は、走行体の水平面に対する傾斜を把握する。 In Patent Document 1, a level is attached to a hydraulic excavator that is a construction machine. Based on the inclination of the level with respect to the horizontal plane, the operator grasps the inclination of the traveling body with respect to the horizontal plane.
前記特許文献１のように水準器が設けられる建設機械では、水準器の取付け状態によっては、水準器の水平面に対する傾斜と走行体の水平面に対する傾斜との間にずれが発生することがある。この場合、走行体が水平に配置されても、水準器は水平面に対して傾斜した状態となり、走行体の傾斜が適切に把握されない。別の水準器を用いていわゆる零点調整を行うことにより、建設機械に取付けられる水準器の傾斜と走行体の傾斜との間のずれを手動で修正し、水準器の傾斜と走行体の傾斜とを合わせることは可能である。しかし、別の水準器を用いたずれの修正には、手間を要する。 In a construction machine in which a level is provided as in Patent Document 1, a deviation may occur between the inclination of the level with respect to the horizontal plane and the inclination of the traveling body with respect to the horizontal plane depending on the mounting state of the level. In this case, even if the traveling body is arranged horizontally, the level is inclined with respect to the horizontal plane, and the inclination of the traveling body is not properly grasped. By making a so-called zero adjustment using another level, manually correct the difference between the level of the level attached to the construction machine and the level of the traveling body, It is possible to match. However, it takes time to correct the deviation using another level.
本発明は前記課題を解決するためになされたものであり、その目的とするところは、水準器の傾斜と走行体の傾斜との間にずれが発生しても、別の水準器を用いた調整を行うことなく、走行体の水平面に対する傾斜が適切に検出される建設機械の傾斜検出装置を提供することにある。 The present invention has been made to solve the above-mentioned problems, and the object of the present invention is to use another level even if a deviation occurs between the inclination of the level and the inclination of the traveling body. An object of the present invention is to provide a construction machine inclination detection device that appropriately detects the inclination of a traveling body with respect to a horizontal plane without adjustment.
前記目的を達成するため、本発明のある態様の建設機械の傾斜検出装置は、走行体と、 前記走行体上に設けられ、前記走行体に対して旋回可能な旋回体と、前記旋回体に取付けられるとともに、前記旋回体と一緒に旋回する水準器と、前記旋回体及び前記水準器が旋回している状態において水平面に対する前記水準器の傾斜を検出するとともに、前記水準器の前記傾斜の検出結果に基づいて前記走行体の前記水平面に対する傾斜と前記水準器の前記傾斜との間のずれを検出し、検出された前記ずれに基づいて前記走行体の前記傾斜を検出するプロセッサと、を備える。 In order to achieve the object, an inclination detection device for a construction machine according to an aspect of the present invention includes a traveling body, a revolving body that is provided on the traveling body and is capable of turning with respect to the traveling body, and the revolving body. A level that is attached and swivels together with the swivel body, and detects the inclination of the level relative to a horizontal plane in a state where the swivel body and the spirit level are swiveling, and the inclination detection of the level A processor that detects a deviation between the inclination of the traveling body with respect to the horizontal plane and the inclination of the spirit level based on the result, and detects the inclination of the traveling body based on the detected deviation. .
本発明によれば、水準器の傾斜と走行体の傾斜との間にずれが発生しても、別の水準器を用いた調整を行うことなく、走行体の水平面に対する傾斜が適切に検出される建設機械の傾斜検出装置を提供することができる。 According to the present invention, even if a deviation occurs between the inclination of the level and the inclination of the traveling body, the inclination of the traveling body with respect to the horizontal plane is appropriately detected without performing adjustment using another level. It is possible to provide a construction machine inclination detecting apparatus.
（第１の実施形態）
本発明の第１の実施形態について図１乃至図８を参照して説明する。図１は、本実施形態の建設機械であるクレーン１を示す図である。図１に示すように、クレーン１は、走行体２と、走行体２上に設けられる旋回体３と、を備える。旋回体３は、走行体２に対して旋回可能である。旋回体３が走行体２に対して旋回することにより、旋回体３の走行体２に対する旋回角度が変化する。旋回体３は、旋回フレーム５と、旋回フレーム５上に取付けられるブーム支持フレーム６と、ブーム支持フレーム６に一端が取付けられるブーム７と、を備える。作業時においては、ブーム７を作動することにより、ブーム７が起伏する。また、旋回体３は、運転室（キャブ）８を備える。
(First embodiment)
A first embodiment of the present invention will be described with reference to FIGS. FIG. 1 is a diagram illustrating a crane 1 which is a construction machine according to the present embodiment. As shown in FIG. 1, the crane 1 includes a traveling body 2 and a revolving body 3 provided on the traveling body 2. The turning body 3 can turn with respect to the traveling body 2. When the turning body 3 turns with respect to the traveling body 2, the turning angle of the turning body 3 with respect to the traveling body 2 changes. The revolving structure 3 includes a revolving frame 5, a boom support frame 6 attached on the revolving frame 5, and a boom 7 having one end attached to the boom support frame 6. During work, the boom 7 is raised and lowered by operating the boom 7. Further, the revolving structure 3 includes a cab 8.
図２は、旋回体３の旋回角度の変化を説明する図である。図２では、矢印Ｐ１側が走行体２の前方側であり、矢印Ｐ２側が走行体２の後方側である。また、矢印Ｗ１側が走行体２の右側（幅方向の一方側）であり、矢印Ｗ２側が走行体２の左側（幅方向の他方側）である。そして、矢印Ｐ´１側が旋回体３の前方側であり、矢印Ｐ´２側が旋回体３の後方側である。また、矢印Ｗ´１側が旋回体３の右側（幅方向の一方側）であり、矢印Ｗ´２側が旋回体３の左側（幅方向の他方側）である。図２に示すように、旋回体３の前方側が走行体２の前方側と略一致する旋回角度から、旋回体３を鉛直上側から視て時計回りに略９０°旋回させると、旋回体３の前方側が走行体２の右側と略一致する旋回角度となる。この状態から、旋回体３を鉛直上側から視て時計回りに略９０°旋回させると、旋回体３の前方側が走行体２の後方側と略一致する旋回角度となる。そして、この状態から旋回体３を鉛直上側から視て時計回りに略９０°旋回させると、旋回体３の前方側が走行体２の左側と略一致する旋回角度となる。さらに、この状態から旋回体３を鉛直上側から視て時計回りに略９０°旋回させると、旋回体３の前方側が走行体２の前方側と略一致する旋回角度に戻る。 FIG. 2 is a diagram for explaining a change in the turning angle of the revolving structure 3. In FIG. 2, the arrow P <b> 1 side is the front side of the traveling body 2, and the arrow P <b> 2 side is the rear side of the traveling body 2. The arrow W1 side is the right side (one side in the width direction) of the traveling body 2, and the arrow W2 side is the left side (the other side in the width direction) of the traveling body 2. The arrow P′1 side is the front side of the swing body 3, and the arrow P′2 side is the rear side of the swing body 3. Further, the arrow W′1 side is the right side (one side in the width direction) of the swing body 3, and the arrow W′2 side is the left side (the other side in the width direction) of the swing body 3. As shown in FIG. 2, when the turning body 3 is turned approximately 90 ° clockwise as viewed from the vertical upper side from the turning angle at which the front side of the turning body 3 substantially coincides with the front side of the traveling body 2, The front side is a turning angle that substantially coincides with the right side of the traveling body 2. From this state, when the revolving unit 3 is turned about 90 ° clockwise as viewed from the vertical upper side, the turning angle at which the front side of the revolving unit 3 substantially coincides with the rear side of the traveling unit 2 is obtained. Then, when the revolving unit 3 is rotated approximately 90 ° clockwise as viewed from the vertical upper side from this state, the turning angle at which the front side of the revolving unit 3 substantially coincides with the left side of the traveling unit 2 is obtained. Further, when the revolving unit 3 is swung clockwise by about 90 ° as viewed from the vertically upper side from this state, the front side of the revolving unit 3 returns to a turning angle that substantially coincides with the front side of the traveling unit 2.
図１及び図２に示すように、旋回体３には、水準器（電子水準器）１０が取付けられている。水準器１０は、旋回フレーム５上に設置される。水準器１０は、例えば、加速度センサを備え、重力加速度を検知する。水準器１０は、旋回体３と一緒に走行体２に対して旋回する。水準器１０は、互いに対して垂直な第１の基準軸Ｃ１及び第２の基準軸Ｃ２を有する。ここで、鉛直方向に垂直な水平面を規定すると、水準器１０が水平面に対して傾斜していない状態では、第１の基準軸Ｃ１及び第２の基準軸Ｃ２は、水平面に対して平行である。旋回体３が旋回することにより、基準軸Ｃ１，Ｃ２も、走行体２に対して旋回する。また、本実施形態では、第１の基準軸Ｃ１は、旋回体３の前後方向（矢印Ｐ´１及び矢印Ｐ´２で示す方向）に対して略平行であり、第２の基準軸Ｃ２は、旋回体３の左右方向（矢印Ｗ´１及び矢印Ｗ´２で示す方向）に対して略平行である。なお、ある変形例では、基準軸Ｃ１が、旋回体３の左右方向に対して略平行であり、第２の基準軸Ｃ２が旋回体３の前後方向に対して略平行であってもよい。また、水準器１０が水平面に対して傾斜していない状態において基準軸Ｃ１，Ｃ２が水平面に対して平行であり、かつ、基準軸Ｃ１，Ｃ２が互いに対して垂直であれば、基準軸Ｃ１，Ｃ２は、旋回体３の前後方向及び左右方向に対して平行でなくてもよい。 As shown in FIGS. 1 and 2, a level (electronic level) 10 is attached to the swivel body 3. The level 10 is installed on the swivel frame 5. The level 10 includes, for example, an acceleration sensor and detects gravitational acceleration. The level 10 turns with respect to the traveling body 2 together with the turning body 3. The level 10 has a first reference axis C1 and a second reference axis C2 that are perpendicular to each other. Here, when a horizontal plane perpendicular to the vertical direction is defined, the first reference axis C1 and the second reference axis C2 are parallel to the horizontal plane when the level 10 is not inclined with respect to the horizontal plane. . When the revolving unit 3 revolves, the reference axes C1 and C2 also revolve with respect to the traveling unit 2. In the present embodiment, the first reference axis C1 is substantially parallel to the front-rear direction of the revolving structure 3 (directions indicated by arrows P′1 and P′2), and the second reference axis C2 is , Which is substantially parallel to the left-right direction of the revolving structure 3 (directions indicated by arrows W′1 and W′2). In a modification, the reference axis C <b> 1 may be substantially parallel to the left-right direction of the revolving structure 3, and the second reference axis C <b> 2 may be substantially parallel to the front-rear direction of the revolving structure 3. In addition, when the level 10 is not inclined with respect to the horizontal plane, the reference axes C1, C2 are parallel to the horizontal plane and the reference axes C1, C2 are perpendicular to each other. C2 may not be parallel to the front-rear direction and the left-right direction of the revolving unit 3.
クレーン１には、水準器１０を用いて走行体２（クレーン１）の水平面に対する傾斜を検出する傾斜検出装置９が設けられる。図３は、傾斜検出装置９の構成を示す図である。図３に示すように、傾斜検出装置９は、前述の水準器１０と、プロセッサ（制御部）１１と、記憶媒体１２と、を備える。プロセッサ１１は、ＣＰＵ（Central Processing Unit）、ＡＳＩＣ（Application specific integrated circuit）又はＦＰＧＡ（Field Programmable Gate Array）等を備える集積回路等であり、１つの集積回路から形成されてもよく、複数の集積回路から形成されてもよい。プロセッサ１１は、記憶媒体１２に記憶される情報を読取るとともに、演算処理、制御等を行う。プロセッサ１１は、水準器１０で検知された重力加速度等の傾斜に関するパラメータに基づいて、水平面に対する水準器１０の傾斜を検出する。 The crane 1 is provided with an inclination detection device 9 that detects an inclination of the traveling body 2 (crane 1) with respect to a horizontal plane using a level 10. FIG. 3 is a diagram illustrating a configuration of the tilt detection device 9. As shown in FIG. 3, the inclination detection device 9 includes the above-described level 10, a processor (control unit) 11, and a storage medium 12. The processor 11 is an integrated circuit or the like including a CPU (Central Processing Unit), an ASIC (Application Specific Integrated Circuit), or an FPGA (Field Programmable Gate Array), and may be formed from a single integrated circuit. May be formed. The processor 11 reads information stored in the storage medium 12 and performs arithmetic processing, control, and the like. The processor 11 detects the inclination of the level 10 with respect to the horizontal plane based on parameters relating to the inclination such as gravitational acceleration detected by the level 10.
クレーン１の運転室８には、旋回操作入力部として旋回レバー１３が設けられている。また、クレーン１には、旋回体３のアクチュエータである旋回モータ１５、及び、旋回モータ１５の駆動状態を検出するエンコーダ１６が設けられている。プロセッサ１１は、旋回レバー１３での操作に基づいて、旋回モータ１５への油の供給を制御し、旋回モータ１５の駆動を制御する。旋回モータ１５の駆動が制御されることにより、旋回体３の旋回速度等が調整され、旋回体３の旋回動作が制御される。また、プロセッサ１１は、エンコーダ１６によって検出される旋回モータ１５の駆動状態に基づいて、旋回体３の走行体２に対する旋回角度を検出する。 The cab 8 of the crane 1 is provided with a turning lever 13 as a turning operation input unit. In addition, the crane 1 is provided with a swing motor 15 that is an actuator of the swing body 3 and an encoder 16 that detects a drive state of the swing motor 15. The processor 11 controls the supply of oil to the turning motor 15 based on the operation with the turning lever 13 and controls the driving of the turning motor 15. By controlling the drive of the turning motor 15, the turning speed of the turning body 3 is adjusted, and the turning operation of the turning body 3 is controlled. Further, the processor 11 detects the turning angle of the turning body 3 with respect to the traveling body 2 based on the driving state of the turning motor 15 detected by the encoder 16.
運転室８には、傾斜検出操作部である傾斜検出操作ボタン２１、及び、ずれ検出操作部であるずれ検出操作ボタン２２が設けられている。プロセッサ１１は、傾斜検出操作ボタン２１で操作入力が行われると、水準器１０の水平面に対する傾斜の検出結果に基づいて、走行体２（クレーン１）の水平面に対する傾斜を検出する。また、プロセッサ１１は、ずれ検出操作ボタン２２で操作入力が行われると、水準器１０の水平面に対する傾斜の検出結果に基づいて、水準器１０の傾斜と走行体２の傾斜との間のずれを検出する。この際、旋回体３が一定の旋回速度で旋回している状態でのみ、ずれの検出が行われる。そして、プロセッサ１１は、検出した水準器１０の傾斜と走行体２の傾斜との間のずれに基づいて、走行体２の水平面に対する傾斜を検出する。なお、検出した水準器１０の傾斜と走行体２の傾斜との間のずれは、記憶媒体１２等に記憶される。傾斜検出操作ボタン２１での操作入力に基づいて走行体２の傾斜を検出する際には、プロセッサ１１は、記憶された水準器１０の傾斜と走行体２の傾斜との間のずれに基づいて、走行体２の傾斜の検出を行う。また、運転室８には、走行体２の水平面に対する傾斜を告知する表示画面等の告知部２３が設けられる。 The cab 8 is provided with an inclination detection operation button 21 that is an inclination detection operation section and a deviation detection operation button 22 that is a deviation detection operation section. When an operation input is performed with the inclination detection operation button 21, the processor 11 detects the inclination of the traveling body 2 (crane 1) with respect to the horizontal plane based on the detection result of the inclination of the level 10 with respect to the horizontal plane. Further, when an operation input is performed with the deviation detection operation button 22, the processor 11 detects a deviation between the inclination of the level 10 and the inclination of the traveling body 2 based on the detection result of the inclination of the level 10 with respect to the horizontal plane. To detect. At this time, the deviation is detected only when the revolving structure 3 is revolving at a constant revolving speed. Then, the processor 11 detects the inclination of the traveling body 2 with respect to the horizontal plane based on the detected deviation between the inclination of the level 10 and the inclination of the traveling body 2. The detected deviation between the inclination of the level 10 and the inclination of the traveling body 2 is stored in the storage medium 12 or the like. When detecting the inclination of the traveling body 2 based on the operation input with the inclination detection operation button 21, the processor 11 is based on the stored difference between the inclination of the level 10 and the inclination of the traveling body 2. The inclination of the traveling body 2 is detected. The cab 8 is provided with a notification unit 23 such as a display screen for notifying the inclination of the traveling body 2 with respect to the horizontal plane.
次に、本実施形態のクレーン１及び傾斜検出装置９の作用及び効果を説明する。クレーン１において、走行体２の水平面に対する傾斜を検出する際には、傾斜検出操作ボタン２１で操作入力を行う。また、水準器１０の水平面に対する傾斜と走行体２の水平面に対する傾斜との間のずれの検出、及び、走行体２の傾斜の検出の両方を行う場合には、ずれ検出操作ボタン２２で操作入力を行う。 Next, operations and effects of the crane 1 and the inclination detection device 9 of the present embodiment will be described. In the crane 1, when the inclination of the traveling body 2 with respect to the horizontal plane is detected, an operation input is performed with the inclination detection operation button 21. Further, when both the detection of the deviation between the inclination of the level 10 with respect to the horizontal plane and the inclination of the traveling body 2 with respect to the horizontal plane and the detection of the inclination of the traveling body 2 are performed, an operation input is performed with the deviation detection operation button 22. I do.
図４は、水準器１０の傾斜と走行体２の傾斜との間のずれの検出及び走行体２の傾斜の検出を行う際の、プロセッサ１１での処理を示すフローチャートである。図４に示すように、水準器１０の傾斜と走行体２の傾斜との間のずれを検出する際には、プロセッサ１１は、ずれ検出操作ボタン（ずれ検出操作部）２２で操作入力が行われたか否か（すなわち、操作入力がＯＮかＯＦＦか）を判断する（ステップＳ１０１）。操作入力が行われていない場合は（ステップＳ１０１−Ｎｏ）、処理は、ステップＳ１０１に戻る。すなわち、プロセッサ１１は、ずれ検出操作ボタン２２で操作入力が行われるまで、待機する。操作入力が行われると（ステップＳ１０１−Ｙｅｓ）、プロセッサ１１は、エンコーダ１６での旋回モータ１５の駆動状態の検出結果に基づいて、旋回体３が旋回しているか否かを判断する（ステップＳ１０２）。旋回体３が旋回していない場合は（ステップＳ１０２−Ｎｏ）、処理は、ステップＳ１０２に戻る。旋回体３が旋回している場合は（ステップＳ１０２−Ｙｅｓ）、プロセッサ１１は、エンコーダ１６での検出結果に基づいて、旋回体３の旋回速度が一定であるか否か（すなわち、旋回速度が安定しているか否か）を判断する（ステップＳ１０３）。旋回速度が一定でない場合は（ステップＳ１０３−Ｎｏ）、処理は、ステップＳ１０３に戻る。すなわち、プロセッサ１１は、旋回体３の旋回速度が一定になるまで、待機する。 FIG. 4 is a flowchart showing processing in the processor 11 when detecting the deviation between the inclination of the level 10 and the inclination of the traveling body 2 and detecting the inclination of the traveling body 2. As shown in FIG. 4, when detecting a deviation between the inclination of the level 10 and the inclination of the traveling body 2, the processor 11 performs an operation input with a deviation detection operation button (a deviation detection operation unit) 22. It is determined whether or not (i.e., whether the operation input is ON or OFF) (step S101). If no operation input has been made (step S101—No), the process returns to step S101. That is, the processor 11 stands by until an operation input is performed with the deviation detection operation button 22. When the operation input is performed (step S101-Yes), the processor 11 determines whether or not the revolving structure 3 is turning based on the detection result of the driving state of the turning motor 15 by the encoder 16 (step S102). ). When the revolving structure 3 is not turning (No at Step S102), the process returns to Step S102. When the turning body 3 is turning (step S102-Yes), the processor 11 determines whether or not the turning speed of the turning body 3 is constant based on the detection result of the encoder 16 (that is, the turning speed is It is determined whether or not it is stable (step S103). If the turning speed is not constant (step S103-No), the process returns to step S103. That is, the processor 11 stands by until the turning speed of the turning body 3 becomes constant.
旋回速度が一定である場合は（ステップＳ１０３−Ｙｅｓ）、プロセッサ１１は、水準器１０によって検知される重力加速度に基づいて、水準器１０（水準器１０が設置される部位）の水平面に対する傾斜を検出する（ステップＳ１０４）。水準器１０の傾斜は、旋回体３の複数の（好ましくは３つ以上の）旋回角度のそれぞれにおいて、検出される。すなわち、旋回体３が旋回している状態において、水準器１０の傾斜が検出される。また、プロセッサ１１は、エンコーダ１６での旋回モータ１５の駆動状態の検出結果に基づいて、旋回体３の走行体２に対する旋回角度を検出する（ステップＳ１０５）。これにより、プロセッサ１１は、検出された水準器１０の傾斜のそれぞれがいずれの旋回角度で検出された傾斜であるか、特定する。すなわち、水準器１０の傾斜と旋回体３の旋回角度が関連付けられる。そして、プロセッサ１１は、エンコーダ１６での検出結果に基づいて、旋回体３の旋回速度が一定であるか否か（すなわち、旋回速度が安定しているか否か）を判断する（ステップＳ１０６）。旋回速度が一定であることにより、水準器１０の傾斜及び旋回速度が適切に検出される。旋回速度が一定でない場合は（ステップＳ１０６−Ｎｏ）、プロセッサ１１は、水準器１０の傾斜の検出を強制終了する（ステップＳ１０７）。これにより、水準器１０の傾斜と走行体２の傾斜との間のずれの検出も強制終了される。 When the turning speed is constant (step S103-Yes), the processor 11 determines the inclination of the level 10 (part where the level 10 is installed) with respect to the horizontal plane based on the gravitational acceleration detected by the level 10. It detects (step S104). The inclination of the level 10 is detected at each of a plurality of (preferably three or more) turning angles of the turning body 3. That is, the inclination of the level 10 is detected in a state where the revolving body 3 is revolving. The processor 11 detects the turning angle of the turning body 3 relative to the traveling body 2 based on the detection result of the driving state of the turning motor 15 by the encoder 16 (step S105). As a result, the processor 11 identifies which of the turning angles each detected inclination of the level 10 is detected at. That is, the inclination of the level 10 and the turning angle of the swivel body 3 are associated with each other. Then, the processor 11 determines whether or not the turning speed of the revolving structure 3 is constant (that is, whether or not the turning speed is stable) based on the detection result of the encoder 16 (step S106). Since the turning speed is constant, the inclination of the level 10 and the turning speed are appropriately detected. If the turning speed is not constant (step S106-No), the processor 11 forcibly ends the detection of the inclination of the level 10 (step S107). Thereby, the detection of the deviation between the inclination of the level 10 and the inclination of the traveling body 2 is also forcibly terminated.
旋回速度が一定である場合は（ステップＳ１０６−Ｙｅｓ）、プロセッサ１１は、水準器１０の傾斜の検出が完了したか否かを判断する（ステップＳ１０８）。すなわち、水準器１０の傾斜に関するデータの収集が終了したか否かが、判断される。水準器１０の傾斜に関するデータは、水準器１０の傾斜と走行体２の傾斜との間のずれの検出に用いられる。水準器１０の傾斜の検出が完了していない場合は（ステップＳ１０８−Ｎｏ）、処理は、ステップＳ１０４に戻り、ステップＳ１０４以降の処理が順次行われる。すなわち、旋回体３が一定の旋回速度で旋回している状態において、水準器１０の傾斜の検出及び旋回体３の旋回角度の検出が繰り返し行われる。 When the turning speed is constant (step S106-Yes), the processor 11 determines whether or not the detection of the inclination of the level 10 is completed (step S108). That is, it is determined whether or not collection of data relating to the inclination of the level 10 has been completed. Data relating to the inclination of the level 10 is used to detect a deviation between the inclination of the level 10 and the inclination of the traveling body 2. When the detection of the inclination of the level 10 has not been completed (No at Step S108), the process returns to Step S104, and the processes after Step S104 are sequentially performed. That is, in a state where the revolving unit 3 is revolving at a constant revolving speed, the detection of the inclination of the level 10 and the detection of the revolving angle of the revolving unit 3 are repeatedly performed.
ここで、水準器１０の第１の基準軸Ｃ１に沿う方向（例えば旋回体３の前後方向）について傾斜量、及び、水準器１０の第２の基準軸Ｃ２に沿う方向（例えば旋回体３の左右方向）についての傾斜量を２軸（ｘ軸及びｙ軸）とする演算上の座標（ｘ−ｙ座標）２５を規定する。水準器１０の傾斜の検出が完了すると（ステップＳ１０８−Ｙｅｓ）、プロセッサ１１は、旋回体３の複数の旋回角度のそれぞれについて、検出された水準器１０の傾斜を示すデータ点（Ｚ）を座標２５に形成する（ステップＳ１０９）。この際、水準器１０が水平面に対して傾斜していない状態では、旋回体３のいずれの旋回角度でも、データ点（Ｚ）は、座標２５において原点Ｏ上に形成される。また、例えば、第１の基準軸Ｃ１に沿う方向の一方側（例えば旋回体３の前方側）が鉛直下側になる状態に水準器１０が傾斜する場合、データ点（Ｚ）は、座標２５において原点Ｏからｙ軸の正側に離れた位置に形成され、第１の基準軸Ｃ１に沿う方向の他方側（例えば旋回体３の後方側）が鉛直下側になる状態に水準器１０が傾斜する場合、データ点（Ｚ）は、座標２５において原点Ｏからｙ軸の負側に離れた位置に形成される。そして、例えば、第２の基準軸Ｃ２に沿う方向の一方側（例えば旋回体３の右側）が鉛直下側になる状態に水準器１０が傾斜する場合、データ点（Ｚ）は、座標２５において原点Ｏからｘ軸の正側に離れた位置に形成され、第２の基準軸Ｃ２に沿う方向の他方側（例えば旋回体３の左側）が鉛直下側になる状態に水準器１０が傾斜する場合、データ点（Ｚ）は、座標２５において原点Ｏからｘ軸の負側に離れた位置に形成される。また、水準器１０の傾斜量が大きいほど、座標２５においてデータ点（Ｚ）の原点Ｏからの距離が大きい。 Here, the amount of inclination in the direction along the first reference axis C1 of the level 10 (for example, the longitudinal direction of the swivel body 3) and the direction along the second reference axis C2 of the level 10 (for example of the swivel body 3) An arithmetic coordinate (xy coordinate) 25 is defined with the amount of inclination in the left-right direction as two axes (x-axis and y-axis). When the detection of the inclination of the level 10 is completed (step S108-Yes), the processor 11 coordinates the data point (Z) indicating the detected inclination of the level 10 for each of the plurality of turning angles of the turning body 3. 25 (step S109). At this time, in a state where the level 10 is not inclined with respect to the horizontal plane, the data point (Z) is formed on the origin O at the coordinate 25 at any turning angle of the turning body 3. Further, for example, when the level 10 is tilted so that one side in the direction along the first reference axis C1 (for example, the front side of the swing body 3) is vertically downward, the data point (Z) has the coordinate 25. The level 10 is formed at a position away from the origin O to the positive side of the y-axis, and the other side in the direction along the first reference axis C1 (for example, the rear side of the swing body 3) is vertically downward. When tilting, the data point (Z) is formed at a position away from the origin O to the negative side of the y-axis at the coordinate 25. For example, when the level 10 is tilted so that one side in the direction along the second reference axis C2 (for example, the right side of the swivel body 3) is vertically downward, the data point (Z) is The level 10 is tilted so that the other side in the direction along the second reference axis C2 (for example, the left side of the swivel body 3) is vertically downward, formed at a position away from the origin O to the positive side of the x-axis. In this case, the data point (Z) is formed at a position away from the origin O to the negative side of the x-axis at the coordinate 25. Moreover, the distance from the origin O of the data point (Z) in the coordinate 25 is large, so that the inclination amount of the level 10 is large.
前述のように水準器１０の傾斜を示す複数のデータ点（Ｚ）が座標２５に形成されることにより、座標２５において、全てのデータ点（Ｚ）は一箇所に集中するか、又は、全てのデータ点（Ｚ）が同一の円（Ｒ）上に配置される。データ点（Ｚ）を座標２５上に形成すると（ステップＳ１０９）、プロセッサ１１は、座標２５上において、全てのデータ点（Ｚ）の集中箇所（Ｔ）、又は、全てのデータ点（Ｚ）を通る円（Ｒ）の中心（Ｔ）を特定する（ステップＳ１１０）。そして、プロセッサ１１は、座標２５上での集中箇所（Ｔ）又は円（Ｒ）の中心（Ｔ）の位置に基づいて、水準器１０の水平面に対する傾斜と走行体２の水平面に対する傾斜との間のずれの検出処理を行う（ステップＳ１１１）。そして、プロセッサ１１は、ずれの検出処理の結果に基づいて、水準器１０の傾斜と走行体２の傾斜との間にずれがあるか否かを判断する（ステップＳ１１２）。 As described above, a plurality of data points (Z) indicating the inclination of the level 10 are formed at the coordinates 25, so that all the data points (Z) are concentrated at one place in the coordinates 25 or all of them. Data points (Z) are arranged on the same circle (R). When the data point (Z) is formed on the coordinate 25 (step S109), the processor 11 sets the concentrated point (T) of all the data points (Z) or all the data points (Z) on the coordinates 25. The center (T) of the passing circle (R) is specified (step S110). Then, the processor 11 determines between the inclination of the level 10 with respect to the horizontal plane and the inclination of the traveling body 2 with respect to the horizontal plane, based on the position of the concentration point (T) or the center (T) of the circle (R) on the coordinates 25. A shift detection process is performed (step S111). Then, the processor 11 determines whether or not there is a deviation between the inclination of the level 10 and the inclination of the traveling body 2 based on the result of the deviation detection process (step S112).
ずれの検出処理（ステップＳ１１１）では、プロセッサ１１は、全てのデータ点（Ｚ）の集中箇所（Ｔ）又は全てのデータ点（Ｚ）を通る円（Ｒ）の中心（Ｔ）の座標２５の原点Ｏからのずれを検出する。そして、集中箇所（Ｔ）又は円（Ｒ）の中心（Ｔ）の原点Ｏからのずれに基づいて、水準器１０の傾斜と走行体２の傾斜との間のずれを検出する。この際、集中箇所（Ｔ）又は円（Ｒ）の中心（Ｔ）が原点Ｏ上に位置する場合は、プロセッサ１１は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生していないと判断する（ステップＳ１１２−Ｎｏ）。一方、集中箇所（Ｔ）又は円（Ｒ）の中心（Ｔ）が原点Ｏから離れて位置する場合は、プロセッサ１１は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生している判断する（ステップＳ１１２−Ｙｅｓ）。なお、検出された水準器１０の傾斜と走行体２の傾斜との間のずれに関する情報は、記憶媒体１２等に記憶される。 In the shift detection process (step S111), the processor 11 sets the coordinates 25 of the center (T) of the circle (R) passing through the concentrated points (T) of all the data points (Z) or all the data points (Z). A deviation from the origin O is detected. Then, based on the deviation from the origin O of the center (T) of the concentrated location (T) or the circle (R), a deviation between the inclination of the level 10 and the inclination of the traveling body 2 is detected. At this time, if the concentration point (T) or the center (T) of the circle (R) is located on the origin O, the processor 11 causes a deviation between the inclination of the level 10 and the inclination of the traveling body 2. It is determined that it has not been done (step S112—No). On the other hand, when the concentration point (T) or the center (T) of the circle (R) is located away from the origin O, the processor 11 causes a deviation between the inclination of the level 10 and the inclination of the traveling body 2. (Step S112-Yes). Information about the detected difference between the inclination of the level 10 and the inclination of the traveling body 2 is stored in the storage medium 12 or the like.
水準器１０の傾斜と走行体２の傾斜との間にずれが発生していないと判断した場合は（ステップＳ１１２−Ｎｏ）、プロセッサ１１は、水準器１０の傾斜を示すデータ点（Ｚ）及びデータ点（Ｚ）のそれぞれに対応する旋回体３の旋回角度に基づいて、走行体２の水平面に対する傾斜を検出する（ステップＳ１１３）。一方、水準器１０の傾斜と走行体２の傾斜との間にずれが発生していると判断した場合は（ステップＳ１１２−Ｙｅｓ）、プロセッサ１１は、座標２５においてデータ点（Ｚ）を補正し、データ点（Ｚ）の位置を修正する（ステップＳ１１４）。データ点（Ｚ）の補正では、プロセッサ１１は、集中箇所（Ｔ）又は円（Ｒ）の中心（Ｔ）の原点Ｏからのずれと同一の大きさだけ、データ点（Ｚ）のそれぞれをｘ軸方向及びｙ軸方向に移動する（平行移動する）。そして、座標２５上においてデータ点（Ｚ）のそれぞれを移動させた位置に、補正された（修正された）データ点（Ｚ´）を形成する。前述のようにデータ点（Ｚ）が補正されるため、座標２５において、補正された全てのデータ点（Ｚ´）は原点Ｏに集中するか、又は、補正された全てのデータ点（Ｚ´）が原点Ｏを中心とする同一の円（Ｒ´）上に配置される。そして、プロセッサ１１は、補正されたデータ点（Ｚ´）及び補正されたデータ点（Ｚ´）のそれぞれに対応する旋回体３の旋回角度に基づいて、走行体２の水平面に対する傾斜を検出する（ステップＳ１１３）。 If it is determined that there is no deviation between the inclination of the level 10 and the inclination of the traveling body 2 (step S112—No), the processor 11 determines the data point (Z) indicating the inclination of the level 10 and The inclination of the traveling body 2 with respect to the horizontal plane is detected based on the turning angle of the turning body 3 corresponding to each data point (Z) (step S113). On the other hand, if it is determined that there is a deviation between the inclination of the level 10 and the inclination of the traveling body 2 (step S112—Yes), the processor 11 corrects the data point (Z) at the coordinate 25. Then, the position of the data point (Z) is corrected (step S114). In the correction of the data point (Z), the processor 11 sets each of the data points (Z) to x by the same amount as the deviation from the origin O of the center (T) of the concentration point (T) or the circle (R). It moves in the axial direction and the y-axis direction (translates). Then, a corrected (corrected) data point (Z ′) is formed at a position where each of the data points (Z) is moved on the coordinate 25. Since the data point (Z) is corrected as described above, at the coordinate 25, all the corrected data points (Z ′) are concentrated at the origin O or all the corrected data points (Z ′). ) Are arranged on the same circle (R ′) centered on the origin O. Then, the processor 11 detects the inclination of the traveling body 2 with respect to the horizontal plane based on the turning angle of the turning body 3 corresponding to each of the corrected data point (Z ′) and the corrected data point (Z ′). (Step S113).
なお、検出された走行体２の水平面に対する傾斜は、表示画面に表示される等、告知部２３によって告知される。また、傾斜検出操作ボタン２１での操作入力が行われた場合は、プロセッサ１１は、旋回体３が旋回していない状態において（すなわち、１つの旋回角度においてのみ）、水準器１０の水平面に対する傾斜を検出する。そして、プロセッサ１１は、記憶媒体１２に記憶された水準器１０の傾斜と走行体２の傾斜との間のずれ、及び、検出した水準器１０の傾斜に基づいて、走行体２の水平面に対する傾斜を検出する。 The detected inclination of the traveling body 2 with respect to the horizontal plane is notified by the notification unit 23, such as being displayed on the display screen. In addition, when an operation input is performed with the tilt detection operation button 21, the processor 11 tilts the level 10 with respect to the horizontal plane in a state where the swing body 3 does not swing (that is, only at one swing angle). Is detected. Then, the processor 11 determines the inclination of the traveling body 2 with respect to the horizontal plane based on the difference between the inclination of the level 10 and the inclination of the traveling body 2 stored in the storage medium 12 and the detected inclination of the level 10. Is detected.
図５乃至図８のそれぞれは、プロセッサ１１の座標２５を用いた処理、及び、告知部２３に表示される走行体２の傾斜に関する情報の一例を示す図である。図５は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生せず、かつ、走行体２が水平面に対して傾斜していない状態での一例であり、図６は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生せず、かつ、走行体２が水平面に対して傾斜している状態での一例である。図７は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生し、かつ、走行体２が水平面に対して傾斜していない状態での一例であり、図８は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生し、かつ、走行体２が水平面に対して傾斜している状態での一例である。 Each of FIG. 5 to FIG. 8 is a diagram illustrating an example of processing using the coordinates 25 of the processor 11 and information related to the inclination of the traveling body 2 displayed on the notification unit 23. FIG. 5 is an example in a state in which no deviation occurs between the inclination of the level 10 and the inclination of the traveling body 2 and the traveling body 2 is not inclined with respect to the horizontal plane. This is an example in which no deviation occurs between the inclination of the level 10 and the inclination of the traveling body 2 and the traveling body 2 is inclined with respect to the horizontal plane. FIG. 7 is an example of a state in which a deviation occurs between the inclination of the level 10 and the inclination of the traveling body 2 and the traveling body 2 is not inclined with respect to the horizontal plane. This is an example in a state in which a deviation occurs between the inclination of the vessel 10 and the traveling body 2 and the traveling body 2 is inclined with respect to the horizontal plane.
図５乃至図８に示すように、告知部２３では、走行体２の前後方向についての走行体２の傾斜量をＰ軸に示し、かつ、走行体２の左右方向（幅方向）についての走行体２の傾斜量をＷ軸に示した座標（Ｐ−Ｗ座標）２７を用いて、検出された走行体２の傾斜に関する情報が表示される。ここで、走行体２が水平面に対して傾斜していない状態では、告知部２３の座標２７において原点Ｏ´上に走行体２の傾斜を示すデータ点（Ｑ）が表示される。また、例えば走行体２の前方側が鉛直下側になる状態に走行体２が傾斜する場合、データ点（Ｑ）は、告知部２３の座標２７において原点Ｏ´からＰ軸の正側に離れた位置に形成され、走行体２の後方側が鉛直下側になる状態に走行体２が傾斜する場合、データ点（Ｑ）は、座標２７において原点Ｏ´からＰ軸の負側に離れた位置に形成される。そして、例えば、走行体２の右側が鉛直下側になる状態に走行体２が傾斜する場合、データ点（Ｑ）は、座標２７において原点Ｏ´からＷ軸の正側に離れた位置に形成され、走行体２の左側が鉛直下側になる状態に走行体２が傾斜する場合、データ点（Ｑ）は、座標２７において原点Ｏ´からＷ軸の負側に離れた位置に形成される。また、走行体２の傾斜量が大きいほど、座標２７においてデータ点（Ｑ）の原点Ｏ´からの距離が大きい。 As shown in FIGS. 5 to 8, the notification unit 23 indicates the amount of inclination of the traveling body 2 in the front-rear direction of the traveling body 2 on the P axis and travels in the left-right direction (width direction) of the traveling body 2. Information on the detected inclination of the traveling body 2 is displayed using the coordinates (P-W coordinates) 27 indicating the inclination amount of the body 2 on the W axis. Here, in a state where the traveling body 2 is not inclined with respect to the horizontal plane, a data point (Q) indicating the inclination of the traveling body 2 is displayed on the origin O ′ at the coordinate 27 of the notification unit 23. Further, for example, when the traveling body 2 is inclined in a state where the front side of the traveling body 2 is vertically downward, the data point (Q) is separated from the origin O ′ to the positive side of the P axis at the coordinates 27 of the notification unit 23. When the traveling body 2 is tilted so that the rear side of the traveling body 2 is vertically downward, the data point (Q) is located at a position away from the origin O ′ to the negative side of the P-axis at the coordinate 27. It is formed. For example, when the traveling body 2 is tilted so that the right side of the traveling body 2 is vertically downward, the data point (Q) is formed at a position away from the origin O ′ to the positive side of the W axis at the coordinate 27. When the traveling body 2 is tilted so that the left side of the traveling body 2 is vertically downward, the data point (Q) is formed at a position away from the origin O ′ to the negative side of the W axis at the coordinate 27. . Further, the greater the amount of inclination of the traveling body 2, the greater the distance from the origin O ′ of the data point (Q) at the coordinate 27.
図５の一例では、プロセッサ１１は、座標２５上において、水準器１０の傾斜を示す全てのデータ点（Ｚａ１〜Ｚａ８）を、原点Ｏ上に形成する。このため、原点Ｏが、全てのデータ点（Ｚａ１〜Ｚａ８）の集中箇所Ｔａとなる。この際、集中箇所Ｔａが原点Ｏ上に位置するため、プロセッサ１１は、データ点（Ｚａ１〜Ｚａ８）を補正せず、水準器１０の傾斜と走行体２の傾斜との間にずれが発生していないと判断する。また、いずれの旋回角度でも、データ点（Ｚａ１〜Ｚａ８）が原点Ｏ上に集中するため、プロセッサ１１は、走行体２が水平面に対して傾斜していないと判断する。このため、告知部２３では、座標２７の原点Ｏ´上に、走行体２の傾斜を示すデータ点Ｑａが表示される。 In the example of FIG. 5, the processor 11 forms all data points (Za 1 to Za 8) indicating the inclination of the level 10 on the origin O on the coordinate 25. For this reason, the origin O becomes a concentrated portion Ta of all the data points (Za1 to Za8). At this time, since the concentrated portion Ta is located on the origin O, the processor 11 does not correct the data points (Za1 to Za8), and a deviation occurs between the inclination of the level 10 and the inclination of the traveling body 2. Judge that it is not. Moreover, since the data points (Za1 to Za8) are concentrated on the origin O at any turning angle, the processor 11 determines that the traveling body 2 is not inclined with respect to the horizontal plane. For this reason, in the notification part 23, the data point Qa which shows the inclination of the traveling body 2 is displayed on the origin O 'of the coordinate 27. FIG.
図６の一例では、プロセッサ１１は、座標２５上において、水準器１０の傾斜を示す全てのデータ点（Ｚｂ１〜Ｚｂ８）を、原点Ｏを中心とする半径Ｄｂの円Ｒｂ上に形成する。このため、原点Ｏが、全てのデータ点（Ｚｂ１〜Ｚｂ８）を通る円Ｒｂの中心Ｔｂとなる。この際、円Ｒｂの中心Ｔｂが原点Ｏ上に位置するため、プロセッサ１１は、データ点（Ｚｂ１〜Ｚｂ８）を補正せず、水準器１０の傾斜と走行体２の傾斜との間にずれが発生していないと判断する。また、データ点Ｚｂ１が第１の基準軸Ｃ１に沿う方向の一方側（旋回体３の前方側）が走行体２の前方側に一致する旋回角度に対応する場合、プロセッサ１１は、走行体２の前方側が鉛直下側になる状態に傾斜量Ｄｂだけ走行体２が傾斜し、左右方向について走行体２が傾斜していないと判断する。このため、告知部２３では、座標２７において原点Ｏ´からＰ軸の正側に傾斜量Ｄｂだけ離れ、かつ、Ｗ軸に沿う方向について原点Ｏ´からずれていない位置に、走行体２の傾斜を示すデータ点Ｑｂが表示される。 In the example of FIG. 6, the processor 11 forms all the data points (Zb1 to Zb8) indicating the inclination of the level 10 on the circle Rb having the radius Db with the origin O as the center on the coordinate 25. For this reason, the origin O becomes the center Tb of the circle Rb passing through all the data points (Zb1 to Zb8). At this time, since the center Tb of the circle Rb is located on the origin O, the processor 11 does not correct the data points (Zb1 to Zb8), and there is a shift between the inclination of the level 10 and the inclination of the traveling body 2. Judge that it does not occur. When the data point Zb1 corresponds to the turning angle at which one side (the front side of the turning body 3) along the first reference axis C1 corresponds to the front side of the traveling body 2, the processor 11 It is determined that the traveling body 2 is inclined by the inclination amount Db so that the traveling body 2 is not inclined in the left-right direction. For this reason, the notification unit 23 inclines the traveling body 2 at a position at a coordinate 27 away from the origin O ′ by the inclination amount Db on the positive side of the P-axis and not deviated from the origin O ′ in the direction along the W-axis. A data point Qb indicating is displayed.
図７の一例では、プロセッサ１１は、座標２５上において、水準器１０の傾斜を示す全てのデータ点（Ｚｃ１〜Ｚｃ８）を、原点Ｏからｘ軸の負側に傾斜量αｃだけ離れ、かつ、原点Ｏからｙ軸の正側に傾斜量βｃだけ離れた位置に、形成する。このため、原点Ｏからｘ軸の負側に傾斜量αｃだけ離れ、かつ、原点Ｏからｙ軸の正側に傾斜量βｃだけ離れた位置が、全てのデータ点（Ｚｃ１〜Ｚｃ８）の集中箇所Ｔｃとなる。この際、集中箇所Ｔｃが原点Ｏから離れているため、プロセッサ１１は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生していると判断する。そして、プロセッサ１１は、集中箇所Ｔｃと原点Ｏとのずれと同一の大きさだけ、データ点（Ｚｃ１〜Ｚｃ８）のそれぞれをｘ軸方向及びｙ軸方向に平行移動する。この際、データ点（Ｚｃ１〜Ｚｃ８）のそれぞれは、ｘ軸の正側に傾斜量αｃだけ平行移動し、かつ、ｙ軸の負側に傾斜量βｃだけ平行移動する。これにより、データ点（Ｚｃ１〜Ｚｃ８）が移動した原点Ｏに、補正されたデータ点（Ｚ´ｃ１〜Ｚ´ｃ８）が形成される。したがって、原点Ｏは、補正された全てのデータ点（Ｚ´ｃ１〜Ｚ´ｃ８）の集中箇所Ｔ´ｃとなる。補正されたデータ点（Ｚ´ｃ１〜Ｚ´ｃ８）が形成されることにより、水準器１０の傾斜と走行体２の傾斜との間のずれを補正した状態で、走行体２の傾斜の検出が行われる。また、いずれの旋回角度でも、補正されたデータ点（Ｚ´ｃ１〜Ｚ´８）が原点Ｏ上に集中するため、プロセッサ１１は、走行体２が水平面に対して傾斜していないと判断する。このため、告知部２３では、座標２７の原点Ｏ´上に、走行体２の傾斜を示すデータ点Ｑｃが表示される。 In the example of FIG. 7, the processor 11 separates all data points (Zc1 to Zc8) indicating the inclination of the level 10 on the coordinate 25 from the origin O to the negative side of the x axis by the inclination amount αc, and It is formed at a position separated from the origin O by the inclination amount βc on the positive side of the y-axis. For this reason, a position that is separated from the origin O by the inclination amount αc on the negative side of the x-axis and is separated from the origin O by the inclination amount βc on the positive side of the y-axis is a concentrated location of all the data points (Zc1 to Zc8). Tc. At this time, since the concentrated portion Tc is away from the origin O, the processor 11 determines that a deviation has occurred between the inclination of the level 10 and the inclination of the traveling body 2. Then, the processor 11 translates each of the data points (Zc1 to Zc8) in the x-axis direction and the y-axis direction by the same magnitude as the deviation between the concentrated location Tc and the origin O. At this time, each of the data points (Zc1 to Zc8) translates by an amount of inclination αc on the positive side of the x axis and translates by an amount of inclination βc on the negative side of the y axis. As a result, corrected data points (Z′c1 to Z′c8) are formed at the origin O where the data points (Zc1 to Zc8) have moved. Therefore, the origin O is a concentrated point T′c of all the corrected data points (Z′c1 to Z′c8). Detection of the inclination of the traveling body 2 in the state where the deviation between the inclination of the level 10 and the inclination of the traveling body 2 is corrected by forming the corrected data points (Z′c1 to Z′c8). Is done. Moreover, since the corrected data points (Z′c1 to Z′8) are concentrated on the origin O at any turning angle, the processor 11 determines that the traveling body 2 is not inclined with respect to the horizontal plane. . For this reason, in the notification part 23, the data point Qc which shows the inclination of the traveling body 2 is displayed on the origin O 'of the coordinate 27. FIG.
図８の一例では、プロセッサ１１は、座標２５上において、水準器１０の傾斜を示す全てのデータ点（Ｚｄ１〜Ｚｄ８）を、円Ｒｄ上に形成する。円Ｒｄは、原点Ｏからｘ軸の負側に傾斜量αｄだけ離れ、かつ、原点Ｏからｙ軸の正側に傾斜量βｄだけ離れて中心Ｔｄが位置し、半径Ｄｄを有する。このため、原点Ｏからｘ軸の負側に傾斜量αｄだけ離れ、かつ、原点Ｏからｙ軸の正側に傾斜量βｄだけ離れた位置が、全てのデータ点（Ｚｄ１〜Ｚｄ８）を通る円Ｒｄの中心Ｔｄとなる。この際、円Ｒｄの中心Ｔｄが原点Ｏから離れているため、プロセッサ１１は、水準器１０の傾斜と走行体２の傾斜との間にずれが発生していると判断する。そして、プロセッサ１１は、円Ｒｄの中心Ｔｄと原点Ｏとのずれと同一の大きさだけ、データ点（Ｚｄ１〜Ｚｄ８）のそれぞれをｘ軸方向及びｙ軸方向に平行移動する。この際、データ点（Ｚｄ１〜Ｚｄ８）のそれぞれは、ｘ軸の正側に傾斜量αｄだけ平行移動し、かつ、ｙ軸の負側に傾斜量βｄだけ平行移動する。そして、データ点（Ｚｄ１〜Ｚｄ８）のそれぞれが移動した位置に、補正されたデータ点（Ｚ´ｄ１〜Ｚ´ｃｄの対応する１つ）が形成される。補正された全てのデータ点（Ｚ´ｄ１〜Ｚ´ｄ８）は、原点Ｏを中心とする半径Ｄｄの円Ｒ´ｄ上に形成される。したがって、原点Ｏは、補正された全てのデータ点（Ｚ´ｄ１〜Ｚ´ｄ８）を通る円Ｒ´ｄの中心Ｔ´ｄとなる。補正されたデータ点（Ｚ´ｄ１〜Ｚ´ｄ８）が形成されることにより、水準器１０の傾斜と走行体２の傾斜との間のずれを補正した状態で、走行体２の傾斜の検出が行われる。また、補正されたデータ点Ｚ´ｄ１が第１の基準軸Ｃ１に沿う方向の一方側（旋回体３の前方側）が走行体２の前方側に一致する旋回角度に対応する場合、プロセッサ１１は、走行体２の前方側が鉛直下側になる状態に傾斜量Ｄｄだけ走行体２が傾斜し、左右方向について走行体２が傾斜していないと判断する。このため、告知部２３では、座標２７において原点Ｏ´からＰ軸の正側に傾斜量Ｄｄだけ離れ、かつ、Ｗ軸に沿う方向について原点Ｏ´からずれていない位置に、走行体２の傾斜を示すデータ点Ｑｄが表示される。 In the example of FIG. 8, the processor 11 forms all data points (Zd1 to Zd8) indicating the inclination of the level 10 on the circle Rd on the coordinate 25. The circle Rd is separated from the origin O by the inclination amount αd on the negative side of the x-axis, and the center Td is located away from the origin O by the inclination amount βd on the positive side of the y-axis, and has a radius Dd. For this reason, a position that is separated from the origin O by the inclination amount αd on the negative side of the x-axis and separated from the origin O by the inclination amount βd on the positive side of the y-axis passes through all the data points (Zd1 to Zd8). It becomes the center Td of Rd. At this time, since the center Td of the circle Rd is away from the origin O, the processor 11 determines that a deviation has occurred between the inclination of the level 10 and the inclination of the traveling body 2. Then, the processor 11 translates each of the data points (Zd1 to Zd8) in the x-axis direction and the y-axis direction by the same magnitude as the deviation between the center Td of the circle Rd and the origin O. At this time, each of the data points (Zd1 to Zd8) translates by an amount of inclination αd to the positive side of the x axis and translates by an amount of inclination βd to the negative side of the y axis. Then, corrected data points (one corresponding to Z′d1 to Z′cd) are formed at positions where the data points (Zd1 to Zd8) have moved. All the corrected data points (Z′d1 to Z′d8) are formed on a circle R′d having a radius Dd centered on the origin O. Therefore, the origin O becomes the center T′d of the circle R′d that passes through all the corrected data points (Z′d1 to Z′d8). Detection of the inclination of the traveling body 2 in a state where the deviation between the inclination of the level 10 and the inclination of the traveling body 2 is corrected by forming the corrected data points (Z′d1 to Z′d8). Is done. Further, when the corrected data point Z′d1 corresponds to a turning angle in which one side in the direction along the first reference axis C1 (the front side of the turning body 3) coincides with the front side of the traveling body 2, the processor 11 Determines that the traveling body 2 is inclined by the inclination amount Dd in a state where the front side of the traveling body 2 is vertically downward, and the traveling body 2 is not inclined in the left-right direction. For this reason, in the notification part 23, the inclination of the traveling body 2 at a position where the coordinate 27 is away from the origin O ′ by the inclination amount Dd on the positive side of the P axis and is not deviated from the origin O ′ in the direction along the W axis. A data point Qd indicating is displayed.
前述のように、本実施形態では、旋回体３の複数の旋回角度のそれぞれにおいて、旋回体３と一緒に旋回する水準器１０の傾斜を、プロセッサ１１が検出する。そして、プロセッサ１１は、旋回体３の複数の旋回角度のそれぞれについて、検出された水準器１０の傾斜を示すデータ点（Ｚ）を座標２５に形成する。そして、プロセッサ１１は、座標２５での全てのデータ点（Ｚ）の集中箇所（Ｔ）又は全てデータ点（Ｚ）を通る円（Ｒ）の中心（Ｔ）の原点Ｏからのずれに基づいて、水準器１０の傾斜と走行体２の傾斜との間のずれを検出する。このため、水準器１０の傾斜と走行体２の傾斜との間のずれが適切に検出される。 As described above, in this embodiment, the processor 11 detects the inclination of the level 10 that rotates together with the revolving structure 3 at each of the plurality of revolving angles of the revolving structure 3. Then, the processor 11 forms a data point (Z) indicating the detected inclination of the level 10 at the coordinate 25 for each of the plurality of turning angles of the turning body 3. Then, the processor 11 is based on the deviation from the origin O of the center (T) of the circle (R) passing through all the data points (Z) or all the data points (Z) at the coordinates 25 or all the data points (Z). The deviation between the inclination of the level 10 and the inclination of the traveling body 2 is detected. For this reason, the shift | offset | difference between the inclination of the level 10 and the inclination of the traveling body 2 is detected appropriately.
また、プロセッサ１１は、適切に検出された水準器１０の傾斜と走行体２の傾斜との間のずれに基づいて、座標２５においてデータ点（Ｚ）を補正し、補正されたデータ点（Ｚ´）に基づいて、走行体２の傾斜を検出する。したがって、水準器１０の傾斜と走行体２の傾斜との間のずれを補正した状態で、適切に走行体２の傾斜の検出が行われる。このため、走行体２の水平面に対する傾斜が適切に検出される。 Further, the processor 11 corrects the data point (Z) at the coordinate 25 based on the appropriately detected deviation between the inclination of the level 10 and the inclination of the traveling body 2, and the corrected data point (Z '), The inclination of the traveling body 2 is detected. Therefore, the inclination of the traveling body 2 is appropriately detected in a state where the deviation between the inclination of the level 10 and the inclination of the traveling body 2 is corrected. For this reason, the inclination with respect to the horizontal surface of the traveling body 2 is detected appropriately.
また、前述のようにしてプロセッサ１１よって走行体２の傾斜が検出されるため、水準器１０とは別の水準器を用いていわゆる零点調整を行う必要がない。すなわち、走行体２との間に傾斜のずれがない別の水準器を用いて、クレーン１に取付けられる水準器１０の傾斜と走行体２の傾斜との間のずれを手動で修正し、水準器１０の傾斜と走行体２の傾斜とを合わせる調整を行う必要はない。これにより、別の水準器を用いてずれを修正する手間が省略される。 Moreover, since the inclination of the traveling body 2 is detected by the processor 11 as described above, it is not necessary to perform so-called zero adjustment using a level different from the level 10. That is, by using another level with no inclination deviation from the traveling body 2, the deviation between the inclination of the level 10 attached to the crane 1 and the inclination of the traveling body 2 is manually corrected, and the level There is no need to adjust the inclination of the vessel 10 and the inclination of the traveling body 2. Thereby, the trouble of correcting the shift using another level is omitted.
（変形例）
なお、前述の実施形態等では、建設機械としてクレーン１を例として説明したが、前述の構成は、高所作業車及び油圧ショベル等のクレーン１以外の建設機械にも適用可能である。すなわち、走行体２及び走行体２上に旋回可能に設置される旋回体３が設けられ、旋回体３に水準器１０が取付けられる構成であれば、前述の構成を適用可能である。
(Modification)
In the above-described embodiment and the like, the crane 1 is described as an example of the construction machine. However, the above-described configuration can be applied to construction machines other than the crane 1 such as an aerial work vehicle and a hydraulic excavator. That is, the above-described configuration can be applied as long as the traveling body 2 and the revolving body 3 that is turnably installed on the traveling body 2 are provided and the level 10 is attached to the revolving body 3.
前述の実施形態等では、建設機械（１）の傾斜検出装置（９）は、走行体（２）と、走行体（２）上に設けられ、走行体（２）に対して旋回可能な旋回体（３）と、を備える。水準器（１０）は、旋回体（３）に取付けられるとともに、旋回体（３）と一緒に旋回する。プロセッサ（１１）は、旋回体（３）及び水準器（１０）が旋回している状態において、水平面に対する水準器（１０）の傾斜を検出する。プロセッサ（１１）は、水準器（１０）の傾斜の検出結果に基づいて、走行体（２）の水平面に対する傾斜と水準器（１０）の傾斜との間のずれを検出し、検出されたずれに基づいて、走行体（２）の傾斜を検出する。 In the above-described embodiment or the like, the inclination detection device (9) of the construction machine (1) is provided on the traveling body (2) and the traveling body (2), and can be turned with respect to the traveling body (2). A body (3). The level (10) is attached to the swivel body (3) and swivels together with the swivel body (3). The processor (11) detects the inclination of the level (10) with respect to the horizontal plane in a state where the swiveling body (3) and the level (10) are turning. The processor (11) detects a deviation between the inclination of the traveling body (2) with respect to the horizontal plane and the inclination of the level (10) based on the detection result of the inclination of the level (10), and detects the detected deviation. Based on this, the inclination of the traveling body (2) is detected.
以上、本発明の実施形態について説明したが、本発明は上記の実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲で種々の変形ができることは勿論である。 The embodiments of the present invention have been described above. However, the present invention is not limited to the above-described embodiments, and various modifications can be made without departing from the scope of the present invention.
１…クレーン、２…走行体、３…旋回体、９…傾斜検出装置、１０…水準器、１１…プロセッサ。 DESCRIPTION OF SYMBOLS 1 ... Crane, 2 ... Running body, 3 ... Revolving body, 9 ... Inclination detection apparatus, 10 ... Level, 11 ... Processor.
Claims (4)
前記走行体上に設けられ、前記走行体に対して旋回可能な旋回体と、
前記旋回体に取付けられるとともに、前記旋回体と一緒に旋回する水準器と、
前記旋回体及び前記水準器が旋回している状態において水平面に対する前記水準器の傾斜を検出するとともに、前記水準器の前記傾斜の検出結果に基づいて前記走行体の前記水平面に対する傾斜と前記水準器の前記傾斜との間のずれを検出し、検出された前記ずれに基づいて前記走行体の前記傾斜を検出するプロセッサと、
を具備する建設機械の傾斜検出装置。 A traveling body,
A swivel body provided on the travel body and capable of swiveling relative to the travel body;
A spirit level attached to the swivel body and swiveling together with the swivel body;
While the swiveling body and the spirit level are swiveling, the inclination of the spirit level with respect to a horizontal plane is detected, and the inclination of the traveling body with respect to the horizontal plane and the spirit level based on the detection result of the inclination of the spirit level A processor that detects the inclination of the traveling body based on the detected deviation,
An inclination detection apparatus for construction machinery comprising:
前記プロセッサは、前記旋回体の複数の旋回角度のそれぞれについて、前記水準器の前記傾斜を示すデータ点を、前記第１の基準軸に沿う方向について傾斜量及び前記第２の基準軸に沿う方向についての傾斜量を２軸とする座標上に形成するとともに、前記座標上において、全ての前記データ点の集中箇所又は全ての前記データ点を通る円の中心の、前記座標の原点からのずれを検出し、前記集中箇所又は前記円の前記中心の前記原点からの前記ずれに基づいて、前記走行体の前記傾斜と前記水準器の前記傾斜との間の前記ずれ、及び、前記走行体の前記傾斜を検出する、請求項１の傾斜検出装置。 The level has a first reference axis and a second reference axis that are parallel to the horizontal plane and perpendicular to each other when the level is not inclined with respect to the horizontal plane,
For each of a plurality of turning angles of the turning body, the processor sets a data point indicating the inclination of the spirit level, an amount of inclination with respect to a direction along the first reference axis, and a direction along the second reference axis. Is formed on coordinates with two axes as the tilt amount, and on the coordinates, the concentration point of all the data points or the center of a circle passing through all the data points is shifted from the origin of the coordinates. Detecting, based on the deviation from the origin of the center of the concentration point or the circle, the deviation between the inclination of the traveling body and the inclination of the spirit level, and the traveling body The tilt detection apparatus according to claim 1, wherein the tilt is detected.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016085459A JP6689660B2 (en) | 2016-04-21 | 2016-04-21 | Tilt detector for construction machinery |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016085459A JP6689660B2 (en) | 2016-04-21 | 2016-04-21 | Tilt detector for construction machinery |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2017194381A true JP2017194381A (en) | 2017-10-26 |
| JP6689660B2 JP6689660B2 (en) | 2020-04-28 |
Family
ID=60156062
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2016085459A Active JP6689660B2 (en) | 2016-04-21 | 2016-04-21 | Tilt detector for construction machinery |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6689660B2 (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2019187560A1 (en) * | 2018-03-29 | 2019-10-03 | コベルコ建機株式会社 | Working machine control device |
| CN114164858A (en) * | 2021-12-18 | 2022-03-11 | 中铁广州工程局集团有限公司 | High-precision construction method for vertical column in cover-excavation type subway station |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010032359A (en) * | 2008-07-29 | 2010-02-12 | Nec Corp | Sensor error correcting apparatus and method, inclination measuring apparatus, and antenna control system |
| US20110099822A1 (en) * | 2008-07-10 | 2011-05-05 | Leica Geosystems Ag | Rotating construction laser, in particular a self-compensating rotating construction laser, and method for measuring a tilt of an axis of rotation of a construction laser |
| JP2014524030A (en) * | 2011-07-08 | 2014-09-18 | サンドビック．マイニング．アンド．コンストラクション．オイ | Method and apparatus for calibrating excavator sensor |
| WO2015173920A1 (en) * | 2014-05-14 | 2015-11-19 | 株式会社小松製作所 | Hydraulic shovel calibration system and calibration method |
-
2016
- 2016-04-21 JP JP2016085459A patent/JP6689660B2/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20110099822A1 (en) * | 2008-07-10 | 2011-05-05 | Leica Geosystems Ag | Rotating construction laser, in particular a self-compensating rotating construction laser, and method for measuring a tilt of an axis of rotation of a construction laser |
| JP2010032359A (en) * | 2008-07-29 | 2010-02-12 | Nec Corp | Sensor error correcting apparatus and method, inclination measuring apparatus, and antenna control system |
| JP2014524030A (en) * | 2011-07-08 | 2014-09-18 | サンドビック．マイニング．アンド．コンストラクション．オイ | Method and apparatus for calibrating excavator sensor |
| WO2015173920A1 (en) * | 2014-05-14 | 2015-11-19 | 株式会社小松製作所 | Hydraulic shovel calibration system and calibration method |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2019187560A1 (en) * | 2018-03-29 | 2019-10-03 | コベルコ建機株式会社 | Working machine control device |
| JP2019173444A (en) * | 2018-03-29 | 2019-10-10 | コベルコ建機株式会社 | Work machine control device |
| JP7000957B2 (en) | 2018-03-29 | 2022-01-19 | コベルコ建機株式会社 | Work machine control device |
| US11970837B2 (en) | 2018-03-29 | 2024-04-30 | Kobelco Construction Machinery Co., Ltd. | Working machine control device |
| CN114164858A (en) * | 2021-12-18 | 2022-03-11 | 中铁广州工程局集团有限公司 | High-precision construction method for vertical column in cover-excavation type subway station |
| CN114164858B (en) * | 2021-12-18 | 2022-09-30 | 中铁广州工程局集团有限公司 | High-precision construction method for vertical column in cover-excavation type subway station |
Also Published As
| Publication number | Publication date |
|---|---|
| JP6689660B2 (en) | 2020-04-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR102322519B1 (en) | construction machinery | |
| US9617709B2 (en) | Work vehicle and method of controlling work vehicle | |
| JP5823046B1 (en) | Hydraulic excavator calibration system and calibration method | |
| WO2013057758A1 (en) | Rotation type working machine and control method for rotation type working machine | |
| US7719778B2 (en) | Optical axis tilting device of laser optical system | |
| CN106363460B (en) | Working piece positioning device for positioning workpiece | |
| JP2016065751A (en) | Circularity measurement machine and control method thereof | |
| US20170087678A1 (en) | Tool replacement apparatus | |
| JP5972081B2 (en) | One-side welding equipment for bent plate | |
| JP2007283436A (en) | Robot, robot system, and attitude control method of hand device | |
| JP2012021290A (en) | Turning work machine and control method of the same | |
| JP6689660B2 (en) | Tilt detector for construction machinery | |
| US20200180168A1 (en) | Working robot | |
| JP6490477B2 (en) | Automatic leveling method and automatic leveling device | |
| JP2010162611A (en) | Relative teaching method | |
| JP2018036130A (en) | Circularity measuring instrument | |
| JP6162481B2 (en) | Work area line display device | |
| JP7207127B2 (en) | Surrounding monitoring device for working machine | |
| JP6690438B2 (en) | Eyeglass lens processing device and processing control data creation program | |
| JP2010194631A (en) | Setting assisting device for centerless grinding machine | |
| JP2008179986A (en) | Vehicle with rear monitoring camera | |
| JP6867973B2 (en) | Work vehicle | |
| JP6909944B1 (en) | Material transportation and mounting equipment | |
| JP2017145586A (en) | Work vehicle | |
| JP6319162B2 (en) | Balance training system and display control method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190204 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20191224 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20200114 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20200227 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20200310 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200408 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6689660 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |