(57)【特許請求の範囲】
【請求項１】
下部走行体と、
前記下部走行体に旋回可能に搭載される上部旋回体と、
前記上部旋回体に取り付けられる角速度センサと、
旋回操作情報と前記角速度センサの出力とに基づいて前記上部旋回体の旋回角度を算出する演算処理装置と、
前記上部旋回体に取り付けられる地磁気センサと、を備え、
前記演算処理装置は、前記地磁気センサの出力を用いて旋回角度を算出する、
ショベル。
【請求項２】
前記演算処理装置は、前記旋回操作情報に基づいて前記上部旋回体が旋回していないと判定した場合、前記角速度センサの出力に基づく旋回角度の算出を中止する、
請求項１に記載のショベル。
【請求項３】
前記旋回操作情報は、旋回操作レバーのパイロット圧を含む、
請求項１又は２に記載のショベル。
【請求項４】
前記演算処理装置は、前記地磁気センサの出力が所定の条件を満たしている場合に、前記地磁気センサの出力を用いて旋回角度を算出する、
請求項１乃至３の何れか一項に記載のショベル。
【請求項５】
前記演算処理装置は、前記上部旋回体が旋回していない場合に、前記地磁気センサの出力を用いて旋回角度を算出する、
請求項１乃至４の何れか一項に記載のショベル。
【請求項６】
前記演算処理装置は、前記下部走行体に対する前記上部旋回体の旋回角度を算出する、
請求項１乃至５の何れか一項に記載のショベル。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、旋回角度を導出する機能を備えたショベルに関する。
【背景技術】
【０００２】
旋回体に取り付けられたジャイロセンサの出力に基づいて走行体に対する旋回体の旋回角度を導出するショベルが知られている（例えば、特許文献１参照）。
【０００３】
また、旋回体及び走行体のそれぞれに取り付けられた一対の地磁気センサの出力差から走行体に対する旋回体の旋回角度を導出するショベルが知られている（例えば、特許文献２参照）。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００５−６１０２４号公報
【特許文献２】特開平９−２１６０５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、特許文献１の構成は、ジャイロセンサの出力である角速度を積算して旋回角度を算出するため、算出した旋回角度にはジャイロセンサ出力におけるノイズが積算されて大きな誤差が生じるおそれがある。また、特許文献２の地磁気センサは、周囲の磁場の影響を受け易いため、旋回角度を安定的に出力できないおそれがある。
【０００６】
上述に鑑み、より小さい誤差で安定的に旋回角度を導出できるショベルを提供することが望ましい。
【課題を解決するための手段】
【０００７】
本発明の実施例に係るショベルは、下部走行体と、前記下部走行体に旋回可能に搭載される上部旋回体と、前記上部旋回体に取り付けられる角速度センサと、旋回操作情報と前記角速度センサの出力とに基づいて前記上部旋回体の旋回角度を算出する演算処理装置と、前記上部旋回体に取り付けられる地磁気センサと、を備え、前記演算処理装置は、前記地磁気センサの出力を用いて旋回角度を算出する。
【発明の効果】
【０００８】
上述の手段により、より小さい誤差で安定的に旋回角度を導出できるショベルを提供できる。
【図面の簡単な説明】
【０００９】
【図１】本発明の実施例に係るショベルの側面図である。
【図２】図１のショベルの駆動系の構成を示す図である。
【図３】マシンガイダンス装置の構成例を示すブロック図である。
【図４】旋回角度導出処理のフローチャートである。
【図５】旋回操作が断続的に行われたときの各種物理量の時間的推移を示す図である。
【発明を実施するための形態】
【００１０】
図１は本発明の実施例に係るショベル（掘削機）の側面図である。ショベルの下部走行体１には旋回機構２を介して上部旋回体３が旋回可能に搭載される。上部旋回体３にはブーム４が取り付けられる。ブーム４の先端にはアーム５が取り付けられ、アーム５の先端にはエンドアタッチメントとしてのバケット６が取り付けられる。エンドアタッチメントとして、法面用バケット、浚渫用バケット等が用いられてもよい。
【００１１】
ブーム４、アーム５、及びバケット６は、アタッチメントの一例として掘削アタッチメントを構成し、ブームシリンダ７、アームシリンダ８、及びバケットシリンダ９によりそれぞれ油圧駆動される。ブーム４にはブーム角度センサＳ１が取り付けられ、アーム５にはアーム角度センサＳ２が取り付けられ、バケット６にはバケット角度センサＳ３が取り付けられる。掘削アタッチメントには、バケットチルト機構が設けられてもよい。
【００１２】
ブーム角度センサＳ１はブーム４の回動角度を検出する。本実施例では、ブーム角度センサＳ１は水平面に対する傾斜を検出して上部旋回体３に対するブーム４の回動角度を検出する加速度センサである。
【００１３】
アーム角度センサＳ２はアーム５の回動角度を検出する。本実施例では、アーム角度センサＳ２は水平面に対する傾斜を検出してブーム４に対するアーム５の回動角度を検出する加速度センサである。
【００１４】
バケット角度センサＳ３はバケット６の回動角度を検出する。本実施例では、バケット角度センサＳ３は水平面に対する傾斜を検出してアーム５に対するバケット６の回動角度を検出する加速度センサである。掘削アタッチメントがバケットチルト機構を備える場合、バケット角度センサＳ３はチルト軸回りのバケット６の回動角度を追加的に検出する。
【００１５】
ブーム角度センサＳ１、アーム角度センサＳ２、及びバケット角度センサＳ３は、可変抵抗器を利用したポテンショメータ、対応する油圧シリンダのストローク量を検出するストロークセンサ、連結ピン回りの回動角度を検出するロータリエンコーダ等であってもよい。
【００１６】
上部旋回体３にはキャビン１０が設けられ且つエンジン１１等の動力源が搭載される。また、上部旋回体３には機体傾斜センサＳ４、旋回角速度センサＳ５、カメラＳ６、通信装置Ｓ７、測位装置Ｓ８、地磁気センサＳ９が取り付けられる。
【００１７】
機体傾斜センサＳ４は水平面に対する上部旋回体３の傾斜を検出する。本実施例では、機体傾斜センサＳ４は上部旋回体３の前後軸及び左右軸回りの傾斜角を検出する２軸加速度センサである。なお、上部旋回体３の前後軸及び左右軸は、例えば、互いに直交してショベルの旋回軸上の一点であるショベル中心点を通る。機体傾斜センサＳ４は、３軸加速度センサであってもよい。
【００１８】
旋回角速度センサＳ５は、上部旋回体３の旋回角速度を導出する。本実施例では、旋回角速度センサＳ５はジャイロセンサである。
【００１９】
カメラＳ６はショベルの周辺の画像を取得する撮像装置である。本実施例では、カメラＳ６は上部旋回体３に取り付けられる１又は複数台のカメラである。
【００２０】
通信装置Ｓ７は、ショベルと外部との間の通信を制御する装置である。通信装置Ｓ７は、例えば、ＧＮＳＳ（Global Navigation Satellite System）等の測量システムとショベルとの間の無線通信を制御する。ショベルは、通信装置Ｓ７を用いることで無線通信を介して目標施工面に関する情報等を含む設計データを取得できる。但し、ショベルは、半導体メモリ等を用いて設計データを取得してもよい。
【００２１】
測位装置Ｓ８は、ショベルの位置及び向きを測定する装置である。本実施例では、測位装置Ｓ８は、電子コンパスを組み込んだＧＮＳＳ受信機であり、ショベルの存在位置の緯度、経度、高度を測定し、且つ、ショベルの向きを測定する。
【００２２】
地磁気センサＳ９は地磁気を検出するセンサである。本実施例では、地磁気センサＳ９は３軸地磁気センサである。地磁気センサＳ９は、上部旋回体３に取り付けられた上部地磁気センサと下部走行体１に取り付けられた下部地磁気センサとの組み合わせで構成されてもよい。
【００２３】
キャビン１０内には、入力装置Ｄ１、音声出力装置Ｄ２、表示装置Ｄ３、記憶装置Ｄ４、ゲートロックレバーＤ５、コントローラ３０、及びマシンガイダンス装置５０が設置される。
【００２４】
コントローラ３０は、ショベルの駆動制御を行う主制御部として機能する。本実施例では、コントローラ３０は、ＣＰＵ及び内部メモリを含む演算処理装置で構成される。コントローラ３０の各種機能は、ＣＰＵが内部メモリに格納されたプログラムを実行することで実現される。
【００２５】
マシンガイダンス装置５０は、ショベルの操作をガイドする。本実施例では、マシンガイダンス装置５０は、例えば、操作者が設定した目標施工面とバケット６の先端（爪先）位置との鉛直方向における距離を視覚的に且つ聴覚的に操作者に報知する。これにより、マシンガイダンス装置５０は操作者によるショベルの操作をガイドする。なお、マシンガイダンス装置５０は、その距離を視覚的に操作者に知らせるのみであってもよく、聴覚的に操作者に知らせるのみであってもよい。具体的には、マシンガイダンス装置５０は、コントローラ３０と同様、ＣＰＵ及び内部メモリを含む演算処理装置で構成される。マシンガイダンス装置５０の各種機能はＣＰＵが内部メモリに格納されたプログラムを実行することで実現される。マシンガイダンス装置５０は、コントローラ３０とは別個に設けられてもよく、或いは、コントローラ３０に組み込まれていてもよい。
【００２６】
入力装置Ｄ１は、ショベルの操作者がマシンガイダンス装置５０に各種情報を入力するための装置である。本実施例では、入力装置Ｄ１は、表示装置Ｄ３の周囲に取り付けられるメンブレンスイッチである。入力装置Ｄ１としてタッチパネル等が用いられてもよい。
【００２７】
音声出力装置Ｄ２は、マシンガイダンス装置５０からの音声出力指令に応じて各種音声情報を出力する。本実施例では、音声出力装置Ｄ２として、マシンガイダンス装置５０に直接接続される車載スピーカが利用される。なお、音声出力装置Ｄ２として、ブザー等の警報器が利用されてもよい。
【００２８】
表示装置Ｄ３は、マシンガイダンス装置５０からの指令に応じて各種画像情報を出力する。本実施例では、表示装置Ｄ３として、マシンガイダンス装置５０に直接接続される車載液晶ディスプレイが利用される。
【００２９】
記憶装置Ｄ４は、各種情報を記憶するための装置である。本実施例では、記憶装置Ｄ４として、半導体メモリ等の不揮発性記憶媒体が用いられる。記憶装置Ｄ４は、マシンガイダンス装置５０等が出力する各種情報を記憶する。
【００３０】
ゲートロックレバーＤ５は、ショベルが誤って操作されるのを防止する機構である。本実施例では、ゲートロックレバーＤ５は、キャビン１０のドアと運転席との間に配置される。キャビン１０から操作者が退出できないようにゲートロックレバーＤ５が引き上げられた場合に、各種操作装置は操作可能となる。一方、キャビン１０から操作者が退出できるようにゲートロックレバーＤ５が押し下げられた場合には、各種操作装置は操作不能となる。
【００３１】
図２は、図１のショベルの駆動系の構成例を示す図である。図２において、機械的動力系は二重線、高圧油圧ラインは太実線、パイロットラインは破線、電気駆動・制御系は細実線でそれぞれ示される。
【００３２】
エンジン１１はショベルの動力源である。本実施例では、エンジン１１は、エンジン負荷の増減にかかわらずエンジン回転数を一定に維持するアイソクロナス制御を採用したディーゼルエンジンである。エンジン１１における燃料噴射量、燃料噴射タイミング、ブースト圧等は、エンジンコントローラユニット（ＥＣＵ）Ｄ７により制御される。
【００３３】
エンジン１１には油圧ポンプとしてのメインポンプ１４及びパイロットポンプ１５が接続される。メインポンプ１４には高圧油圧ラインを介してコントロールバルブ１７が接続される。
【００３４】
コントロールバルブ１７は、ショベルの油圧系の制御を行う油圧制御装置である。右側走行用油圧モータ、左側走行用油圧モータ、ブームシリンダ７、アームシリンダ８、バケットシリンダ９、旋回用油圧モータ等の油圧アクチュエータは、高圧油圧ラインを介してコントロールバルブ１７に接続される。なお、旋回用油圧モータは旋回用電動発電機であってもよい。
【００３５】
パイロットポンプ１５にはパイロットラインを介して操作装置２６が接続される。操作装置２６はレバー及びペダルを含む。また、操作装置２６は、油圧ライン及びゲートロック弁Ｄ６を介してコントロールバルブ１７に接続される。
【００３６】
ゲートロック弁Ｄ６は、コントロールバルブ１７と操作装置２６とを接続する油圧ラインの連通・遮断を切り換える。本実施例では、ゲートロック弁Ｄ６は、コントローラ３０からの指令に応じて油圧ラインの連通・遮断を切り換える電磁弁である。コントローラ３０は、ゲートロックレバーＤ５が出力する状態信号に基づいてゲートロックレバーＤ５の状態を判定する。そして、コントローラ３０は、ゲートロックレバーＤ５が引き上げられた状態にあると判定した場合に、ゲートロック弁Ｄ６に対して連通指令を出力する。連通指令を受けると、ゲートロック弁Ｄ６は開いて油圧ラインを連通させる。その結果、操作装置２６に対する操作者の操作が有効となる。一方、コントローラ３０は、ゲートロックレバーＤ５が引き下げられた状態にあると判定した場合に、ゲートロック弁Ｄ６に対して遮断指令を出力する。遮断指令を受けると、ゲートロック弁Ｄ６は閉じて油圧ラインを遮断する。その結果、操作装置２６に対する操作者の操作が無効となる。
【００３７】
圧力センサ２９は、操作装置２６の操作内容を圧力の形で検出する。圧力センサ２９は、検出値をコントローラ３０に対して出力する。
【００３８】
また、図２はコントローラ３０と表示装置Ｄ３との接続関係を示す。本実施例では、表示装置Ｄ３はマシンガイダンス装置５０を介してコントローラ３０に接続される。なお、表示装置Ｄ３、マシンガイダンス装置５０、及びコントローラ３０は、ＣＡＮ等の通信ネットワークを介して接続されてもよく、専用線を介して接続されてもよい。
【００３９】
表示装置Ｄ３は画像を生成する変換処理部Ｄ３ａを含む。本実施例では、変換処理部Ｄ３ａは、カメラＳ６の出力に基づいて表示用のカメラ画像を生成する。そのため、表示装置Ｄ３は、マシンガイダンス装置５０を介し、マシンガイダンス装置５０に接続されたカメラＳ６の出力を取得する。但し、カメラＳ６は、表示装置Ｄ３に接続されてもよく、コントローラ３０に接続されてもよい。
【００４０】
また、変換処理部Ｄ３ａは、コントローラ３０又はマシンガイダンス装置５０の出力に基づいて表示用の画像を生成する。本実施例では、変換処理部Ｄ３ａは、コントローラ３０又はマシンガイダンス装置５０が出力する各種情報を画像信号に変換する。なお、コントローラ３０が出力する情報は、例えば、エンジン冷却水の温度を示すデータ、作動油の温度を示すデータ、燃料の残量を示すデータ等を含む。また、マシンガイダンス装置５０が出力する情報は、バケット６の先端（爪先）位置を示すデータ、作業対象の法面の向きを示すデータ、ショベルの向きを示すデータ、ショベルを法面に正対させるための操作方向を示すデータ等を含む。
【００４１】
なお、変換処理部Ｄ３ａは、表示装置Ｄ３が有する機能としてではなく、コントローラ３０又はマシンガイダンス装置５０が有する機能として実現されてもよい。
【００４２】
また、表示装置Ｄ３は、蓄電池７０から電力の供給を受けて動作する。なお、蓄電池７０はエンジン１１のオルタネータ１１ａ（発電機）で発電した電力で充電される。蓄電池７０の電力は、コントローラ３０及び表示装置Ｄ３以外のショベルの電装品７２等にも供給される。また、エンジン１１のスタータ１１ｂは、蓄電池７０からの電力で駆動され、エンジン１１を始動する。
【００４３】
エンジン１１は、エンジンコントローラユニットＤ７により制御される。エンジンコントローラユニットＤ７からは、エンジン１１の状態を示す各種データ（例えば、水温センサ１１ｃで検出される冷却水温（物理量）を示すデータ）がコントローラ３０に常時送信される。したがって、コントローラ３０は一時記憶部（メモリ）３０ａにこのデータを蓄積しておき、必要なときに表示装置Ｄ３に送信することができる。
【００４４】
また、コントローラ３０には以下のように各種のデータが供給され、コントローラ３０の一時記憶部３０ａに格納される。
【００４５】
まず、可変容量式油圧ポンプであるメインポンプ１４のレギュレータ１４ａから斜板傾転角を示すデータがコントローラ３０に供給される。また、メインポンプ１４の吐出圧力を示すデータが、吐出圧力センサ１４ｂからコントローラ３０に送られる。これらのデータ（物理量を表すデータ）は一時記憶部３０ａに格納される。また、メインポンプ１４が吸入する作動油が貯蔵されたタンクとメインポンプ１４との間の管路には油温センサ１４ｃが設けられており、その管路を流れる作動油の温度を表すデータが油温センサ１４ｃからコントローラ３０に供給される。
【００４６】
また、燃料収容部５５における燃料収容量検出部５５ａから燃料収容量を示すデータがコントローラ３０に供給される。本実施例では、燃料収容部５５としての燃料タンクにおける燃料収容量検出部５５ａとしての燃料残量センサから燃料の残量状態を示すデータがコントローラ３０に供給される。
【００４７】
具体的には、燃料残量センサは、液面に追従するフロートと、フロートの上下変動量を抵抗値に変換する可変抵抗器（ポテンショメータ）とで構成される。この構成により、燃料残量センサは、表示装置Ｄ３で燃料の残量状態を無段階表示させることができる。なお、燃料収容量検出部の検出方式は、使用環境等に応じて適宜選択され得るものであり、燃料の残量状態を段階表示させることができる検出方式が採用されてもよい。
【００４８】
また、操作装置２６を操作した際にコントロールバルブ１７に送られるパイロット圧が、圧力センサ２９で検出され、検出したパイロット圧を示すデータがコントローラ３０に供給される。
【００４９】
また、本実施例では、図２に示すように、ショベルは、キャビン１０内にエンジン回転数調整ダイヤル７５を備える。エンジン回転数調整ダイヤル７５は、エンジン１１の回転数を調整するためのダイヤルであり、本実施例ではエンジン回転数を４段階で切り換えできるようにする。また、エンジン回転数調整ダイヤル７５からは、エンジン回転数の設定状態を示すデータがコントローラ３０に常時送信される。また、エンジン回転数調整ダイヤル７５は、ＳＰモード、Ｈモード、Ａモード、及びアイドリングモードの４段階でエンジン回転数を切り換えできるようにする。なお、図２は、エンジン回転数調整ダイヤル７５でＨモードが選択された状態を示す。
【００５０】
ＳＰモードは、作業量を優先したい場合に選択される回転数モードであり、最も高いエンジン回転数を利用する。Ｈモードは、作業量と燃費を両立させたい場合に選択される回転数モードであり、二番目に高いエンジン回転数を利用する。Ａモードは、燃費を優先させながら低騒音でショベルを稼働させたい場合に選択される回転数モードであり、三番目に高いエンジン回転数を利用する。アイドリングモードは、エンジン１１をアイドリング状態にしたい場合に選択される回転数モードであり、最も低いエンジン回転数を利用する。そして、エンジン１１は、エンジン回転数調整ダイヤル７５で設定された回転数モードのエンジン回転数で一定に回転数制御される。
【００５１】
次に、図３を参照しながら、マシンガイダンス装置５０の各種機能要素について説明する。図３は、マシンガイダンス装置５０の構成例を示す機能ブロック図である。
【００５２】
本実施例では、コントローラ３０は、ショベル全体の動作の制御に加えて、マシンガイダンス装置５０によるガイダンスを行うか否かを制御する。具体的には、コントローラ３０は、ゲートロックレバーＤ５の状態、圧力センサ２９からの検出信号等に基づいてマシンガイダンス装置５０によるガイダンスを行うか否かを制御する。
【００５３】
次に、マシンガイダンス装置５０について説明する。本実施例では、マシンガイダンス装置５０は、例えば、ブーム角度センサＳ１、アーム角度センサＳ２、バケット角度センサＳ３、機体傾斜センサＳ４、旋回角速度センサＳ５、入力装置Ｄ１、及びコントローラ３０から出力される各種信号及びやデータを受信する。そして、マシンガイダンス装置５０は、受信した信号及びデータに基づいてアタッチメント（例えば、バケット６）の実際の動作位置を算出する。そして、マシンガイダンス装置５０は、アタッチメントの実際の動作位置が目標動作位置とは異なる場合に、音声出力装置Ｄ２及び表示装置Ｄ３に警報指令を送信し、警報を発令させる。
【００５４】
マシンガイダンス装置５０は、様々な機能を担う機能部を含む。本実施例では、マシンガイダンス装置５０は、アタッチメントの動作をガイダンスするための機能部として、傾斜角算出部５０１、高さ算出部５０３、比較部５０４、警報制御部５０５、及びガイダンスデータ出力部５０６を含む。また、マシンガイダンス装置５０は、上部旋回体３の旋回角度を導出するための機能部として旋回角度導出部５０７を含む。
【００５５】
傾斜角算出部５０１は、機体傾斜センサＳ４からの検出信号に基づいて、水平面に対する上部旋回体３の傾斜角（ショベルの傾斜角）を算出する。すなわち、傾斜角算出部５０１は、機体傾斜センサＳ４からの検出信号を用いて、ショベルの傾斜角を算出する。
【００５６】
高さ算出部５０３は、傾斜角算出部５０１が算出した傾斜角と、センサＳ１〜Ｓ３の検出信号から算出されたブーム４、アーム５、バケット６の角度とから、エンドアタッチメントの作業部位としてのバケット６の先端（爪先）の高さを算出する。本実施例では、バケット６の先端で掘削を行うため、バケット６の先端（爪先）はエンドアタッチメントの作業部位に相当する。一方、バケット６の背面で土砂をならすような作業をするときには、バケット６の背面がエンドアタッチメントの作業部位に相当する。また、バケット６以外のエンドアタッチメントとしてブレーカを用いた場合には、ブレーカの先端がエンドアタッチメントの作業部位に相当する。
【００５７】
比較部５０４は、高さ算出部５０３が算出したバケット６の先端（爪先）の高さと、ガイダンスデータ出力部５０６から出力されるガイダンスデータで示されるバケット６の先端（爪先）の目標高さとを比較する。ここで、目標高さは、予め入力された設計図面とショベルの現在位置と作業姿勢とから算出されるようにしてもよい。また、設定された過去のショベルの爪先位置と、入力された目標深さと、角度と現在の作業姿勢（現在の爪先位置）から算出されるようにしてもよい。
【００５８】
警報制御部５０５は、比較部５０４での比較結果に基づいて、警報が必要と判断した場合には警報指令を音声出力装置Ｄ２及び表示装置Ｄ３の両方又は一方に送信する。音声出力装置Ｄ２及び表示装置Ｄ３は、警報指令を受けると所定の警報を発してショベルの操作者に通報する。
【００５９】
ガイダンスデータ出力部５０６は、上述のように、マシンガイダンス装置５０の記憶装置に予め格納されていたガイダンスデータからバケット６の目標高さのデータを抽出して比較部５０４に対して出力する。この際、ガイダンスデータ出力部５０６は、ショベルの傾斜角に対応するバケット６の目標高さのデータを出力する。
【００６０】
旋回角度導出部５０７は、上部旋回体３の旋回角度を導出する。本実施例では、基準方位に対する上部旋回体３の旋回角度を導出する。基準方位は基準となる任意の方位であり、例えば、東、西、南、北等の方位、地面上の基準点に対する方位、下部走行体１が向く方位等である。本実施例では、旋回角度導出部５０７は、旋回情報と旋回角速度センサＳ５の出力とに基づいて上部旋回体３の旋回角度を導出する。
【００６１】
旋回情報は、例えば、操作装置２６としての旋回操作レバーが生成するパイロット圧（以下、「旋回パイロット圧」とする。）、旋回操作レバーの操作量等の旋回操作情報を含む。また、旋回用油圧モータ又は旋回用電動発電機の回転数若しくは回転角、旋回用油圧モータに流入する作動油の圧力（以下、「旋回モータ圧」とする。）、旋回用電動発電機に供給される電流等の旋回動作情報を含む。なお、旋回用電動発電機の回転数若しくは回転角はレゾルバ等を用いて検出される。
【００６２】
具体的には、旋回角度導出部５０７は、旋回情報に基づいて上部旋回体３が旋回中であるか否かを判定する。例えば、旋回角度導出部５０７は、旋回パイロット圧が所定圧力以上の場合に旋回中であると判定し、所定圧力未満の場合に旋回中でないと判定する。或いは、旋回角度導出部５０７は、旋回モータ圧が所定圧力以上の場合に旋回中であると判定し、所定圧力未満の場合に旋回中でないと判定してもよい。
【００６３】
そして、旋回中であると判定した場合、旋回角度導出部５０７は、旋回角速度センサＳ５が所定時間間隔で出力する角速度を積算して旋回角度を導き出す。旋回中でないと判定した場合には、旋回角度導出部５０７は、旋回角速度センサＳ５が所定時間間隔で出力する角速度の積算を中止する。旋回角速度センサＳ５のドリフトに起因する誤差が増大するのを防止するためである。
【００６４】
また、旋回角度導出部５０７は、地磁気センサＳ９の出力を用いて旋回角度を補正する。具体的には、旋回角度導出部５０７は、上部旋回体３が旋回中でないと判定した場合、地磁気センサＳ９の出力が所定の条件を満たしているか否かを判定する。例えば、旋回角度導出部５０７は、地磁気センサＳ９の出力が所定の閾値以上の場合に出力が所定の条件を満たしていると判定し、地磁気センサＳ９の出力が所定の閾値未満の場合に出力が所定の条件を満たしていないと判定する。この場合、旋回角度導出部５０７は、建物等の影響で地磁気センサＳ９の出力が弱まっているか否かを検出できる。或いは、旋回角度導出部５０７は、地磁気センサＳ９の出力の直近の所定時間における変動幅が何れも所定値未満の場合に出力が所定の条件を満たしていると判定し、変動幅の何れかが所定値以上の場合に出力が所定の条件を満たしていないと判定してもよい。或いは、旋回角度導出部５０７は、直近の所定時間における出力の分散が何れも所定値未満の場合に出力が所定の条件を満たしていると判定し、分散の何れかが所定値以上の場合に出力が所定の条件を満たしていないと判定してもよい。この場合、旋回角度導出部５０７は、地磁気センサＳ９の出力に対するノイズの影響が大きいか否かを検出できる。このようにして、コントローラ３０は、地磁気センサＳ９の出力が安定しているか否かを判定する。
【００６５】
そして、地磁気センサＳ９の出力が所定の条件を満たしていると判定した場合、旋回角度導出部５０７は、旋回角速度センサＳ５の出力ではなく地磁気センサＳ９の出力から旋回角度を導き出す。具体的には、上部旋回体３の向きを示す地磁気センサＳ９の出力に基づいて基準方位に対する上部旋回体３の旋回角度を導き出す。この場合、旋回角度導出部５０７は、例えば、旋回角度がゼロ度のとき、すなわち、基準方位と上部旋回体３の向きとが一致するときの地磁気センサＳ９の出力を基準値として記憶しておく。そして、旋回中でないと判定し且つ地磁気センサＳ９の出力が所定の条件を満たしていると判定した時点の地磁気センサＳ９の出力と基準値とに基づいて旋回角度を導き出す。
【００６６】
或いは、下部走行体１の向きを示す下部地磁気センサの出力と上部旋回体３の向きを示す上部地磁気センサの出力とに基づいて下部走行体１に対する上部旋回体３の旋回角度を導き出してもよい。
【００６７】
次に、図４を参照し、旋回角度導出部５０７が旋回角度を導出する処理（以下、「旋回角度導出処理」とする。）について説明する。図４は、旋回角度導出処理のフローチャートであり、旋回角度導出部５０７は所定周期で繰り返しこの旋回角度導出処理を実行する。
【００６８】
最初に、旋回角度導出部５０７は、上部旋回体３が旋回中であるか否かを判定する（ステップＳ１）。例えば、旋回角度導出部５０７は、旋回パイロット圧が所定圧力以上の場合に旋回中であると判定する。
【００６９】
そして、旋回中であると判定した場合（ステップＳ１のＹＥＳ）、旋回角度導出部５０７は、旋回角速度センサＳ５の出力を用いて旋回角度を導き出す（ステップＳ２）。例えば、旋回角度導出部５０７は、旋回パイロット圧が所定圧力以上であると判定した場合に、旋回角速度センサＳ５が所定時間間隔で出力する角速度を積算して旋回角度を導き出す。
【００７０】
旋回中でないと判定した場合（ステップＳ１のＮＯ）、旋回角度導出部５０７は、地磁気センサＳ９の出力が所定の条件を満たしているか否かを判定する（ステップＳ３）。例えば、旋回角度導出部５０７は、地磁気センサＳ９の出力の直近の所定時間における変動幅に基づいてそれらの出力が所定の条件を満たしているか否かを判定する。
【００７１】
そして、出力が所定の条件を満たしていると判定した場合（ステップＳ３のＹＥＳ）、旋回角度導出部５０７は、地磁気センサＳ９の出力を用いて旋回角度を導き出す（ステップＳ４）。例えば、旋回角度導出部５０７は、地磁気センサＳ９の出力に基づいて基準方位に対する上部旋回体３の旋回角度を導き出す。或いは、下部地磁気センサの出力と上部地磁気センサの出力とに基づいて下部走行体１に対する上部旋回体３の旋回角度を導き出してもよい。
【００７２】
出力が所定の条件を満たしていないと判定した場合（ステップＳ３のＮＯ）、旋回角度導出部５０７は、前回の旋回角度導出処理で導き出した旋回角度を用いて今回の旋回角度を導き出す（ステップＳ５）。例えば、旋回角度導出部５０７は、前回の旋回角度導出処理で導き出した旋回角度をそのまま今回の旋回角度として採用する。
【００７３】
次に、旋回操作が断続的に行われたときの各種物理量の時間的推移について説明する。図５は各種物理量の時間的推移を示す図であり、図５（Ａ）が旋回パイロット圧の時間的推移を示し、図５（Ｂ）が旋回角速度（旋回角速度センサＳ５の出力）の時間的推移を示す。また、図５（Ｃ）が角速度センサ基準の旋回角度の時間的推移を示し、図５（Ｄ）が地磁気センサ基準の旋回角度の時間的推移を示し、図５（Ｅ）が導出旋回角度の時間的推移を示す。なお、横軸（時間軸）のスケールは各図で共通である。
【００７４】
角速度センサ基準の旋回角度は、旋回角速度センサＳ５の出力から導き出される旋回角度を意味する。また、地磁気センサ基準の旋回角度は、地磁気センサＳ９の出力から導き出される旋回角度を意味する。また、導出旋回角度は、旋回角度導出部５０７が最終的に導き出す旋回角度を意味する。
【００７５】
時刻ｔ０から時刻ｔ１の期間、すなわち、旋回操作レバーが操作されておらず上部旋回体３が旋回していない間、旋回角度導出部５０７は、地磁気センサＳ９の出力が所定の条件を満たしているか否かを判定する。そして、地磁気センサＳ９の出力が所定の条件を満たしていると判定した場合に地磁気センサＳ９の出力を用いて旋回角度を導き出す。旋回角速度センサＳ５の出力を用いて旋回角度を導き出した場合、出力のドリフトに起因する誤差を累積してしまうおそれがあるためである。本実施例では、旋回角速度センサＳ５の出力は、図５（Ｂ）に示すように僅かに右旋回側にドリフトしている。そのため、旋回角速度センサＳ５の出力を用いて旋回角度を導き出した場合、その旋回角度は、図５（Ｃ）に示すように、旋回していないにもかかわらず右旋回側に徐々に増大する。
【００７６】
本実施例では、図５（Ｄ）に示すように地磁気センサＳ９の出力が所定の条件を満たしているため、旋回角度導出部５０７は、地磁気センサ基準の旋回角度を導出旋回角度として出力する。図５（Ｄ）のドットハッチング領域は地磁気センサ基準の旋回角度が導出旋回角度として採用されていることを示す。その結果、導出旋回角度は、図５（Ｅ）の実線で示すように、時刻ｔ０から時刻ｔ１まで変動することなく推移する。なお、図５（Ｅ）の実線は導出旋回角度の推移を示し、破線は角速度センサ基準の旋回角度の推移を示し、一点鎖線は地磁気センサ基準の旋回角度の推移を示す。
【００７７】
その後、時刻ｔ１において旋回操作レバーが左旋回方向に傾けられると、旋回パイロット圧は、図５（Ａ）に示すように中立レベルから左旋回側に増大する。さらに、時刻ｔ２において旋回操作レバーが右旋回方向に傾けられると、旋回パイロット圧は、図５（Ａ）に示すように右旋回側に増大する。
【００７８】
このように、時刻ｔ１から時刻ｔ３の間、すなわち、旋回操作レバーが操作されて上部旋回体３が旋回している間、旋回角度導出部５０７は、旋回角速度センサＳ５の出力を用いて旋回角度を導き出す。旋回中においては、地磁気センサＳ９の出力よりも旋回角速度センサＳ５の出力の方が比較的安定しているためである。
【００７９】
本実施例では、旋回角度導出部５０７は、角速度センサ基準の旋回角度を導出旋回角度として採用する。図５（Ｃ）のドットハッチング領域は角速度センサ基準の旋回角度が導出旋回角度として採用されていることを示す。その結果、導出旋回角度は、図５（Ｅ）の実線で示すように、一旦左旋回方向に増大した後で右旋回方向に増大する。
【００８０】
その後、時刻ｔ３において旋回操作レバーが中立位置に戻されると、旋回パイロット圧は、図５（Ａ）に示すように中立レベルに戻る。
【００８１】
その後、時刻ｔ３から時刻ｔ４の期間、すなわち、旋回操作レバーが操作されておらず上部旋回体３が旋回していない間、旋回角度導出部５０７は、地磁気センサＳ９の出力が所定の条件を満たしているか否かを再び判定する。そして、地磁気センサＳ９の出力が所定の条件を満たしていないと判定した場合、前回の旋回角度導出処理で導出した旋回角度をそのまま導出旋回角度として採用する。旋回角速度センサＳ５の出力を用いて旋回角度を導き出した場合、出力のドリフトに起因する誤差を累積してしまうおそれがあるためである。また、不安定な地磁気センサＳ９の出力を用いて旋回角度を導き出した場合、導出旋回角度が不安定となってしまうためである。本実施例では、地磁気センサＳ９の出力は、図５（Ｄ）に示すように比較的大きな変動幅で上下に変動している。そのため、地磁気センサＳ９の出力を用いて旋回角度を導き出した場合、その旋回角度は、図５（Ｅ）の一点鎖線で示すように、旋回していないにもかかわらず揺れ動く。
【００８２】
本実施例では、図５（Ｄ）に示すように地磁気センサＳ９の出力が所定の条件を満たしていないため、旋回角度導出部５０７は、前回の旋回角度導出処理で導出した旋回角度をそのまま導出旋回角度として採用する。具体的には、旋回角度導出部５０７は、図５（Ｅ）の点Ａ１で示す前回の旋回角度導出処理で導出した旋回角度を、時刻ｔ３から時刻ｔ４にわたって、導出旋回角度として採用し続ける。その結果、導出旋回角度は、時刻ｔ３から時刻ｔ４までの間、点Ａ１で示す旋回角度を維持したまま推移する。
【００８３】
その後、時刻ｔ４において旋回操作レバーが再び左旋回方向に傾けられると、旋回パイロット圧は、図５（Ａ）に示すように中立レベルから左旋回側に増大する。そして、時刻ｔ４から時刻ｔ５の間、すなわち、旋回操作レバーが操作されて上部旋回体３が旋回している間、旋回角度導出部５０７は、旋回角速度センサＳ５の出力を用いて旋回角度を導き出す。その結果、導出旋回角度は、図５（Ｅ）の実線で示すように、右旋回の角度範囲において左旋回方向に減少する。
【００８４】
その後、時刻ｔ５において旋回操作レバーが中立位置に戻されると、旋回パイロット圧は、図５（Ａ）に示すように中立レベルに戻る。そして、旋回角度導出部５０７は、地磁気センサＳ９の出力が所定の条件を満たしているか否かを再び判定する。そして、地磁気センサＳ９の出力が所定の条件を満たしていると判定した場合、旋回角度導出部５０７は、地磁気センサＳ９の出力を用いて導出旋回角度を補正する。具体的には、旋回角度導出部５０７は、図５（Ｅ）の点Ａ２で示す角速度センサ基準の旋回角度を、点Ａ３で示す地磁気センサ基準の旋回角度に補正する。角速度センサ基準の旋回角度には誤差が累積されているおそれがあるので、地磁気センサ基準の旋回角度が角速度センサ基準の旋回角度よりも正確と推定できるためである。
【００８５】
このように、旋回角度導出部５０７は、旋回中であるか否か、及び、地磁気センサＳ９の出力が所定の条件を満たしているか否かに応じて旋回角速度センサの出力と地磁気センサＳ９の出力とを使い分けることで、より小さい誤差で安定的に旋回角度を導出できる。そして、導出された旋回角度は、例えば、マシンガイダンス装置５０が旋回方向をガイドする際に利用される。
【００８６】
また、旋回角度導出部５０７は、旋回角速度センサＳ５及び地磁気センサＳ９のそれぞれの特性に応じて旋回角速度センサの出力と地磁気センサＳ９の出力とを使い分けることで、より小さい誤差で安定的に旋回角度を導出できる。
【００８７】
例えば、旋回角度導出部５０７は、旋回中であると判定した場合、旋回角速度センサＳ５の出力を用いて旋回角度を導き出す。そのため、旋回中に不安定となる地磁気センサＳ９の出力を用いて旋回角度が導き出されてしまうのを防止できる。
【００８８】
また、旋回角度導出部５０７は、旋回中でないと判定し、且つ、地磁気センサＳ９の出力が所定の条件を満たしていると判定した場合、地磁気センサＳ９の出力を用いて旋回角度を導き出す。そのため、出力がドリフトしているおそれがある旋回角速度センサＳ５の出力を用いて旋回角度が導き出された結果、旋回中でないにもかかわらず、旋回角度を変動させてしまうのを防止できる。
【００８９】
また、旋回角度導出部５０７は、旋回中でないと判定し、且つ、地磁気センサＳ９の出力が所定の条件を満たしていないと判定した場合、前回の旋回角度導出処理で導き出した旋回角度を利用する。そのため、不安定な地磁気センサＳ９の出力、及び、出力がドリフトしているおそれがある旋回角速度センサＳ５の出力を用いて旋回角度が導き出されてしまうのを防止できる。
【００９０】
以上、本発明の好ましい実施例について詳説したが、本発明は、上述した実施例に制限されることはなく、本発明の範囲を逸脱することなしに上述した実施例に種々の変形及び置換を加えることができる。
【符号の説明】
【００９１】
１・・・下部走行体  ２・・・旋回機構  ３・・・上部旋回体  ４・・・ブーム  ５・・・アーム  ６・・・バケット  ７・・・ブームシリンダ  ８・・・アームシリンダ  ９・・・バケットシリンダ  １０・・・キャビン  １１・・・エンジン  １１ａ・・・オルタネータ  １１ｂ・・・スタータ  １１ｃ・・・水温センサ  １４・・・メインポンプ  １４ａ・・・レギュレータ  １４ｂ・・・吐出圧力センサ  １４ｃ・・・油温センサ  １５・・・パイロットポンプ  １７・・・コントロールバルブ  ２６・・・操作装置  ２９・・・圧力センサ  ３０・・・コントローラ  ３０ａ・・・一時記憶部  ５０・・・マシンガイダンス装置  ５５・・・燃料収容部  ５５ａ・・・燃料収容量検出部  ７０・・・蓄電池  ７２・・・電装品  ７５・・・エンジン回転数調整ダイヤル  ５０１・・・傾斜角算出部  ５０３・・・高さ算出部  ５０４・・・比較部  ５０５・・・警報制御部  ５０６・・・ガイダンスデータ出力部  ５０７・・・旋回角度導出部  Ｓ１・・・ブーム角度センサ  Ｓ２・・・アーム角度センサ  Ｓ３・・・バケット角度センサ  Ｓ４・・・機体傾斜センサ  Ｓ５・・・旋回角速度センサ  Ｓ６・・・カメラ  Ｓ７・・・通信装置  Ｓ８・・・測位装置  Ｓ９・・・地磁気センサ  Ｄ１・・・入力装置  Ｄ２・・・音声出力装置  Ｄ３・・・表示装置  Ｄ３ａ・・・変換処理部  Ｄ４・・・記憶装置  Ｄ５・・・ゲートロックレバー  Ｄ６・・・ゲートロック弁  Ｄ７・・・エンジンコントローラユニット
【図１】
0006598685.tif 000002
【図２】
0006598685.tif 000003
【図３】
0006598685.tif 000004
【図４】
0006598685.tif 000005
【図５】
0006598685.tif 000006