JP6538315B2 - Shovel - Google Patents
Shovel Download PDFInfo
- Publication number
- JP6538315B2 JP6538315B2 JP2014131541A JP2014131541A JP6538315B2 JP 6538315 B2 JP6538315 B2 JP 6538315B2 JP 2014131541 A JP2014131541 A JP 2014131541A JP 2014131541 A JP2014131541 A JP 2014131541A JP 6538315 B2 JP6538315 B2 JP 6538315B2
- Authority
- JP
- Japan
- Prior art keywords
- shovel
- reflector
- information
- topography
- attachment
- 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.)
- Active
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/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
-
- 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/08—Superstructures; Supports for superstructures
- E02F9/0858—Arrangement of component parts installed on superstructures not otherwise provided for, e.g. electric components, fenders, air-conditioning units
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
Description
本発明は、掘削の対象となる地面の地形を検知可能なショベルに関する。 The present invention relates to a shovel capable of detecting the topography of the ground to be excavated.
地形形状計測装置を搭載したパワーショベルが知られている(特許文献1参照。)。この地形形状計測装置は、ステレオカメラを利用して計測対象地形までの距離を計測する。 DESCRIPTION OF RELATED ART The power shovel which mounts a topography shape measuring apparatus is known (refer patent document 1). The topography measuring apparatus measures the distance to the topography to be measured using a stereo camera.
しかしながら、左右2台のカメラで構成されるステレオカメラを用いた計測は、左カメラ画像上の一点が右カメラ画像上のどの点に対応するかをパターンマッチング等の手法によって特定する必要がある。そのため、地面等の比較的特徴の少ない計測対象を写した2つのカメラ画像上の2つの点を対応付けることが困難な場合がある。 However, in measurement using a stereo camera configured by two cameras on the left and right, it is necessary to specify which point on the right camera image corresponds to one point on the left camera image by a method such as pattern matching. Therefore, it may be difficult to associate two points on two camera images obtained by capturing a measurement object with relatively few features such as the ground.
本発明の一実施形態に係るショベルは、走行動作を行う下部走行体と、前記下部走行体に旋回自在に搭載される上部旋回体と、前記上部旋回体に取り付けられ、アタッチメントに含まれるブームと、前記ブームに取り付けられ、前記アタッチメントに含まれるアームと、前記上部旋回体に搭載され、レーザ光を出射し反射体までの距離を反射光により計測する装置と、前記反射体までの距離を反射光により計測する装置の出力に基づいて反射体形状に関する情報を導き出し、前記反射体形状に関する情報から前記アタッチメントの形状に関する部分を除外して地形に関する情報を導き出す制御装置と、を備える。 A shovel according to an embodiment of the present invention includes a lower traveling body performing traveling operation, an upper swing body rotatably mounted on the lower travel body, a boom attached to the upper swing body and included in an attachment An apparatus attached to the boom and included in the attachment, an apparatus mounted on the upper swing body, emitting a laser beam and measuring a distance to a reflector by reflected light, and reflecting a distance to the reflector A controller for deriving information on the shape of a reflector based on the output of the device to be measured by light, and for deriving information on the topography by excluding a portion on the shape of the attachment from the information on the shape of the reflector;
上述の手段により、掘削の対象となる地面の地形をより確実に検知可能なショベルが提供される。
The above-described means provides a shovel capable of more reliably detecting the topography of the ground to be excavated.
図1は、本発明の実施例に係る建設機械としてのショベルの側面図である。ショベルの下部走行体1には、旋回機構2を介して機体としての上部旋回体3が搭載される。上部旋回体3には、アタッチメントが取り付けられる。具体的には、上部旋回体3にはブーム4が取り付けられ、ブーム4の先端にはアーム5が取り付けられ、アーム5の先端にはエンドアタッチメントとしてのバケット6が取り付けられる。エンドアタッチメントは、ブレーカ、グラップル等であってもよい。作業要素としてのブーム4、アーム5、及びバケット6は、掘削アタッチメントを構成し、ブームシリンダ7、アームシリンダ8、及びバケットシリンダ9によりそれぞれ油圧駆動される。なお、アタッチメントは浚渫アタッチメント等であってもよい。また、上部旋回体3には、キャビン10が設けられ、且つエンジン等の動力源が搭載される。また、上部旋回体3の前端部分には二次元走査型距離計測装置40が取り付けられ、上部旋回体3の後端上部には測位装置41が取り付けられる。また、キャビン10内にはコントローラ30及び表示装置50が設置される。
FIG. 1 is a side view of a shovel as a construction machine according to an embodiment of the present invention. An upper revolving superstructure 3 as an airframe is mounted on a lower traveling
図2は、図1のショベルに搭載される地形検知システム100の構成例を示すブロック図である。地形検知システム100は、主に、コントローラ30、二次元走査型距離計測装置40、測位装置41、姿勢検出装置42、記憶装置43、及び表示装置50を含む。
FIG. 2 is a block diagram showing a configuration example of the
コントローラ30は、地形検知システム100の全般的な制御を行う制御装置である。本実施例では、コントローラ30は、CPU及び内部メモリを含む演算処理装置で構成され、内部メモリに格納された制御用のプログラムをCPUに実行させて各種機能を実現する。
The
具体的には、コントローラ30は、各種装置の出力に基づいて地形を検知し、その検知結果を表示装置50に表示させる。本実施例では、コントローラ30は、二次元走査型距離計測装置40、測位装置41、姿勢検出装置42、及び記憶装置43のそれぞれの出力を受け、地形取得部31及び座標変換部32のそれぞれに対応するソフトウェアプログラムを実行する。そして、その実行結果に応じて表示装置50に各種情報を表示させる。
Specifically, the
二次元走査型距離計測装置40は、ショベルの周囲に存在する反射体までの距離を計測する装置であり、計測データをコントローラ30に対して出力する。本実施例では、二次元走査型距離計測装置40は、半導体レーザを用いた二次元走査型レーザレンジファインダである。具体的には、二次元走査型距離計測装置40は、半導体レーザ発生器が発生させたレーザ光を回転ミラーで反射させて走査面上で放射状(例えば270度の範囲で0.2度毎)にレーザ光を出射する(図1の破線参照。)。そして、所定距離(例えば30メートル)の範囲内に存在する反射体からの反射光の時間遅れ又は位相遅れを検出してその反射体までの距離(以下、「反射体距離」とする。)を導き出す。また、二次元走査型距離計測装置40は、反射体距離に加え、そのときの回転ミラーの回転角度をコントローラ30に対して出力する。レーザ光の出射方向、すなわち反射体の存在方向(以下、「反射体方向」とする。)をコントローラ30が導出できるようにするためである。
The two-dimensional scanning
図3は、掘削アタッチメントの作業空間範囲WSと二次元走査型距離計測装置40の走査面との関係を示す図である。具体的には、図3(A)はショベルの上面図であり、図3(B)はショベルの側面図である。
FIG. 3 is a diagram showing the relationship between the work space range WS of the digging attachment and the scanning surface of the two-dimensional scanning
図3の太点線で表される空間範囲はショベルの作業空間範囲WSである。作業空間範囲WSは、掘削アタッチメントを動作させることでバケット6が到達可能な空間範囲である。具体的には、作業空間範囲WSは、図3(A)に示すように、バケット6のX軸方向における幅と同じ幅を有し、図3(B)に示すような側面WSFを+X側及び−X側に有する。
The space range represented by the thick dotted line in FIG. 3 is the work space range WS of the shovel. The work space range WS is a space range that the
図3(A)の一点鎖線で示す平面SPは、二次元走査型距離計測装置40の走査面を含む仮想平面である。図3(A)に示すように、平面SPは、作業空間範囲WSをX軸方向(幅方向)で2つに分割するように設定される。バケット6で掘削しようとする地面の表面に二次元走査型距離計測装置40のレーザ光が確実に当たるようにするためである。本実施例では、平面SPは、掘削アタッチメントの中心面と一致し、作業空間範囲WSを幅方向に二等分するように設定される。したがって、平面SPは、ショベルが水平面上に位置する場合には鉛直面を構成する。なお、掘削アタッチメントの中心面は掘削アタッチメントを幅方向に二等分する仮想平面である。そのため、二次元走査型距離計測装置40は、例えば、掘削アタッチメントの真下の空間内における上部旋回体3とブーム4との連結部分のところで上部旋回体3のフレームに取り付けられる。なお、平面SPは、望ましくは掘削アタッチメントの中心面に平行となるように設定される。しかしながら、本発明は、平面SPと中心面との間に角度が形成される構成を排除しない。
A plane SP indicated by an alternate long and short dash line in FIG. 3A is a virtual plane including the scan plane of the two-dimensional scanning
測位装置41は、ショベルの位置及び向き(方位)を測定する装置である。本実施例では、測位装置41は、GPS(Global Positioning System)受信機及び電子コンパスを含み、コントローラ30に対してショベルの位置及び向きに関する情報を出力する。電子コンパスは、例えば3軸磁気センサで構成される。また、測位装置41は、2つのGPS受信機で構成されるGPSコンパスであってもよい。
The
姿勢検出装置42は、ショベルの姿勢を検出する装置である。本実施例では、姿勢検出装置42は、機体傾斜センサ、ブーム角度センサ、アーム角度センサ、及びバケット角度センサを含む。具体的には、機体傾斜センサは、水平面に対する機体の傾斜を検出する角度センサである。また、ブーム角度センサは、上部旋回体3に対するブーム4の回動角度を検出する角度センサである。また、アーム角度センサは、ブーム4に対するアーム5の回動角度を検出する角度センサである。また、バケット角度センサは、アーム5に対するバケット6の回動角度を検出する角度センサである。そして、姿勢検出装置42は、検出した値をコントローラ30に対して出力する。なお、ブーム角度センサ、アーム角度センサ、及びバケット角度センサの少なくとも1つは、対応する油圧シリンダのストローク量を検出するストロークセンサ等の他のセンサで置き換えられてもよい。
The
記憶装置43は、各種情報を記憶する装置である。本実施例では、記憶装置43は、施工完了時の地形に関する情報である目標地形情報を記憶する。地形検知システム100は、各種記憶媒体、通信ネットワーク等を介して目標地形情報を取得して記憶装置43に記憶する。また、目標地形情報は、例えば世界測地系を用いて生成される。
The
記憶装置43は、さらに、後述する二次元走査型距離計測装置40が取得した地形に関する情報を世界測地系における位置情報に変換したものを記憶する。なお、この地形に関する情報は、世界測地系における位置情報に変換する前のものであってもよい。
The
表示装置50は、各種情報を表示する装置であり、例えば、各種画像情報を表示する車載ディスプレイを含む。本実施例では、表示装置50は、コントローラ30からの制御指令に応じて各種情報を表示する。
The
次に、コントローラ30が有する各種機能要素について説明する。
Next, various functional elements of the
地形取得部31は、ショベルの前方における現在の地形に関する情報を取得する機能要素である。本実施例では、地形取得部31は、二次元走査型距離計測装置40の出力に基づいてショベルの前方における現在の地形に関する情報を取得する。具体的には、地形取得部31は、二次元走査型距離計測装置40が出力する反射体距離及び反射体方向に基づいて現在の地形に関する情報を取得する。なお、現在の地形に関する情報は、二次元走査型距離計測装置40が計測した各計測点の座標を結ぶことで描画される反射体形状を含む。そして、地形取得部31は、その反射体形状の全部又は一部を、ショベルの前方にある地面の形状を表す地形として認識する。
The
また、地形取得部31は、取得した反射体形状から、掘削アタッチメントの形状に関する部分を除外して地形を導き出してもよい。具体的には、地形取得部31は、取得した反射体形状に、掘削アタッチメントの輪郭形状として予め記憶された所定の形状に対応する形状部分が含まれる場合、反射体形状からその形状部分を取り除いて地形を導き出してもよい。或いは、地形取得部31は、姿勢検出装置42の出力に基づいて現在の掘削アタッチメントの輪郭形状を導き出し、反射体形状からその輪郭形状に対応する形状部分を取り除いて地形を導き出してもよい。図1の太点線で示す形状ASは、二次元走査型距離計測装置40の出力に基づいて取得される反射体形状に含まれる掘削アタッチメントの輪郭形状を表す。また、図1の太実線で示す形状GSは、二次元走査型距離計測装置40の出力に基づいて取得される反射体形状から掘削アタッチメントの輪郭形状を取り除くことで導き出された地形を表す。なお、図1の一点鎖線で示す形状TSは、目標地形情報に含まれる施工完了時の地形を表す。
Further, the
座標変換部32は、現在の地形に関する情報を所望の測地基準系における位置情報に変換する機能要素である。本実施例では、座標変換部32は、測位装置41が出力する世界測地系におけるショベルの位置及び向きに関する情報と、地形取得部31が取得した二次元走査型距離計測装置40の位置を基準とする現在の地形に関する情報と、二次元走査型距離計測装置40及び測位装置41の所定の相対位置関係に関する情報とを取得する。そして、それら3種類の情報に基づいて、地形取得部31が取得した現在の地形に関する情報を世界測地系における位置情報に変換する。現在の地形に関する情報と目標地形情報とを比較できるようにするためである。
The coordinate
図4は、座標変換部32が現在の地形に関する情報を世界測地系における位置情報に変換する際に用いる計測座標系の構成例を示す。具体的には、図4(A)はショベルの側面図であり、図4(B)はショベルの上面図である。なお、世界測地系は、地球の重心に原点をおき、X軸をグリニッジ子午線と赤道との交点の方向に、Y軸を東経90度の方向に、そしてZ軸を北極の方向にとる三次元直交XYZ座標系である。
FIG. 4 shows a configuration example of a measurement coordinate system used when the coordinate
計測座標系は、測位装置41の位置P41に原点をおき、U軸をショベルの幅方向(左右方向)、V軸をショベルの前後方向に、そしてW軸をショベルの高さ方向(上下方向)にとる三次元直交UVW座標系である。また、W軸は、図4(A)の二点鎖線で示すショベルの旋回軸に平行であり、VW平面は、二次元走査型距離計測装置40の走査面を含む仮想平面である平面SPを含む。また、二次元走査型距離計測装置40の位置P40のUVW座標系における座標値は設計で決まる値であるため予め設定される。そのため、座標変換部32は、二次元走査型距離計測装置40の位置P40のUVW座標系における座標と、地形取得部31が取得した二次元走査型距離計測装置40の位置P40を基準とする現在の地形に関する情報とに基づき、現在の地形を表す各反射点のUVW座標系における座標を取得できる。
The measurement coordinate system sets the origin at position P41 of the
具体的には、1つの反射点DPのUVW座標系における座標値は、反射体方向によって決まる角度θと反射体距離Dと位置P40の座標値とに基づいて決定される。 Specifically, the coordinate value in the UVW coordinate system of one reflection point DP is determined based on the angle θ determined by the reflector direction, the reflector distance D, and the coordinate value of the position P40.
また、座標変換部32は、機体傾斜センサの出力に基づいてXYZ座標系に対するUVW座標系の傾きを導き出す。そして、その傾きを補正する演算、すなわちU軸、V軸、W軸をX軸、Y軸、Z軸に一致させる座標変換を行うことで反射点DPのXYZ座標系における座標を取得できる。
The coordinate
その後、座標変換部32は、世界測地系における位置情報に変換された現在の地形に関する情報を記憶装置43に記憶すると共に、現在の地形に関する情報と目標地形情報とを比較できるように両者を表示装置50に表示させる。例えば、座標変換部32は、図1に示すような関係を表示装置50に表示させる。具体的には、掘削対象となっている地面の現在の地形と施工完了時の目標地形とを断面表示させる。
After that, the coordinate
次に、図5を参照し、ショベルの周囲におけるより広い地面領域の形状を検知する方法について説明する。なお、図5(A)は、旋回動作を利用してより広い地面領域の形状を検知する場合のショベルの動きを示すショベルの上面図であり、図5(B)は、走行動作を利用してより広い地面領域の形状を検知する場合のショベルの動きを表すショベルの上面図である。 Next, referring to FIG. 5, a method of detecting the shape of a wider ground area around the shovel will be described. 5 (A) is a top view of the shovel showing the movement of the shovel in the case of detecting the shape of a wider ground area using the turning operation, and FIG. 5 (B) is a traveling operation. It is a top view of a shovel showing movement of a shovel in the case of detecting the shape of a bigger ground area.
図5(A)に示すように、下部走行体1を停止させた状態で上部旋回体3を時計回りに旋回させてショベルの向きを変えることで、地形検知システム100は、ドットハッチングで表される領域の地形を検知できる。この場合、地形検知システム100は、電子コンパス、GPSコンパス等の旋回角度検出装置の出力を用い、地形取得部31が取得した現在の地形に関する情報を補正してもよい。なお、地形検知システム100は、下部走行体1によりショベルをピボットターン(超信地旋回)させた場合にも同様の領域の地形を検知できる。
As shown in FIG. 5A, the
また、図5(B)に示すように、下部走行体1と上部旋回体3との間の相対角度が90度の状態で上部旋回体3を固定したまま下部走行体1を図の右側に移動させてショベルの位置を変えることで、地形検知システム100は、ドットハッチングで表される領域の地形を検知できる。この場合、地形検知システム100は、GPS受信機等の走行距離検出装置の出力を用い、地形取得部31が取得した現在の地形に関する情報を補正してもよい。
Further, as shown in FIG. 5 (B), while the upper swing body 3 is fixed in a state in which the relative angle between the
これにより、地形検知システム100は、より広い地面領域の形状を空間的(三次元的)に簡易且つ迅速に検知でき、記憶装置43に記憶することができる。そして、そのような広い地面領域の形状に関する情報により、例えば、掘削対象となっている地面の現在の地形を示す等高図を表示させることができる。また、掘削対象となっている地面の現在の地形を示す等高図と施工完了時の目標地形を示す等高図とを同時に表示させることができる。
As a result, the
以上の構成により、地形検知システム100は、掘削の対象となる地面の現在の地形を掘削直前に且つ掘削毎に検知して表示する。そのため、ショベルの操作者は、目標地形情報と現在の地形に関する情報とを比較し、どの程度埋めるのか或いは掘るのかをその都度確認できる。また、掘削作業中の現在の地形が目標地形と一致しているか否かを確認できる。また、地形検知システム100は、二次元走査型距離計測装置40を用いた単純な構成を採用するため、三次元レーザスキャナを採用する場合に比べ、掘削の対象となる地面の現在の地形の検知を低コストで実現できる。
With the above configuration, the
次に、図6を参照し、二次元走査型距離計測装置40の別の取り付け例について説明する。なお、図6(A)は、二次元走査型距離計測装置40の別の取り付け例を示すショベルの側面図であり、図1に対応する。また、図6(B)は、座標変換部32が座標変換の際に用いる計測座標系の構成例を示す図であり、図4(A)に対応する。また、図6(A)の太点線で示す形状ASは、二次元走査型距離計測装置40の出力に基づいて取得される反射体形状に含まれる掘削アタッチメントの輪郭形状を表す。また、図6(A)の太実線で示す形状GSは、反射体形状から掘削アタッチメントの輪郭形状を取り除くことで導き出された地形を表す。なお、図6(A)の一点鎖線で示す形状TSは、目標地形情報に含まれる施工完了時の地形を表す。
Next, another mounting example of the two-dimensional scanning
図6(A)において、二次元走査型距離計測装置40は、ブーム4の腹面(図の+Y側の面)の所定位置に取り付けられる。そのため、二次元走査型距離計測装置40の位置は、ブーム4の姿勢の変化に応じて変化する。そのため、座標変換部32は、姿勢検出装置42の出力に基づいて二次元走査型距離計測装置40と測位装置41との間の相対位置関係を導き出す。なお、二次元走査型距離計測装置40は、ブーム4の側面(+X側の面又は−X側の面)に取り付けられてもよい。
In FIG. 6 (A), the two-dimensional scanning
本実施例では、座標変換部32は、ブーム角度センサの出力から導き出される上部旋回体3に対するブーム4の姿勢に基づいてその相対位置関係を導き出す。具体的には、二次元走査型距離計測装置40の位置P40のUVW座標系における座標値は、図6(B)に示すように、ブームフートピンPbの位置のUVW座標系における座標値と、ブームフートピンPbから二次元走査型距離計測装置40の取り付け位置までの距離L1と、角度αとに基づいて決定される。なお、ブームフートピンPbの位置のUVW座標系における座標値及び距離L1は設計で決まる値であるため予め設定される。また、角度αは、例えば、ブーム角度センサの出力値である。
In the present embodiment, the coordinate
そのため、座標変換部32は、二次元走査型距離計測装置40の位置P40のUVW座標系における座標と、地形取得部31が取得した二次元走査型距離計測装置40の位置P40を基準とする現在の地形に関する情報とに基づき、現在の地形を表す各反射点のUVW座標系における座標を取得できる。
Therefore, the coordinate
具体的には、1つの反射点DPのUVW座標系における座標値は、反射体方向によって決まる角度θと反射体距離Dと位置P40の座標値とに基づいて決定される。 Specifically, the coordinate value in the UVW coordinate system of one reflection point DP is determined based on the angle θ determined by the reflector direction, the reflector distance D, and the coordinate value of the position P40.
また、座標変換部32は、機体傾斜センサの出力に基づいてXYZ座標系に対するUVW座標系の傾きを導き出す。そして、その傾きを補正する演算、すなわちU軸、V軸、W軸をX軸、Y軸、Z軸に一致させる座標変換を行うことで反射点DPのXYZ座標系における座標を取得できる。
The coordinate
なお、座標変換部32は、二次元走査型距離計測装置40の出力に基づいて二次元走査型距離計測装置40と測位装置41との間の相対位置関係を導き出してもよい。具体的には、二次元走査型距離計測装置40が取得する、上部旋回体3とブーム4との連結部分の輪郭形状から上部旋回体3に対するブーム4の姿勢を導き出し、その上で、二次元走査型距離計測装置40と測位装置41との間の相対位置関係を導き出す。
The coordinate
その後、座標変換部32は、測位装置41が出力する世界測地系におけるショベルの位置及び向きに関する情報と、地形取得部31が取得した二次元走査型距離計測装置40の位置を基準とする現在の地形に関する情報と、二次元走査型距離計測装置40及び測位装置41の相対位置関係とに基づいて、二次元走査型距離計測装置40が取得した地形に関する情報を世界測地系における位置情報に変換し、記憶装置43に記憶する。
After that, the coordinate
次に、図7を参照し、二次元走査型距離計測装置40のさらに別の取り付け例について説明する。なお、図7(A)は、二次元走査型距離計測装置40のさらに別の取り付け例を示すショベルの側面図であり、図1及び図6(A)に対応する。また、図7(B)は、座標変換部32が座標変換の際に用いる計測座標系の構成例を示す図であり、図4(A)及び図6(B)に対応する。また、図7(A)の太点線で示す形状ASは、二次元走査型距離計測装置40の出力に基づいて取得される反射体形状に含まれる掘削アタッチメントの輪郭形状を表す。また、図7(A)の太実線で示す形状GSは、反射体形状から掘削アタッチメントの輪郭形状を取り除くことで導き出された地形を表す。なお、図7(A)の一点鎖線で示す形状TSは、目標地形情報に含まれる施工完了時の地形を表す。
Next, referring to FIG. 7, still another mounting example of the two-dimensional scanning
図7(A)において、二次元走査型距離計測装置40は、アーム5の腹面(図の−Z側の面)の所定位置に取り付けられる。そのため、二次元走査型距離計測装置40の位置は、ブーム4及びアーム5の少なくとも一方の姿勢の変化に応じて変化する。そのため、座標変換部32は、姿勢検出装置42の出力に基づいて二次元走査型距離計測装置40と測位装置41との間の相対位置関係を導き出す。なお、二次元走査型距離計測装置40は、アーム5の側面(+X側の面又は−X側の面)に取り付けられてもよい。
In FIG. 7A, the two-dimensional scanning
本実施例では、座標変換部32は、ブーム角度センサの出力から導き出される上部旋回体3に対するブーム4の姿勢と、アーム角度センサの出力から導き出されるブーム4に対するアーム5の姿勢とに基づいてその相対位置関係を導き出す。具体的には、二次元走査型距離計測装置40の位置P40のUVW座標系における座標値は、図7(B)に示すように、ブームフートピンPbの位置のUVW座標系における座標値と、ブームフートピンPbからアーム連結ピンPaまでの距離L2と、角度αと、アーム連結ピンPaから二次元走査型距離計測装置40までの距離L3と、角度βとに基づいて決定される。なお、ブームフートピンPbの位置のUVW座標系における座標値、距離L2、及び距離L3は設計で決まる値であるため予め設定される。また、角度αは、例えば、ブーム角度センサの出力値であり、角度βは、例えば、アーム角度センサの出力値である。
In the present embodiment, the coordinate
そのため、座標変換部32は、二次元走査型距離計測装置40の位置P40のUVW座標系における座標と、地形取得部31が取得した二次元走査型距離計測装置40の位置P40を基準とする現在の地形に関する情報とに基づき、現在の地形を表す各反射点のUVW座標系における座標を取得できる。
Therefore, the coordinate
具体的には、1つの反射点DPのUVW座標系における座標値は、反射体方向によって決まる角度θと反射体距離Dと位置P40の座標値とに基づいて決定される。 Specifically, the coordinate value in the UVW coordinate system of one reflection point DP is determined based on the angle θ determined by the reflector direction, the reflector distance D, and the coordinate value of the position P40.
また、座標変換部32は、機体傾斜センサの出力に基づいてXYZ座標系に対するUVW座標系の傾きを導き出す。そして、その傾きを補正する演算、すなわちU軸、V軸、W軸をX軸、Y軸、Z軸に一致させる座標変換を行うことで反射点DPのXYZ座標系における座標を取得できる。
The coordinate
なお、座標変換部32は、二次元走査型距離計測装置40の出力に基づいて二次元走査型距離計測装置40と測位装置41との間の相対位置関係を導き出してもよい。具体的には、二次元走査型距離計測装置40が取得する、上部旋回体3とブーム4との連結部分の輪郭形状から上部旋回体3に対するブーム4の姿勢を導き出す。また、二次元走査型距離計測装置40が取得する、ブーム4の輪郭形状からブーム4に対するアーム5の姿勢を導き出す。その上で、二次元走査型距離計測装置40と測位装置41との間の相対位置関係を導き出す。
The coordinate
その後、座標変換部32は、測位装置41が出力する世界測地系におけるショベルの位置及び向きに関する情報と、地形取得部31が取得した二次元走査型距離計測装置40の位置を基準とする現在の地形に関する情報と、二次元走査型距離計測装置40及び測位装置41の相対位置関係とに基づいて、二次元走査型距離計測装置40が取得した地形に関する情報を世界測地系における位置情報に変換し、記憶装置43に記憶する。
After that, the coordinate
このように、二次元走査型距離計測装置40がブーム4又はアーム5に取り付けられた場合、地形検知システム100は、上述の効果に加え、機体の近くを深掘りするときでも深掘りした地形を確実に検知して表示できるという追加的な効果を奏する。そのため、ショベルの操作者は、ショベル又は地面の死角に入って見えないところにある地形を認識できる。
Thus, when the two-dimensional scanning type
以上、本発明の好ましい実施例について詳説したが、本発明は、上述した実施例に制限されることはなく、本発明の範囲を逸脱することなしに上述した実施例に種々の変形及び置換を加えることができる。 Although the preferred embodiments of the present invention have been described above in detail, the present invention is not limited to the above-described embodiments, and various modifications and substitutions may be made to the above-described embodiments without departing from the scope of the present invention. It can be added.
例えば、上述の実施例では、二次元走査型距離計測装置40は、上部旋回体3のフレーム又は掘削アタッチメントに1つだけ取り付けられる。しかしながら、本発明はこの構成に限定されるものではない。例えば、二次元走査型距離計測装置40は、上部旋回体3のフレーム又は掘削アタッチメントに複数個取り付けられてもよい。
For example, in the above-described embodiment, only one two-dimensional scanning
また、二次元走査型距離計測装置40は、上部旋回体3のフレーム又は掘削アタッチメントにおける複数の所定の取り付け位置の1又は複数に取り外し可能に取り付けられてもよい。この場合、利用者は必要に応じて二次元走査型距離計測装置40の取り付け位置を変更できる。
In addition, the two-dimensional scanning
また、二次元走査型距離計測装置40は、上部旋回体3のフレーム又は掘削アタッチメントにおける任意の位置に取り外し可能に取り付けられてもよい。この場合、利用者は、二次元走査型距離計測装置40の取り付け位置とアーム連結ピンPa、ブームフートピンPb、又は測位装置41との間の相対位置関係をコントローラ30に事前に入力すればよい。
Also, the two-dimensional scanning type
1・・・下部走行体 2・・・旋回機構 3・・・上部旋回体 4・・・ブーム 5・・・アーム 6・・・バケット 7・・・ブームシリンダ 8・・・アームシリンダ 9・・・バケットシリンダ 10・・・キャビン 30・・・コントローラ 31・・・地形取得部 32・・・座標変換部 40・・・二次元走査型距離計測装置 41・・・測位装置 42・・・姿勢検出装置 43・・・記憶装置 50・・・表示装置 100・・・地形検知システム Pa・・・アーム連結ピン Pb・・・ブームフートピン WS・・・作業空間範囲 WSF・・・作業空間範囲の側面
1 ... lower traveling body 2 ... turning mechanism 3 ... upper swing body 4 ... boom 5 ...
Claims (12)
前記下部走行体に旋回自在に搭載される上部旋回体と、
前記上部旋回体に取り付けられ、アタッチメントに含まれるブームと、
前記ブームに取り付けられ、前記アタッチメントに含まれるアームと、
前記上部旋回体に搭載され、レーザ光を出射し反射体までの距離を反射光により計測する装置と、
前記反射体までの距離を反射光により計測する装置の出力に基づいて反射体形状に関する情報を導き出し、前記反射体形状に関する情報から前記アタッチメントの形状に関する部分を除外して地形に関する情報を導き出す制御装置と、
を備えるショベル。 A lower traveling body that performs traveling operation,
An upper revolving unit rotatably mounted on the lower traveling unit;
A boom attached to the upper swing body and included in an attachment;
An arm attached to the boom and included in the attachment;
A device mounted on the upper revolving superstructure, which emits laser light and measures the distance to the reflector by reflected light ;
A controller for deriving information on a reflector shape based on an output of a device which measures a distance to the reflector by reflected light, and for deriving information on a topography by excluding a portion on the shape of the attachment from the information on the reflector shape When,
Excavator equipped with
前記制御装置は、前記測位装置から得られるショベルの位置及び向きに関する情報に基づき、前記地形に関する情報を、所定の座標に基づく位置情報へ変換する、
請求項1に記載のショベル。 And a positioning device mounted on the upper swing body,
The control device converts the information on the terrain into position information based on predetermined coordinates, based on the information on the position and orientation of the shovel obtained from the positioning device.
The shovel according to claim 1 .
請求項2に記載のショベル。 The control device compares position information based on the converted predetermined coordinates with target topography information.
The shovel according to claim 2 .
請求項1乃至3の何れかに記載のショベル。 The device for measuring the distance to the reflector by reflected light is a three-dimensional laser scanner,
The shovel according to any one of claims 1 to 3 .
請求項1乃至3の何れかに記載のショベル。 The device for measuring the distance to the reflector by reflected light is a two-dimensional scanning distance measuring device,
The shovel according to any one of claims 1 to 3 .
請求項1乃至5の何れかに記載のショベル。 An apparatus for measuring the distance to the reflector by reflected light is attached to the attachment or an airframe to which the attachment is connected.
The shovel according to any one of claims 1 to 5 .
請求項1乃至6の何れか一項に記載のショベル。 The control device detects the terrain around the shovel based on the output of a device that measures the distance to the reflector at different orientations or positions using the turning operation or traveling operation of the shovel based on reflected light .
The shovel as described in any one of Claims 1 thru | or 6 .
請求項1乃至7の何れか一項に記載のショベル。 The control device detects topography as position information in a three-dimensional coordinate system based on the front-rear direction, the left-right direction, and the up-down direction of the shovel.
The shovel as described in any one of Claims 1 thru | or 7 .
請求項1乃至8の何れか一項に記載のショベル。 The control device causes the display device to display information on current topography and target topography information detected based on an output of a device that measures the distance to the reflector by reflected light .
The shovel according to any one of claims 1 to 8 .
請求項1乃至9の何れか一項に記載のショベル。 The control device derives the shape of the attachment based on the output of a device that measures the distance to the reflector by reflected light .
The shovel as described in any one of Claims 1 thru | or 9 .
請求項10に記載のショベル。 The control device removes the contour of the attachment from the output of a device that measures the distance to the reflector with reflected light .
The shovel according to claim 10 .
前記制御装置は、前記姿勢検出装置の出力に基づいて前記アタッチメントの形状を導出する、
請求項1に記載のショベル。 And a posture detection device for detecting the posture of the shovel.
The control device derives the shape of the attachment based on the output of the posture detection device.
The shovel according to claim 1.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014131541A JP6538315B2 (en) | 2014-06-26 | 2014-06-26 | Shovel |
JP2019105985A JP6987808B2 (en) | 2014-06-26 | 2019-06-06 | Excavator |
JP2021195525A JP7301937B2 (en) | 2014-06-26 | 2021-12-01 | Excavator and terrain detection system for excavator |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014131541A JP6538315B2 (en) | 2014-06-26 | 2014-06-26 | Shovel |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019105985A Division JP6987808B2 (en) | 2014-06-26 | 2019-06-06 | Excavator |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2016008484A JP2016008484A (en) | 2016-01-18 |
JP2016008484A5 JP2016008484A5 (en) | 2017-09-07 |
JP6538315B2 true JP6538315B2 (en) | 2019-07-03 |
Family
ID=55226237
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2014131541A Active JP6538315B2 (en) | 2014-06-26 | 2014-06-26 | Shovel |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6538315B2 (en) |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6681747B2 (en) * | 2016-03-02 | 2020-04-15 | 株式会社神戸製鋼所 | Attachment recognition device |
US10738441B2 (en) * | 2016-03-09 | 2020-08-11 | Leica Geosystems Technology A/S | Measuring equipment for determining the result of earthmoving work |
JP7210129B2 (en) * | 2016-03-16 | 2023-01-23 | 住友重機械工業株式会社 | Excavator |
WO2017159744A1 (en) * | 2016-03-16 | 2017-09-21 | 住友重機械工業株式会社 | Shovel |
WO2017176773A1 (en) * | 2016-04-08 | 2017-10-12 | Ace/Avant Concrete Construction Co., Inc. | Excavation measurement |
JP2018031153A (en) * | 2016-08-23 | 2018-03-01 | 清水建設株式会社 | Sensor storage device for construction machine |
JP6794193B2 (en) * | 2016-09-02 | 2020-12-02 | 株式会社小松製作所 | Image display system for work machines |
KR101855988B1 (en) | 2016-12-29 | 2018-05-09 | 주식회사 아이지오스캔 | System for topography measuring and construction machine having the same |
FI127505B (en) | 2017-01-18 | 2018-08-15 | Novatron Oy | Earth moving machine, range finder arrangement and method for 3d scanning |
JP6760163B2 (en) * | 2017-03-22 | 2020-09-23 | コベルコ建機株式会社 | Construction machinery |
JP7386592B2 (en) * | 2018-03-22 | 2023-11-27 | 株式会社フジタ | Construction machinery operation assistance system |
JP2019167720A (en) * | 2018-03-22 | 2019-10-03 | 株式会社フジタ | Automatic control system for construction machine |
JP6946227B2 (en) | 2018-03-29 | 2021-10-06 | 株式会社小松製作所 | Work vehicle control systems, methods, and work vehicles |
JP7023813B2 (en) * | 2018-08-27 | 2022-02-22 | 日立建機株式会社 | Work machine |
JP2020056169A (en) * | 2018-09-28 | 2020-04-09 | 東起業株式会社 | Construction machine equipped with approach notification function on ground and underground and capable of acquiring construction data for new buried objects |
JP7149205B2 (en) * | 2019-03-05 | 2022-10-06 | 日立建機株式会社 | self-driving work machine |
JP7346061B2 (en) * | 2019-03-29 | 2023-09-19 | 住友建機株式会社 | excavator |
JP2020197044A (en) * | 2019-05-31 | 2020-12-10 | 株式会社小松製作所 | Map generating system, and map generating method |
US11200654B2 (en) | 2019-08-14 | 2021-12-14 | Cnh Industrial America Llc | System and method for determining field characteristics based on a displayed light pattern |
US20230313502A1 (en) * | 2022-04-05 | 2023-10-05 | Caterpillar Sarl | Trench measurement system |
JP2024042417A (en) * | 2022-09-15 | 2024-03-28 | 株式会社トプコン | Computing device, computing method and program |
JP2024046228A (en) * | 2022-09-22 | 2024-04-03 | 株式会社トプコン | Computing device, computing method and program |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6736216B2 (en) * | 2000-05-05 | 2004-05-18 | Leica Geosystems Gr, Llc | Laser-guided construction equipment |
JP4671317B2 (en) * | 2001-05-02 | 2011-04-13 | 株式会社小松製作所 | Terrain shape measuring device and guidance device |
JP2004294067A (en) * | 2003-03-25 | 2004-10-21 | Penta Ocean Constr Co Ltd | Full automation construction system |
JP5556525B2 (en) * | 2010-09-14 | 2014-07-23 | コニカミノルタ株式会社 | Laser distance measuring device |
JP5759798B2 (en) * | 2011-06-08 | 2015-08-05 | 株式会社トプコン | Construction machine control system |
JP5549646B2 (en) * | 2011-06-22 | 2014-07-16 | コベルコ建機株式会社 | Abnormal displacement detection device for construction machine work members |
-
2014
- 2014-06-26 JP JP2014131541A patent/JP6538315B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2016008484A (en) | 2016-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6538315B2 (en) | Shovel | |
JP7285051B2 (en) | Display control device and display control method | |
WO2020241618A1 (en) | Map generation system and map generation method | |
JP2016160741A (en) | Image display system for work machine, remote operation system for work machine, and work machine | |
JP6618856B2 (en) | Construction system and construction method | |
JP5247938B1 (en) | Construction machinery | |
JP7372029B2 (en) | Display control device, display control system, and display control method | |
JP2018059400A (en) | Construction management system | |
JP6710493B2 (en) | Construction machinery and excavators | |
JP2024052764A (en) | Display control device and display method | |
JP6616149B2 (en) | Construction method, work machine control system, and work machine | |
JP6889675B2 (en) | Method of detecting the position of the construction end of a turning work vehicle and a turning work vehicle | |
JP7301937B2 (en) | Excavator and terrain detection system for excavator | |
JP6987808B2 (en) | Excavator | |
KR20230002979A (en) | Information Acquisition System and Information Acquisition Method | |
JP7195903B2 (en) | Excavator | |
WO2022070707A1 (en) | Display control device and display control method | |
JP7263287B2 (en) | working machine | |
JP7065002B2 (en) | Work machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A625 | Written request for application examination (by other person) |
Free format text: JAPANESE INTERMEDIATE CODE: A625 Effective date: 20161018 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20170725 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170908 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20171107 |
|
A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20180105 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180219 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180731 |
|
A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20181001 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20181129 |
|
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: 20190507 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190606 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6538315 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |