JP7382255B2

JP7382255B2 - 作業機械の外力推定装置、当該外力推定装置を備える作業機械、作業装置のパラメータ推定装置、並びに作業機械の外力推定方法

Info

Publication number: JP7382255B2
Application number: JP2020031862A
Authority: JP
Inventors: 亮菊植
Original assignee: Kobelco Construction Machinery Co Ltd; Hiroshima University NUC
Current assignee: Kobelco Construction Machinery Co Ltd; Hiroshima University NUC
Priority date: 2020-02-27
Filing date: 2020-02-27
Publication date: 2023-11-16
Anticipated expiration: 2040-02-27
Also published as: JP2021134576A

Description

本発明は、作業機械の外力推定装置、当該外力推定装置を備える作業機械、作業装置のパラメータ推定装置、並びに作業機械の外力推定方法に関する。

下部走行体及び上部旋回体を有する本体部と、本体部に対して姿勢変更可能に取り付けられた作業装置とを備えた作業機械において、作業装置に作用する外力を特定するための技術が知られている。

下記特許文献１には、２つの回動軸を介して連結されたアーム及びアタッチメントを有する作業装置を備えた作業機械において、当該２つの回動軸の各々にひずみゲージ等を用いたロードセルを配置し、各ロードセルから出力されるひずみ検出結果に基づいて、アタッチメントに作用する外力の方向及び大きさを計測する外力計測装置が開示されている。

特開２０１０－２４９５８６号公報

上記特許文献１に開示された外力計測装置によると、アタッチメントに作用する外力を計測するためにロードセルを追加実装する必要があるため、作業機械の製造コストが上昇する。また、一般的に、ひずみゲージ等を用いたロードセルは外部衝撃等に対して脆弱である。従って、建設現場等の衝撃の大きい環境下での作業が想定される作業機械にロードセルを実装したのでは、十分な信頼性を担保できないため、ロードセルを用いない他の手法の実現が望まれる。

本発明はかかる事情に鑑みて成されたものであり、外部衝撃等に対して高い信頼性を担保し、かつ、作業機械の製造コストの上昇を抑えつつ、作業装置に作用する外力の方向及び大きさを推定することが可能な、作業機械の外力推定装置、当該外力推定装置を備える作業機械、作業装置のパラメータ推定装置、並びに作業機械の外力推定方法を得ることを目的とする。

本発明の一態様に係る作業機械の外力推定装置は、本体部と、ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、を備える作業機械において、前記作業装置に作用する外力を推定する、作業機械の外力推定装置であって、前記アーム駆動手段によって発生されるアーム駆動力を検出するアーム駆動力センサ、及び、前記アタッチメント駆動手段によって発生されるアタッチメント駆動力を検出するアタッチメント駆動力センサと、前記ブームに対する前記アームの角度であるアーム角を検出するアーム角センサ、及び、前記アームに対する前記アタッチメントの角度であるアタッチメント角を検出するアタッチメント角センサと、前記作業装置に外力が作用していない状態で前記アタッチメントが駆動された際の、前記アタッチメント駆動力センサによって検出された前記アタッチメント駆動力と、前記アタッチメント角センサによって検出された前記アタッチメント角とに基づいて、前記アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアタッチメントパラメータを算出するアタッチメントパラメータ算出部と、前記作業装置に外力が作用していない状態で前記アームが駆動された際の、前記アーム駆動力センサによって検出された前記アーム駆動力と、前記アーム角センサによって検出された前記アーム角とに基づいて、前記アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアームパラメータを算出するアームパラメータ算出部と、前記アタッチメントパラメータ算出部によって算出された前記アタッチメントパラメータと、前記作業装置に外力が作用している状態で前記アタッチメントが駆動された際の、前記アタッチメント駆動力センサによって検出された前記アタッチメント駆動力と、前記アタッチメント角センサによって検出された前記アタッチメント角とに基づいて、前記外力に起因する前記アタッチメントのトルクであるアタッチメントトルクを算出するアタッチメントトルク算出部と、前記アームパラメータ算出部によって算出された前記アームパラメータと、前記作業装置に外力が作用している状態で前記アームが駆動された際の、前記アーム駆動力センサによって検出された前記アーム駆動力と、前記アーム角センサによって検出された前記アーム角とに基づいて、前記外力に起因する前記アームのトルクであるアームトルクを算出するアームトルク算出部と、前記アタッチメントトルク算出部によって算出された前記アタッチメントトルクと、前記アームトルク算出部によって算出された前記アームトルクとに基づいて、前記外力の方向及び大きさを算出する外力算出部と、を備えることを特徴とするものである。

この態様に係る作業機械の外力推定装置によれば、作業装置に作用する外力の方向及び大きさを、アタッチメント駆動力、アタッチメント角、アーム駆動力、及びアーム角の検出結果に基づいて推定できる。従って、外力計測のためのロードセルを追加実装する必要がないため、外部衝撃等に対して高い信頼性を担保し、かつ、作業機械の製造コストの上昇を抑えつつ、作業装置に作用する外力の方向及び大きさを推定することが可能となる。また、作業機械においてアタッチメント及びアームが同時に駆動された場合であっても、作業装置に作用する外力の方向及び大きさを適切に推定することが可能となる。
上記態様に係る作業機械の外力推定装置において、前記アーム駆動力センサは、前記アーム駆動手段が有するアームシリンダの内部圧力と内部断面積とに基づいて前記アーム駆動力を検出し、前記アタッチメント駆動力センサは、前記アタッチメント駆動手段が有するアタッチメントシリンダの内部圧力と内部断面積とに基づいて前記アタッチメント駆動力を検出することが望ましい。

上記態様に係る作業機械の外力推定装置において、前記作業機械は、前記ブームを駆動するブーム駆動手段をさらに備え、前記ブーム駆動手段によって発生されるブーム駆動力を検出するブーム駆動力センサと、前記本体部に対する前記ブームの角度であるブーム角を検出するブーム角センサと、前記作業装置に外力が作用していない状態で前記ブームが駆動された際の、前記ブーム駆動力センサによって検出された前記ブーム駆動力と、前記ブーム角センサによって検出された前記ブーム角とに基づいて、前記ブームに関する、ブーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むブームパラメータを算出するブームパラメータ算出部と、前記ブームパラメータ算出部によって算出された前記ブームパラメータと、前記作業装置に外力が作用している状態で前記ブームが駆動された際の、前記ブーム駆動力センサによって検出された前記ブーム駆動力と、前記ブーム角センサによって検出された前記ブーム角とに基づいて、前記外力に起因する前記ブームのトルクであるブームトルクを算出するブームトルク算出部と、をさらに備え、前記外力算出部は、前記アタッチメントトルク算出部によって算出された前記アタッチメントトルクと、前記アームトルク算出部によって算出された前記アームトルクと、前記ブームトルク算出部によって算出された前記ブームトルクとに基づいて、前記外力の方向及び大きさを算出することが望ましい。

この態様に係る作業機械の外力推定装置によれば、作業機械においてアタッチメント、アーム、及びブームが同時に駆動された場合であっても、作業装置に作用する外力の方向及び大きさを適切に推定することが可能となる。

本発明の一態様に係る作業機械は、本体部と、ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、上記態様に係る作業機械の外力推定装置と、を備えることを特徴とするものである。

この態様に係る作業機械によれば、作業装置に作用する外力の方向及び大きさを、アタッチメント駆動力、アタッチメント角、アーム駆動力、及びアーム角の検出結果に基づいて推定できる。従って、外力計測のためのロードセルを追加実装する必要がないため、作業機械の製造コストの上昇を抑え、かつ、外部衝撃等に対して高い信頼性を担保しつつ、作業装置に作用する外力の方向及び大きさを推定することが可能となる。

本発明の一態様に係る作業装置のパラメータ推定装置は、本体部と、ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、を備える作業機械において、前記作業装置のパラメータを推定する、作業装置のパラメータ推定装置であって、前記アーム駆動手段によって発生されるアーム駆動力を検出するアーム駆動力センサ、及び、前記アタッチメント駆動手段によって発生されるアタッチメント駆動力を検出するアタッチメント駆動力センサと、前記ブームに対する前記アームの角度であるアーム角を検出するアーム角センサ、及び、前記アームに対する前記アタッチメントの角度であるアタッチメント角を検出するアタッチメント角センサと、前記作業装置に外力が作用していない状態で前記アタッチメントが駆動された際の、前記アタッチメント駆動力センサによって検出された前記アタッチメント駆動力と、前記アタッチメント角センサによって検出された前記アタッチメント角とに基づいて、前記アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさ、のうちの少なくとも一つを含むアタッチメントパラメータを算出するアタッチメントパラメータ算出部と、前記作業装置に外力が作用していない状態で前記アームが駆動された際の、前記アーム駆動力センサによって検出された前記アーム駆動力と、前記アーム角センサによって検出された前記アーム角とに基づいて、前記アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさ、のうちの少なくとも一つを含むアームパラメータを算出するアームパラメータ算出部と、を備えることを特徴とするものである。

この態様に係る作業装置のパラメータ推定装置によれば、アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアタッチメントパラメータと、アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアームパラメータとを、簡易に推定することが可能となる。

本発明の一態様に係る作業機械の外力推定方法は、本体部と、ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、を備える作業機械において、前記作業装置に作用する外力を推定する、作業機械の外力推定方法であって、（Ａ）前記アーム駆動手段によって発生されるアーム駆動力を検出するステップと、（Ｂ）前記アタッチメント駆動手段によって発生されるアタッチメント駆動力を検出するステップと、（Ｃ）前記ブームに対する前記アームの角度であるアーム角を検出するステップと、（Ｄ）前記アームに対する前記アタッチメントの角度であるアタッチメント角を検出するステップと、（Ｅ）前記作業装置に外力が作用していない状態で前記アタッチメントが駆動された際の、前記ステップ（Ｂ）によって検出された前記アタッチメント駆動力と、前記ステップ（Ｄ）によって検出された前記アタッチメント角とに基づいて、前記アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアタッチメントパラメータを算出するステップと、（Ｆ）前記作業装置に外力が作用していない状態で前記アームが駆動された際の、前記ステップ（Ａ）によって検出された前記アーム駆動力と、前記ステップ（Ｃ）によって検出された前記アーム角とに基づいて、前記アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアームパラメータを算出するステップと、（Ｇ）前記ステップ（Ｅ）によって算出された前記アタッチメントパラメータと、前記作業装置に外力が作用している状態で前記アタッチメントが駆動された際の、前記ステップ（Ｂ）によって検出された前記アタッチメント駆動力と、前記ステップ（Ｄ）によって検出された前記アタッチメント角とに基づいて、前記外力に起因する前記アタッチメントのトルクであるアタッチメントトルクを算出するステップと、（Ｈ）前記ステップ（Ｆ）によって算出された前記アームパラメータと、前記作業装置に外力が作用している状態で前記アームが駆動された際の、前記ステップ（Ａ）によって検出された前記アーム駆動力と、前記ステップ（Ｃ）によって検出された前記アーム角とに基づいて、前記外力に起因する前記アームのトルクであるアームトルクを算出するステップと、（Ｉ）前記ステップ（Ｇ）によって算出された前記アタッチメントトルクと、前記ステップ（Ｈ）によって算出された前記アームトルクとに基づいて、前記外力の方向及び大きさを算出するステップと、を備えることを特徴とするものである。

この態様に係る作業機械の外力推定方法によれば、作業装置に作用する外力の方向及び大きさを、アタッチメント駆動力、アタッチメント角、アーム駆動力、及びアーム角の検出結果に基づいて推定できる。従って、外力計測のためのロードセルを追加実装する必要がないため、外部衝撃等に対して高い信頼性を担保し、かつ、作業機械の製造コストの上昇を抑えつつ、作業装置に作用する外力の方向及び大きさを推定することが可能となる。また、作業機械においてアタッチメント及びアームが同時に駆動された場合であっても、作業装置に作用する外力の方向及び大きさを適切に推定することが可能となる。

本発明によれば、外部衝撃等に対して高い信頼性を担保し、かつ、作業機械の製造コストの上昇を抑えつつ、作業装置に作用する外力の方向及び大きさを推定することが可能となる。

本発明の実施の形態に係る作業機械の構成を模式的に示す図である。推定器の接続構成を簡略化して示すブロック図である。コントローラの接続構成を簡略化して示すブロック図である。作業装置の簡略化モデルを示す図である。アーム及びアタッチメントの簡略化モデルを示す図である。推定器が有する機能を示すブロック図である。推定器によって実行される外力算出処理の流れを示すフローチャートである。変形例に係る推定器が有する機能を示すブロック図である。変形例に係る推定器によって実行される外力算出処理の流れを示すフローチャートである。

図１は、本発明の実施の形態に係る作業機械１の構成を模式的に示す図である。本実施の形態の例において、作業機械１は、交換可能なアタッチメント３３としてバケットが装着された建設機械である。但し、バケットに限らず、ニブラ又はブレーカ等の他のアタッチメントが装着されても良い。また、建設機械に限らず、任意のアタッチメントが装着される農業機械又は工業機械等の他の作業機械であっても良い。

図１に示すように、作業機械１は、クローラ式の下部走行体２２と、下部走行体２２上に旋回可能に配置された上部旋回体２１と、上部旋回体２１に取り付けられた作業装置３とを備えている。下部走行体２２及び上部旋回体２１は、作業機械１の本体部２を構成する。

作業装置３は、ブームフットピン６１（ブーム回動軸）によって上部旋回体２１に対し回動可能に連結されたブーム３１と、アームフットピン６２（アーム回動軸）によってブーム３１に対し回動可能に連結されたアーム３２と、アームトップピン６３（アタッチメント回動軸）によってアーム３２に対し回動可能に連結されたアタッチメント３３とを備えている。

作業機械１は、上部旋回体２１に対しブーム３１を起伏させるブームシリンダ４１と、ブーム３１に対しアーム３２を揺動させるアームシリンダ４２と、アーム３２に対しアタッチメント３３を揺動させるアタッチメントシリンダ４３とを備えている。なお、ブーム３１、アーム３２、及びアタッチメント３３を駆動するための駆動手段としては、シリンダの代わりに油圧モータ等の他のアクチュエータを使用しても良い。

アタッチメントシリンダ４３のシリンダロッドの先端は、回動可能なアタッチメントロッドピン６５によって、アイドラリンク５１の一端及びアタッチメントリンク５２の一端に接続されている。アイドラリンク５１の他端は、回動可能なアイドラリンクピン６４によって、アーム３２に接続されている。アタッチメントリンク５２の他端は、回動可能なアタッチメントリンクピン６６によって、アタッチメント３３に接続されている。

また、作業機械１は、ブーム駆動力センサ７１、アーム駆動力センサ７２、及びアタッチメント駆動力センサ７３を備えている。ブーム駆動力センサ７１は、ブームシリンダ４１の内部圧力を検出し、その圧力検出値とブームシリンダ４１の内部断面積とを乗算することにより、ブームシリンダ４１が発生するブーム駆動力ｆ_ｃ１を検出する。ブーム駆動力センサ７１は、検出したブーム駆動力ｆ_ｃ１を示すブーム駆動力データを出力する。アーム駆動力センサ７２は、アームシリンダ４２の内部圧力を検出し、その圧力検出値とアームシリンダ４２の内部断面積とを乗算することにより、アームシリンダ４２が発生するアーム駆動力ｆ_ｃ２を検出する。アーム駆動力センサ７２は、検出したアーム駆動力ｆ_ｃ２を示すアーム駆動力データを出力する。アタッチメント駆動力センサ７３は、アタッチメントシリンダ４３の内部圧力を検出し、その圧力検出値とアタッチメントシリンダ４３の内部断面積とを乗算することにより、アタッチメントシリンダ４３が発生するアタッチメント駆動力ｆ_ｃ３を検出する。アタッチメント駆動力センサ７３は、検出したアタッチメント駆動力ｆ_ｃ３を示すアタッチメント駆動力データを出力する。

上部旋回体２１の内部には、作業機械１の全体の制御を司るコントローラ３００が配置されている。作業機械１のオペレータのレバー操作に伴うコントローラ３００の油圧制御によって、上部旋回体２１に対するブーム３１の角度（ブーム角）、ブーム３１に対するアーム３２の角度（アーム角）、及び、アーム３２に対するアタッチメント３３の角度（アタッチメント角）がそれぞれ変更されることにより、作業装置３の姿勢が変更される。また、上部旋回体２１の内部には、推定器１００が配置されている。推定器１００の接続構成及び処理内容については後述する。

また、作業機械１は、ブーム角センサ８１、アーム角センサ８２、及びアタッチメント角センサ８３を備えている。これらの角度センサは、ポテンショメータ又はロータリエンコーダ等によって構成される。ブーム角センサ８１は、ブームフットピン６１の回転角度を検出することによってブーム角θ_ｂを検出し、検出したブーム角θ_ｂを示すブーム角データを出力する。アーム角センサ８２は、アームフットピン６２の回転角度を検出することによってアーム角θ_ａｂを検出し、検出したアーム角θ_ａｂを示すアーム角データを出力する。アタッチメント角センサ８３は、アームトップピン６３の回転角度を検出することによってアタッチメント角θ_ｎを検出し、検出したアタッチメント角θ_ｎを示すアタッチメント角データを出力する。

図２Ａは、推定器１００の接続構成を簡略化して示すブロック図である。ブーム駆動力センサ７１、アーム駆動力センサ７２、及びアタッチメント駆動力センサ７３は、有線の通信路によって推定器１００に接続されている。ブーム駆動力データ、アーム駆動力データ、及びアタッチメント駆動力データは、当該通信路を介して推定器１００に入力される。同様に、ブーム角センサ８１、アーム角センサ８２、及びアタッチメント角センサ８３は、有線の通信路によって推定器１００に接続されている。ブーム角データ、アーム角データ、及びアタッチメント角データは、当該通信路を介して推定器１００に入力される。なお、通信路は無線であっても良く、その場合、推定器１００は無線通信を介して作業機械１の外部に配置されていても良い。

図２Ｂは、コントローラ３００の接続構成を簡略化して示すブロック図である。コントローラ３００は、制御信号Ｓ１９によってアクチュエータ駆動回路２００を制御する。アクチュエータ駆動回路２００は、アクチュエータとしてのブームシリンダ４１、アームシリンダ４２、及びアタッチメントシリンダ４３を駆動する。アクチュエータ駆動回路２００には、動力源としてのエンジンによって駆動される油圧ポンプ、油圧ポンプから各アクチュエータへの作動油の供給量を調整するためのコントロールバルブ、及び、コントロールバルブを制御するためのパイロット圧を発生させる操作レバー等が含まれる。作業機械１のオペレータによって操作レバーが操作されると、その操作量に応じて変動するパイロット圧によってコントロールバルブが制御され、パイロット圧に応じた吐出量の作動油が各アクチュエータに供給され、作動油の油圧によって各アクチュエータが動作する。これにより、オペレータのレバー操作に従って、作業装置３が所望の動作を実行することとなる。

図３は、作業装置３の簡略化モデルを示す図である。図３に示す第１要素Ｗ１、第２要素Ｗ２、第３要素Ｗ３は、図１に示したブーム３１、アーム３２、アタッチメント３３にそれぞれ対応する。図３には、第１要素Ｗ１の重心Ｐ_ｇ１、第２要素Ｗ２の重心Ｐ_ｇ２、及び第３要素Ｗ３の重心Ｐ_ｇ３を示している。図３に示す点Ｘ０，Ｘ１，Ｘ２は、図１に示したブームフットピン６１、アームフットピン６２、アームトップピン６３にそれぞれ対応する。点Ｘ３は、アタッチメント３３の先端を示す。

第１要素Ｗ１に関し、鉛直上向き方向と、点Ｘ０及び点Ｘ１を結ぶ線分との成す角は、ブーム角θ_ｂである。

第２要素Ｗ２に関し、鉛直上向き方向と、点Ｘ１及び点Ｘ３を結ぶ線分との成す角は、角度θ_ｔ３である。鉛直上向き方向と、点Ｘ１及び重心Ｐ_ｇ３を結ぶ線分との成す角は、角度θ_ｇ３２である。点Ｘ０及び点Ｘ１を結ぶ線分の延長線と、点Ｘ１及び点Ｘ２を結ぶ線分との成す角は、アーム角θ_ａｂである。また、点Ｘ１及び点Ｘ３を結ぶ線分の長さはｌ_ｔ３であり、点Ｘ１及び重心Ｐ_ｇ３を結ぶ線分の長さはｌ_ｇ３２であり、点Ｘ１及び重心Ｐ_ｇ２を結ぶ線分の長さはｌ_ｇ２である。

アタッチメントＷ３に関し、鉛直上向き方向と、点Ｘ２及び点Ｘ３を結ぶ線分との成す角は、角度θ_ｔ３３である。鉛直上向き方向と、点Ｘ２及び重心Ｐ_ｇ３を結ぶ線分との成す角は、角度θ_ｇ３３である。点Ｘ１及び点Ｘ２を結ぶ線分の延長線と、点Ｘ２及び重心Ｐ_ｇ３を結ぶ線分との成す角は、アタッチメント角θ_ｎである。また、点Ｘ２及び点Ｘ３を結ぶ線分の長さはＢｕＲ_２であり、点Ｘ２及び重心Ｐ_ｇ３を結ぶ線分の長さはＢｕＧＲである。

図４は、アーム３２及びアタッチメント３３の簡略化モデルを示す図である。図４に示す点Ｙ１は、図１に示したアタッチメントシリンダ４３とアーム３２との連結点を示す。図４に示す点Ｙ２，Ｙ３，Ｙ４は、図１に示したアイドラリンクピン６４、アタッチメントロッドピン６５、アタッチメントリンクピン６６にそれぞれ対応する。点Ｙ１及び点Ｙ３を結ぶ線分の長さはＣＹＬ_３であり、アタッチメントシリンダ４３のシリンダ長に対応する。点Ｙ１及び点Ｙ２を結ぶ線分と、点Ｙ２及び点Ｙ３を結ぶ線分との成す角は、角度ｄである。また、点Ｙ１及び点Ｙ２を結ぶ線分の長さはＲ_２であり、点Ｙ２及び点Ｙ３を結ぶ線分の長さはＣＬ_２である。

図５は、推定器１００が有する機能を示すブロック図である。推定器１００は、ＣＰＵ等の情報処理装置と、当該情報処理装置が参照可能なＲＯＭ及びＲＡＭ等の記憶装置とを備えて構成されている。本実施の形態に係る推定器１００は、ブーム３１を静止させた状態でアーム３２及びアタッチメント３３を動作させて作業装置３に所定の作業を実行させた際に、作業装置３（具体的にはアタッチメント３３）に作用する外力を推定する外力推定装置として機能する。

図２Ａに示したように、推定器１００は、推定した外力の方向θ_ｅ及び大きさＦを示す信号Ｓ１８を出力する。第１の例として、信号Ｓ１８は、作業機械１の操縦席に配置された表示装置（図略）に入力される。これにより、推定された外力に関する情報を図形情報としてオペレータに提示することができる。第２の例として、信号Ｓ１８は、作業機械１に搭載されているハードディスク又はフラッシュメモリ等の記憶装置（図略）に入力される。これにより、推定された外力に関する情報を時系列データとして作業履歴情報に含めて保存することができる。第３の例として、信号Ｓ１８は、コントローラ３００に入力される。これにより、コントローラ３００は、推定された外力に応じて適切な動作を行うことができる。

図５の接続関係で示すように推定器１００は、アタッチメントパラメータ算出部１０１、アームパラメータ算出部１０２、パラメータ保持部１０３、アタッチメントトルク算出部１０４、アームトルク算出部１０５、及び外力算出部１０６を備えている。

図６は、推定器１００によって実行される外力算出処理の流れを示すフローチャートである。

まずステップＳＰ１１において推定器１００は、作業装置３に外力が作用していない状態（即ちアタッチメント３３の無負荷状態）で、ブーム３１及びアーム３２を動作させずにアタッチメント３３だけを動作させる。その状態でアタッチメントパラメータ算出部１０１は、アタッチメント角センサ８３及びアタッチメント駆動力センサ７３から所定のサンプリング間隔で逐次入力されるアタッチメント角データ（アタッチメント角θ_ｎ，ｋ）及びアタッチメント駆動力データ（アタッチメント駆動力ｆ_ｃ３，ｋ）に基づいて、アタッチメント３３に関する所定のアタッチメントパラメータを算出する。なお、添え字の「ｋ」は時刻を意味し、具体的には、サンプリング周期Ｔを用いたｋＴによって時刻が表される。サンプリング周期Ｔは、例えば、０．００１秒から０．０３秒までの間の適切な値である。当該アタッチメントパラメータには、アームトップピン６３まわりのアタッチメント３３の慣性モーメントＩ_ｊ３、アタッチメント３３の質量Ｍ_３、アタッチメント３３のクーロン摩擦力の大きさＮ_３、及びアタッチメント３３の粘性摩擦力の大きさＢ_３が含まれる。なお、図中の記号「＾」は推定値を意味し、明細書中ではその呼称を用いて＜ハット＞と表記する。これらのアタッチメントパラメータ＜ハット＞Ｉ_ｊ３，＜ハット＞Ｍ_３，＜ハット＞Ｎ_３，＜ハット＞Ｂ_３は、パラメータ保持部１０３によって保持される。

アタッチメントパラメータ算出部１０１による演算処理について説明する。

アタッチメントシリンダ４３が発生するアタッチメント駆動力ｆ_ｃ３をトルクτ_３に変換するための変換係数Ｊ（θ_ｎ）を式（１）に示す。

アームトップピン６３まわりの運動方程式を式（２）に示す。

式（２）において、角度θ_ｇ３３の１階微分は角速度、２階微分は角加速度を表し、微小時間の差分値として求められる。また、角度θ_ｇ３３は、ブーム角θ_ｂ、アーム角θ_ａｂ、及びアタッチメント角θ_ｎに基づいて幾何学的に算出できる。

式（２）は式（３）～（６）のように変形できる。例えば式（４）において、イコールの上に三角印を付した記号は、定義を意味する。

式（３）において、τ_３，ｋ及びψ_３，ｋを既知、θ_３を未知として扱うことにより、逐次入力される複数のτ_３，ｋ及びψ_３，ｋに基づいてθ_３を推定することができる。推定には、例えば、忘却因子付き逐次最小二乗法を用いることができる。但し、カルマンフィルタを用いても良い。

忘却因子の設定値に基づく重みをｗ_{３，ｋ，ｉ}とすると、式（３）から二乗誤差は式（７）～（１０）のように表される。

ここで、ｉ_０は計算を開始する時刻を意味する。リアルタイム演算においては、Ｒ_３，ｋ及びｑ_３，ｋは式（１１）（１２）に基づいて計算される。

Ｒ_ｍ，ｋが逆行列を持つ場合、式（１３）に基づいて推定値＜ハット＞θ_ｍ，ｋを算出することができる。なお、添え字の「ｍ」は、アタッチメント３３に関しては「３」、アーム３２に関しては「２」、ブーム３１に関しては「１」となる。

以上のように、アタッチメントパラメータ算出部１０１は、アタッチメント角センサ８３及びアタッチメント駆動力センサ７３から逐次入力されるアタッチメント角データ（アタッチメント角θ_ｎ，ｋ）及びアタッチメント駆動力データ（アタッチメント駆動力ｆ_ｃ３，ｋ）に基づいて、式（５）のθ_３に相当するアタッチメントパラメータ＜ハット＞Ｉ_ｊ３，＜ハット＞Ｍ_３，＜ハット＞Ｎ_３，＜ハット＞Ｂ_３を算出することができる。

図６のフローチャートを参照して、次にステップＳＰ１２において推定器１００は、アタッチメント３３の無負荷状態で、ブーム３１及びアタッチメント３３を動作させずにアーム３２だけを動作させる。その状態でアームパラメータ算出部１０２は、アーム角センサ８２及びアーム駆動力センサ７２から所定のサンプリング間隔で逐次入力されるアーム角データ（アーム角θ_ａｂ，ｋ）及びアーム駆動力データ（アーム駆動力ｆ_ｃ２，ｋ）に基づいて、アーム３２に関する所定のアームパラメータを算出する。当該アームパラメータには、アームフットピン６２まわりのアーム３２の慣性モーメントの推定値＜ハット＞Ｉ_ｊ２、アタッチメント３３及びアーム３２の合計質量の推定値＜ハット＞Ｍ_２３、アーム３２のクーロン摩擦力の大きさの推定値＜ハット＞Ｎ_２、及びアーム３２の粘性摩擦力の大きさの推定値＜ハット＞Ｂ_２が含まれる。これらのアームパラメータ＜ハット＞Ｉ_ｊ２，＜ハット＞Ｍ_２３，＜ハット＞Ｎ_２，＜ハット＞Ｂ_２は、パラメータ保持部１０３によって保持される。

アームパラメータ算出部１０２による演算処理について説明する。

アームフットピン６２まわりの運動方程式を式（１４）～（１７）に示す。

ここで、角度θ_ｇ３２は、ブーム角θ_ｂ及びアーム角θ_ａｂに基づいて幾何学的に算出できる。

式（１４）は式（１８）～（２０）のように変形できる。

上記と同様に、τ_２，ｋ及びψ_２，ｋを既知、θ_２を未知として扱い、逐次入力される複数のτ_２，ｋ及びψ_２，ｋに基づいてθ_２を推定する。

以上のように、アームパラメータ算出部１０２は、アーム角センサ８２及びアーム駆動力センサ７２から逐次入力されるアーム角データ（アーム角θ_ａｂ，ｋ）及びアーム駆動力データ（アーム駆動力ｆ_ｃ２，ｋ）に基づいて、式（１９）のθ_２に相当するアームパラメータ＜ハット＞Ｉ_ｊ２，＜ハット＞Ｍ_２３，＜ハット＞Ｎ_２，＜ハット＞Ｂ_２を算出することができる。

図６のフローチャートを参照して、次にステップＳＰ１３において推定器１００は、作業装置３（具体的にはアタッチメント３３の先端）に対して所定の外力が作用している状態（即ちアタッチメント３３の有負荷状態）で、ブーム３１及びアーム３２を動作させずにアタッチメント３３だけを動作させる。ここで、外力の大きさはＦであり、鉛直上向き方向に対する外力の作用方向はθ_ｅである。その状態でアタッチメントトルク算出部１０４は、時刻ｌにおいてアタッチメント角センサ８３及びアタッチメント駆動力センサ７３から入力されたアタッチメント角データ（アタッチメント角θ_ｎ，ｌ）及びアタッチメント駆動力データ（アタッチメント駆動力ｆ_ｃ３，ｌ）と、パラメータ保持部１０３から入力されたアタッチメントパラメータ＜ハット＞Ｉ_ｊ３，＜ハット＞Ｍ_３，＜ハット＞Ｎ_３，＜ハット＞Ｂ_３とに基づいて、外力に起因して生じるアームトップピン６３まわりのトルクであるアタッチメントトルクの推定値＜ハット＞τ_ｅ３，ｌを算出する。なお、添え字の「ｌ」は、時刻ｌ（エル）における値であることを意味する。

次にステップＳＰ１４において推定器１００は、アタッチメント３３の有負荷状態で、ブーム３１及びアタッチメント３３を動作させずにアーム３２だけを動作させる。その状態でアームトルク算出部１０５は、時刻ｌにおいてアーム角センサ８２及びアーム駆動力センサ７２から入力されたアーム角データ（アーム角θ_ａｂ，ｌ）及びアーム駆動力データ（アーム駆動力ｆ_ｃ２，ｌ）と、パラメータ保持部１０３から入力されたアームパラメータ＜ハット＞Ｉ_ｊ２，＜ハット＞Ｍ_２３，＜ハット＞Ｎ_２，＜ハット＞Ｂ_２とに基づいて、外力に起因して生じるアームフットピン６２まわりのトルクであるアームトルクの推定値＜ハット＞τ_ｅ２，ｌを算出する。

アタッチメントトルク算出部１０４及びアームトルク算出部１０５による演算処理について説明する。

アタッチメント３３の重心Ｐ_ｇ３まわりの慣性モーメントの推定値＜ハット＞Ｉ_３は、式（２１）で表される。

アーム３２の質量の推定値＜ハット＞Ｍ_２は、式（２２）で表される。

アーム３２の重心Ｐ_ｇ２まわりの慣性モーメントの推定値＜ハット＞Ｉ_２は、式（２３）で表される。

アタッチメントトルク算出部１０４及びアームトルク算出部１０５が使用する摩擦モデルのアルゴリズムを、式（２４）～（２７）に示す。

ここで、Ｋ及びＢは定数であり、例えば、Ｋ＝１０^７［Ｎｍ／ｒａｄ］、Ｂ＝１０^５［Ｎｍｓ／ｒａｄ］である。

アームフットピン６２まわりの慣性モーメントＩ_ｊ２は、アームフットピン６２からアタッチメント３３の重心Ｐ_ｇ３までの距離ｌ_ｇ３２によって変化する。よって、時刻ｌにおけるＩ_ｊ２の推定値＜ハット＞Ｉ_ｊ２，ｌは、式（２８）で表すことができる。

アームトルク算出部１０５は、外力に起因するアームトルクの推定値＜ハット＞τ_ｅ２，ｌを、式（２９）によって算出する。

ここで、τ_２，ｌは、時刻ｌにおいてアーム駆動力センサ７２から入力されたアーム駆動力データ（アーム駆動力ｆ_ｃ２，ｌ）に対応するトルク（即ち無負荷状態のトルクと外力起因のトルクとの合計）である。

アタッチメントトルク算出部１０４は、外力に起因するアタッチメントトルクの推定値＜ハット＞τ_ｅ３，ｌを、式（３０）によって算出する。

ここで、τ_３，ｌは、時刻ｌにおいてアタッチメント駆動力センサ７３から入力されたアタッチメント駆動力データ（アタッチメント駆動力ｆ_ｃ３，ｌ）に対応するトルク（即ち無負荷状態のトルクと外力起因のトルクとの合計）である。

図６のフローチャートを参照して、次にステップＳＰ１５において外力算出部１０６は、アタッチメントトルク算出部１０４から入力されたアタッチメントトルクの推定値＜ハット＞τ_ｅ３，ｌと、アームトルク算出部１０５から入力されたアームトルクの推定値＜ハット＞τ_ｅ２，ｌとに基づいて、外力の方向の推定値＜ハット＞θ_ｅ，ｌ及び大きさの推定値＜ハット＞Ｆ_ｌを算出する。

外力算出部１０６による演算処理について説明する。

推定値＜ハット＞τ_ｅ２，ｌ及び推定値＜ハット＞τ_ｅ３，ｌは、外力の方向の推定値＜ハット＞θ_ｅ，ｌ及び大きさの推定値＜ハット＞Ｆ_ｌを用いて、式（３１）（３２）のように表される。

よって、Ｅ_２，ｌ及びＥ_３，ｌを式（３３）（３４）のように定義すると、ｃｏｓ＜ハット＞θ_ｅ，ｌ及びｓｉｎ＜ハット＞θ_ｅ，ｌは、式（３５）で表される。

関数ａｔａｎ２（ｙ，ｘ）の戻り値の範囲は［－π，π］であり、また、＜ハット＞θ_ｅ，ｌの範囲は［０，２π］であるため、外力算出部１０６は、式（３６）によって＜ハット＞θ_ｅ，ｌを算出することができ、式（３７）によって＜ハット＞Ｆ_ｌを算出することができる。

以上のように本実施の形態に係る作業機械１によれば、作業装置３に作用する外力の方向θ_ｅ及び大きさＦを、アタッチメント駆動力ｆ_ｃ３、アタッチメント角θ_ｎ、アーム駆動力ｆ_ｃ２、及びアーム角θ_ａｂの検出結果に基づいて推定できる。従って、外力計測のためのロードセルを追加実装する必要がないため、外部衝撃等に対して高い信頼性を担保し、かつ、作業機械１の製造コストの上昇を抑えつつ、作業装置３に作用する外力の方向θ_ｅ及び大きさＦを推定することが可能となる。また、作業機械１においてアタッチメント３３及びアーム３２が同時に駆動された場合であっても、作業装置３に作用する外力の方向θ_ｅ及び大きさＦを適切に推定することが可能となる。

＜変形例＞
上記実施の形態では、推定器１００は、ブーム３１を静止させた状態でアーム３２及びアタッチメント３３を動作させた際の外力を算出したが、上記と同様のアルゴリズムをブーム３１にも拡張することにより、ブーム３１、アーム３２、及びアタッチメント３３の全てを同時に動作させた際の外力を推定器１００によって推定することもできる。

図７は、本変形例に係る推定器１００が有する機能を示すブロック図である。図７の接続関係で示すように推定器１００は、図５に示した構成に対してブームパラメータ算出部１０７及びブームトルク算出部１０８をさらに備えている。

図８は、本変形例に係る推定器１００によって実行される外力算出処理の流れを示すフローチャートである。

まずステップＳＰ２１において推定器１００は、アタッチメント３３の無負荷状態で、ブーム３１及びアーム３２を動作させずにアタッチメント３３だけを動作させる。その状態でアタッチメントパラメータ算出部１０１は、アタッチメント角センサ８３及びアタッチメント駆動力センサ７３から逐次入力されるアタッチメント角データ（アタッチメント角θ_ｎ，ｋ）及びアタッチメント駆動力データ（アタッチメント駆動力ｆ_ｃ３，ｋ）に基づいて、アタッチメントパラメータ＜ハット＞Ｉ_ｊ３，＜ハット＞Ｍ_３，＜ハット＞Ｎ_３，＜ハット＞Ｂ_３を算出する。これらのアタッチメントパラメータは、パラメータ保持部１０３によって保持される。

次にステップＳＰ２２において推定器１００は、アタッチメント３３の無負荷状態で、ブーム３１及びアタッチメント３３を動作させずにアーム３２だけを動作させる。その状態でアームパラメータ算出部１０２は、アーム角センサ８２及びアーム駆動力センサ７２から逐次入力されるアーム角データ（アーム角θ_ａｂ，ｋ）及びアーム駆動力データ（アーム駆動力ｆ_ｃ２，ｋ）に基づいて、アームパラメータ＜ハット＞Ｉ_ｊ２，＜ハット＞Ｍ_２３，＜ハット＞Ｎ_２，＜ハット＞Ｂ_２を算出する。これらのアームパラメータは、パラメータ保持部１０３によって保持される。

次にステップＳＰ２３において推定器１００は、アタッチメント３３の無負荷状態で、アーム３２及びアタッチメント３３を動作させずにブーム３１だけを動作させる。その状態でブームパラメータ算出部１０７は、ブーム角センサ８１及びブーム駆動力センサ７１から逐次入力されるブーム角データ（ブーム角θ_ｂ，ｋ）及びブーム駆動力データ（ブーム駆動力ｆ_ｃ１，ｋ）に基づいて、ブームパラメータ＜ハット＞Ｉ_ｊ１，＜ハット＞Ｍ_１２３，＜ハット＞Ｎ_１，＜ハット＞Ｂ_１を算出する。これらのブームパラメータは、パラメータ保持部１０３によって保持される。

次にステップＳＰ２４において推定器１００は、アタッチメント３３の有負荷状態で、ブーム３１及びアーム３２を動作させずにアタッチメント３３だけを動作させる。その状態でアタッチメントトルク算出部１０４は、時刻ｌにおいてアタッチメント角センサ８３及びアタッチメント駆動力センサ７３から入力されたアタッチメント角データ（アタッチメント角θ_ｎ，ｌ）及びアタッチメント駆動力データ（アタッチメント駆動力ｆ_ｃ３，ｌ）と、パラメータ保持部１０３から入力されたアタッチメントパラメータ＜ハット＞Ｉ_ｊ３，＜ハット＞Ｍ_３，＜ハット＞Ｎ_３，＜ハット＞Ｂ_３とに基づいて、外力に起因して生じるアームトップピン６３まわりのトルクであるアタッチメントトルクの推定値＜ハット＞τ_ｅ３，ｌを算出する。

次にステップＳＰ２５において推定器１００は、アタッチメント３３の有負荷状態で、ブーム３１及びアタッチメント３３を動作させずにアーム３２だけを動作させる。その状態でアームトルク算出部１０５は、時刻ｌにおいてアーム角センサ８２及びアーム駆動力センサ７２から入力されたアーム角データ（アーム角θ_ａｂ，ｌ）及びアーム駆動力データ（アーム駆動力ｆ_ｃ２，ｌ）と、パラメータ保持部１０３から入力されたアームパラメータ＜ハット＞Ｉ_ｊ２，＜ハット＞Ｍ_２３，＜ハット＞Ｎ_２，＜ハット＞Ｂ_２とに基づいて、外力に起因して生じるアームフットピン６２まわりのトルクであるアームトルクの推定値＜ハット＞τ_ｅ２，ｌを算出する。

次にステップＳＰ２６において推定器１００は、アタッチメント３３の有負荷状態で、アーム３２及びアタッチメント３３を動作させずにブーム３１だけを動作させる。その状態でブームトルク算出部１０８は、時刻ｌにおいてブーム角センサ８１及びブーム駆動力センサ７１から入力されたブーム角データ（ブームθ_ｂ，ｌ）及びブーム駆動力データ（ブーム駆動力ｆ_ｃ１，ｌ）と、パラメータ保持部１０３から入力されたブームパラメータ＜ハット＞Ｉ_ｊ１，＜ハット＞Ｍ_１２３，＜ハット＞Ｎ_１，＜ハット＞Ｂ_１とに基づいて、外力に起因して生じるブームフットピン６１まわりのトルクであるブームトルクの推定値＜ハット＞τ_ｅ１，ｌを算出する。

次にステップＳＰ２７において外力算出部１０６は、アタッチメントトルク算出部１０４から入力されたアタッチメントトルクの推定値＜ハット＞τ_ｅ３，ｌと、アームトルク算出部１０５から入力されたアームトルクの推定値＜ハット＞τ_ｅ２，ｌと、ブームトルク算出部１０８から入力されたブームトルクの推定値＜ハット＞τ_ｅ１，ｌとに基づいて、外力の方向の推定値＜ハット＞θ_ｅ，ｌ及び大きさの推定値＜ハット＞Ｆ_ｌを算出する。

本変形例に係る作業機械１によれば、作業機械１においてアタッチメント３３、アーム３２、及びブーム３１が同時に駆動された場合であっても、作業装置３に作用する外力の方向θ_ｅ及び大きさＦを適切に推定することが可能となる。

１作業機械
２本体部
３作業装置
３１ブーム
３２アーム
３３アタッチメント
４１ブームシリンダ
４２アームシリンダ
４３アタッチメントシリンダ
７１ブーム駆動力センサ
７２アーム駆動力センサ
７３アタッチメント駆動力センサ
８１ブーム角センサ
８２アーム角センサ
８３アタッチメント角センサ
１００推定器
１０１バケットパラメータ算出部
１０２アームパラメータ算出部
１０４バケットトルク算出部
１０５アームトルク算出部
１０６外力算出部
１０７ブームパラメータ算出部
１０８ブームトルク算出部
３００コントローラ

Claims

本体部と、
ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、
前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、
を備える作業機械において、前記作業装置に作用する外力を推定する、作業機械の外力推定装置であって、
前記アーム駆動手段によって発生されるアーム駆動力を検出するアーム駆動力センサ、及び、前記アタッチメント駆動手段によって発生されるアタッチメント駆動力を検出するアタッチメント駆動力センサと、
前記ブームに対する前記アームの角度であるアーム角を検出するアーム角センサ、及び、前記アームに対する前記アタッチメントの角度であるアタッチメント角を検出するアタッチメント角センサと、
前記作業装置に外力が作用していない状態で前記アタッチメントが駆動された際の、前記アタッチメント駆動力センサによって検出された前記アタッチメント駆動力と、前記アタッチメント角センサによって検出された前記アタッチメント角とに基づいて、前記アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアタッチメントパラメータを算出するアタッチメントパラメータ算出部と、
前記作業装置に外力が作用していない状態で前記アームが駆動された際の、前記アーム駆動力センサによって検出された前記アーム駆動力と、前記アーム角センサによって検出された前記アーム角とに基づいて、前記アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアームパラメータを算出するアームパラメータ算出部と、
前記アタッチメントパラメータ算出部によって算出された前記アタッチメントパラメータと、前記作業装置に外力が作用している状態で前記アタッチメントが駆動された際の、前記アタッチメント駆動力センサによって検出された前記アタッチメント駆動力と、前記アタッチメント角センサによって検出された前記アタッチメント角とに基づいて、前記外力に起因する前記アタッチメントのトルクであるアタッチメントトルクを算出するアタッチメントトルク算出部と、
前記アームパラメータ算出部によって算出された前記アームパラメータと、前記作業装置に外力が作用している状態で前記アームが駆動された際の、前記アーム駆動力センサによって検出された前記アーム駆動力と、前記アーム角センサによって検出された前記アーム角とに基づいて、前記外力に起因する前記アームのトルクであるアームトルクを算出するアームトルク算出部と、
前記アタッチメントトルク算出部によって算出された前記アタッチメントトルクと、前記アームトルク算出部によって算出された前記アームトルクとに基づいて、前記外力の方向及び大きさを算出する外力算出部と、
を備える、作業機械の外力推定装置。
前記アーム駆動力センサは、前記アーム駆動手段が有するアームシリンダの内部圧力と内部断面積とに基づいて前記アーム駆動力を検出し、
前記アタッチメント駆動力センサは、前記アタッチメント駆動手段が有するアタッチメントシリンダの内部圧力と内部断面積とに基づいて前記アタッチメント駆動力を検出する、請求項１に記載の作業機械の外力推定装置。
前記作業機械は、
前記ブームを駆動するブーム駆動手段
をさらに備え、
前記ブーム駆動手段によって発生されるブーム駆動力を検出するブーム駆動力センサと、
前記本体部に対する前記ブームの角度であるブーム角を検出するブーム角センサと、
前記作業装置に外力が作用していない状態で前記ブームが駆動された際の、前記ブーム駆動力センサによって検出された前記ブーム駆動力と、前記ブーム角センサによって検出された前記ブーム角とに基づいて、前記ブームに関する、ブーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むブームパラメータを算出するブームパラメータ算出部と、
前記ブームパラメータ算出部によって算出された前記ブームパラメータと、前記作業装置に外力が作用している状態で前記ブームが駆動された際の、前記ブーム駆動力センサによって検出された前記ブーム駆動力と、前記ブーム角センサによって検出された前記ブーム角とに基づいて、前記外力に起因する前記ブームのトルクであるブームトルクを算出するブームトルク算出部と、
をさらに備え、
前記外力算出部は、前記アタッチメントトルク算出部によって算出された前記アタッチメントトルクと、前記アームトルク算出部によって算出された前記アームトルクと、前記ブームトルク算出部によって算出された前記ブームトルクとに基づいて、前記外力の方向及び大きさを算出する、請求項１に記載の作業機械の外力推定装置。
本体部と、
ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、
前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、
請求項１～３のいずれか一つに記載の作業機械の外力推定装置と、
を備える、作業機械。
本体部と、
ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、
前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、
を備える作業機械において、前記作業装置のパラメータを推定する、作業装置のパラメータ推定装置であって、
前記アーム駆動手段によって発生されるアーム駆動力を検出するアーム駆動力センサ、及び、前記アタッチメント駆動手段によって発生されるアタッチメント駆動力を検出するアタッチメント駆動力センサと、
前記ブームに対する前記アームの角度であるアーム角を検出するアーム角センサ、及び、前記アームに対する前記アタッチメントの角度であるアタッチメント角を検出するアタッチメント角センサと、
前記作業装置に外力が作用していない状態で前記アタッチメントが駆動された際の、前記アタッチメント駆動力センサによって検出された前記アタッチメント駆動力と、前記アタッチメント角センサによって検出された前記アタッチメント角とに基づいて、前記アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさ、のうちの少なくとも一つを含むアタッチメントパラメータを算出するアタッチメントパラメータ算出部と、
前記作業装置に外力が作用していない状態で前記アームが駆動された際の、前記アーム駆動力センサによって検出された前記アーム駆動力と、前記アーム角センサによって検出された前記アーム角とに基づいて、前記アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさ、のうちの少なくとも一つを含むアームパラメータを算出するアームパラメータ算出部と、
を備える、作業装置のパラメータ推定装置。
本体部と、
ブーム回動軸によって前記本体部に回動可能に連結されたブームと、アーム回動軸によって前記ブームに回動可能に連結されたアームと、アタッチメント回動軸によって前記アームに回動可能に連結されたアタッチメントと、を有する作業装置と、
前記アームを駆動するアーム駆動手段、及び、前記アタッチメントを駆動するアタッチメント駆動手段と、
を備える作業機械において、前記作業装置に作用する外力を推定する、作業機械の外力推定方法であって、
（Ａ）前記アーム駆動手段によって発生されるアーム駆動力を検出するステップと、
（Ｂ）前記アタッチメント駆動手段によって発生されるアタッチメント駆動力を検出するステップと、
（Ｃ）前記ブームに対する前記アームの角度であるアーム角を検出するステップと、
（Ｄ）前記アームに対する前記アタッチメントの角度であるアタッチメント角を検出するステップと、
（Ｅ）前記作業装置に外力が作用していない状態で前記アタッチメントが駆動された際の、前記ステップ（Ｂ）によって検出された前記アタッチメント駆動力と、前記ステップ（Ｄ）によって検出された前記アタッチメント角とに基づいて、前記アタッチメントに関する、アタッチメント回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアタッチメントパラメータを算出するステップと、
（Ｆ）前記作業装置に外力が作用していない状態で前記アームが駆動された際の、前記ステップ（Ａ）によって検出された前記アーム駆動力と、前記ステップ（Ｃ）によって検出された前記アーム角とに基づいて、前記アームに関する、アーム回動軸まわりの慣性モーメント、質量、及び摩擦力の大きさを含むアームパラメータを算出するステップと、
（Ｇ）前記ステップ（Ｅ）によって算出された前記アタッチメントパラメータと、前記作業装置に外力が作用している状態で前記アタッチメントが駆動された際の、前記ステップ（Ｂ）によって検出された前記アタッチメント駆動力と、前記ステップ（Ｄ）によって検出された前記アタッチメント角とに基づいて、前記外力に起因する前記アタッチメントのトルクであるアタッチメントトルクを算出するステップと、
（Ｈ）前記ステップ（Ｆ）によって算出された前記アームパラメータと、前記作業装置に外力が作用している状態で前記アームが駆動された際の、前記ステップ（Ａ）によって検出された前記アーム駆動力と、前記ステップ（Ｃ）によって検出された前記アーム角とに基づいて、前記外力に起因する前記アームのトルクであるアームトルクを算出するステップと、
（Ｉ）前記ステップ（Ｇ）によって算出された前記アタッチメントトルクと、前記ステップ（Ｈ）によって算出された前記アームトルクとに基づいて、前記外力の方向及び大きさを算出するステップと、
を備える、作業機械の外力推定方法。