JP5750383B2 - 柱体昇降機及び枝打ちロボット - Google Patents

Description

本発明は、柱体昇降機及び枝打ちロボットに関するものである。

従来、樹幹等の柱体に沿って昇降動作する柱体昇降機がある。例えば、特許文献１に記載の枝打機は、フレームに設けられた主輪と、高応答性弾性材の弾性力に基づいて樹幹を抱き締めるように動作する左右のアームと、各フレームの先端に設けられた副輪とを備えている。そして、その各アームの抱き締め動作によって各主輪及び副輪間に樹幹を挟み込むことにより、その柱体に対する上下方向の相対位置を保持する構成となっている。

また、特許文献２に記載の枝払昇降機は、樹幹を締め付ける締め付け機構と、モータ駆動により締め付け圧力を調整する圧力調整機構とを備えている。そして、これにより、その上下方向において直径が大きく変化する樹幹にも対応することが可能となっている。

しかしながら、機体の自重を支えるためには大きな締め付け力が必要である。このため、上記のような圧力調整機構を設けることで、機体の大型化及び重量化を招くとともに、その機体の姿勢を維持するために複雑な制御が必要になる。また、アームによる抱き締め方式では、装置を樹幹に取り付ける際、高応答性弾性材の弾性力に抗してアームを押し広げる動作が必要となる。このため、例えば、所謂「樹幹の細り」等、樹径の変化に対応すべく、その弾性力を強化することで、樹幹への取付作業が困難になるという問題がある。

この点を踏まえ、特許文献３に記載の柱体昇降作業装置は、柱体を挟む反対側において上下方向に異なる位置で柱体の外周面に当接する上部主車輪及び下部主車輪を備えている。そして、その下部主車輪側における当該下部主車輪よりも径方向外側に重心を設定することにより、自重を利用して柱体に対する上下方向の相対位置を保持することが可能となっている。

即ち、このような構成とすることで、上記高応答性弾性材や圧力調整機構等のような能動的に締め付け力を発生させる構成を廃することができる。その結果、機体の小型化及び軽量化を図るともに、併せて、その柱体への取付性を向上させることができる。

また、特許文献３には、その各主車輪及び下部主車輪の位置と、機体の傾きと、柱体の直径との関係に基づいて、上部主車輪及び下部主車輪の位置を制御する構成が開示されている。そして、このような構成を適用することにより、その制御も含め、構成の複雑化を招くことなく、柱体の直径が変化する状況においても、機体の姿勢を維持することができるようになる。

特開２０００−２９５９３１号公報 特開２００６−８７３２６号公報 特開２００８−２５３１１６号公報

しかしながら、上記従来技術では、上部主車輪及び下部主車輪を支持する各アームは、その支持する上部主車輪及び下部主車輪の間に柱体を挟み込むように、それぞれが独立して動作する。このため、図１４（ａ）（ｂ）に示すように、上下方向における柱体７０の直径変化に応じて各主車輪７１が移動する際、これら各主車輪７１を構成するタイヤの弾性等によって、その各主車輪７１が柱体７０の外周面７０ａに対してハの字状に開いて接触する状態となる可能性がある。その結果、各主車輪の転動方向と柱体の軸線方向との間にずれが生じ、機体（機枠）７２の姿勢が乱れることによって、柱体７０の軸中心Ｐ０を外した状態で各主車輪７１間に柱体７０を挟み込んでしまうおそれがある。そして、これが円滑な機体の動作を妨げる要因になるという問題がある。

特に、これらの各主車輪が、駆動輪として柱体の外周面を転動する機能や操舵輪としての機能を有する場合には、要求される駆動トルク（操舵トルク）が上昇することで、その消費エネルギー（電力消費量等）が増大することになる。そして、その外周面に多くの凹凸が存在する等、外乱の影響を受けやすい樹幹等のような柱体を対象とする場合には、このような現象が起こりやすいことから、この点において、なお改善の余地を残すものとなっていた。

本発明は、上記問題点を解決するためになされたものであって、その目的は、直径が変化する柱体を対象とする場合においても、より好適に機体の姿勢を維持して円滑な動作を担保することができる柱体昇降機及び枝打ちロボットを提供することにある。

上記問題点を解決するために、請求項１に記載の発明は、柱体を挟む反対側において上下方向に異なる位置で前記柱体の外周面に当接する上下の車輪を有して自重により前記柱体に対する上下方向の相対位置を保持可能な柱体昇降機において、前記柱体の径方向外側に配置される機枠と、前記機枠に固定される上下一対の車輪支持装置と、を備え、前記各車輪支持装置は、左右一対の支持アームを有して二つの車輪を独立に支持することにより該各車輪を周方向に離間した位置において前記柱体の外周面に当接させるとともに、前記各支持アームを左右対称に同期して動作させることにより前記各車輪が同期して前記柱体の軸中心に向かうように前記外周面に当接させること、を要旨とする。

請求項２に記載の発明は、前記各支持アームは、基端側に回動中心を有する第１リンク及び第２リンクと、該第１リンク及び第２リンクの先端に対して回動可能に連結された第３リンクと、該第３リンクの一端に設けられた車輪支持部と、を備えてなること、を要旨とする。

請求項３に記載の発明は、前記第１リンクの基端には、前記回動中心に対応するピッチ円中心を有したギヤ部が形成されるとともに、前記各車輪支持装置は、前記各支持アームの前記ギヤ部に対して同時に噛合する駆動ギヤを備えた駆動装置を有すること、を要旨とする。

請求項４に記載の発明は、前記駆動ギヤは、前記ギヤ部側からの逆入力回転を伝達しないウォームギヤであること、を要旨とする。
請求項５に記載の発明は、前記各車輪が操舵輪又は駆動輪の少なくとも何れかの機能を有すること、を要旨とする。

請求項６に記載の発明は、機体の傾きを示す姿勢角度を検出する姿勢角度検出手段と、検出される前記姿勢角度に基づいて、前記各支持アームの動作位置を制御する位置制御装置と、を備えること、を要旨とする。

請求項７に記載の発明は、前記位置制御装置は、検出される前記姿勢角度を目標姿勢角度に追従させるべく、該目標姿勢角度と前記姿勢角度との偏差に基づいて、前記各支持アームの動作位置を制御する姿勢角制御手段を備えること、を要旨とする。

請求項８に記載の発明は、前記位置制御装置は、検出される前記姿勢角度、前記柱体の直径、及び前記動作位置の関係に基づいて、前記動作位置に対応する制御要素の目標値を演算し、該目標値に前記制御要素の実際値を追従させるべく制御する幾何的制御手段を備えること、を要旨とする。

請求項９に記載の発明は、前記幾何的制御手段は、前記姿勢角度と前記動作位置とに基づいて前記柱体の直径を演算する直径演算手段と、前記柱体を上昇する際に演算される前記直径に関する情報を前記上下方向の相対位置毎に記憶する記憶手段と、を備え、前記柱体を下降する際には、その記憶された情報に示される前記直径に基づいて前記目標値を演算すること、を要旨とする。

請求項１０に記載の発明は、前記位置制御装置は、前記姿勢角度が許容範囲を超える場合に前記各支持アームの動作位置制御を実行すること、を備えること、を要旨とする。
請求項１１に記載の発明は、前記各車輪支持装置は、前記位置制御装置を共有すること、を要旨とする。

請求項１２に記載の発明は、前記位置制御装置は、前記各車輪支持装置のうち、一方の車輪支持装置における前記各支持アームを主アームとして、前記姿勢角度に基づき前記主アームの動作位置を制御する主アーム制御手段と、他方の前記車輪支持装置の前記各支持アームを従アームとして、該従アームの動作位置を前記主アームの動作位置に一致させるべく制御する従アーム制御手段と、を備えること、を要旨とする。

請求項１３に記載の発明は、請求項５〜請求項１２の何れか一項に記載の柱体昇降機を有して樹幹を昇降動作するとともに、前記樹幹から延びる枝を切断可能な切断装置を備えた枝打ちロボットであること、を要旨とする。

請求項１４に記載の発明は、前記切断装置は、モータ駆動により前記枝を切断するものであって、モータ負荷に基づいて前記切断装置が前記枝を切断する枝打ち状態にあるか否かを判定する枝打ち判定手段と、前記枝打ち状態にあると判定された場合に前記切断装置のモータ出力を増大させる出力可変手段を備えること、を要旨とする。

請求項１５に記載の発明は、前記柱体昇降機は、樹幹を中心に旋回しつつ昇降する旋回昇降機能を有するとともに、前記切断装置は、前記柱体昇降機と一体に旋回しつつ前記切断装置に接触する前記枝をモータ駆動により切断するものであって、モータ負荷に基づいて前記切断装置が前記枝を切断する枝打ち状態にあるか否かを判定する枝打ち判定手段と、前記枝打ち状態にあると判定された場合に前記柱体昇降機の旋回移動速度を減速させる旋回移動速度可変手段とを備えること、を要旨とする。

本発明によれば、直径が変化する柱体を対象とする場合においても、より好適に機体の姿勢を維持して円滑な動作を担保することが可能な柱体昇降機及び枝打ちロボットを提供することができる。

本発明にかかる枝打ちロボットの斜視図。 （ａ）樹幹（柱体）に取り付けられた柱体昇降機を模式的に示す上面図、（ｂ）同じく模式的に示す側面図。 車輪支持装置の斜視図。 車輪支持装置の平面図。 各支持アームの動作及び各車輪の軌跡を示す説明図。 各車輪に設定された補正角を示す説明図。 柱体昇降機の制御ブロック図。 枝打ち制御の態様を示すフローチャート。 枝打ち制御の作用説明図。 機体の姿勢角度、樹幹の直径、及び各アームの動作位置とその補正量の関係を示す説明図。 樹幹の外周面に当接する二つ車輪の挟み角（車輪取付角度）、各車輪の接点位置ベクトル、及び各アームの動作位置に対応するモータ角の関係を示す説明図。 第２の実施形態における柱体昇降機の姿勢制御の態様を示すフローチャート。 電動チェーンソーの概略構成図。 （ａ）（ｂ）従来技術の課題を模式的に示す説明図。

［第１の実施形態］
以下、本発明を具体化した第１の実施形態を図面に従って説明する。
図１に示すように、枝打ちロボット１は、樹幹を柱体として昇降動作する柱体昇降機２と、モータ駆動により樹幹から延びる枝を切断可能な切断装置としての電動チェーンソー３を備えている。

詳述すると、本実施形態の柱体昇降機２は、略円環状の機枠４と、この機枠４に固定された一対の車輪支持装置５とを備えている。そして、これらの車輪支持装置５が支持する車輪７を柱体の外周面に当接させることにより、その柱体に対する上下方向の相対位置を保持し、及び柱体を昇降することが可能となっている。

図２（ａ）（ｂ）に示すように、機枠４は、その柱体となる樹幹１０を取り囲むように同樹幹１０の径方向外側に配置される。尚、本実施形態の機枠４には、ジョイント部１３及び関節部１４が設けられている。そして、柱体昇降機２の機体（装置全体）を樹幹１０に取り付ける際には、このジョイント部１３を操作することにより、その機枠４の円環形状を開くことが可能となっている。

一方、各車輪支持装置５は、機枠４の周方向において互いに略１８０°離間した位置に固定されている。また、本実施形態では、一方の車輪支持装置５Ａは、その支持する車輪７ａを樹幹１０の上下方向において機枠４よりも上側（図２（ｂ）中、上側）に当接させるように構成され、他方の車輪支持装置５Ｂは、その支持する車輪７ｂを機枠４よりも下側（図２（ｂ）中、下側）に当接させるように構成されている。そして、本実施形態の柱体昇降機２は、その重心Ｇが、車輪支持装置５Ｂ側における下側の車輪７ｂよりも径方向外側となるように設計されている。

即ち、このような構成とすることで、その樹幹１０を挟む反対側において上下方向に異なる位置で樹幹１０の外周面１０ａに当接する上下の車輪７ａ，７ｂには、機体の自重に基づいて、これら各車輪７ａ，７ｂを樹幹１０に押し付けるような押付力Ｆ１，Ｆ２が発生する。そして、本実施形態の柱体昇降機２は、この互いに相反する方向の押付力Ｆ１，Ｆ２を利用して、上下の各車輪７ａ，７ｂ間に樹幹１０を挟み込むことにより、その自重により、当該樹幹１０に対する上下方向の相対位置を保持することが可能となっている。

さらに詳述すると、図３及び図４に示すように、各車輪支持装置５は、機枠４に固定される基部１５と、この基部１５から延びる左右一対の支持アーム１６（１６Ｌ，１６Ｒ）とを備えている。また、各支持アーム１６の先端には、それぞれ、独立して車輪７を支持可能な車輪支持部１７が設けられている。そして、本実施形態の各車輪支持装置５は、これら各支持アーム１６が支持する二つの車輪７（７Ｌ，７Ｒ）を、周方向に離間した位置において樹幹１０の外周面１０ａに当接させる構成になっている。

具体的には、各支持アーム１６は、基端側に回動中心となる関節Ｊ１，Ｊ２を有して基部１５に連結された第１リンク２１及び第２リンク２２と、各関節Ｊ１，Ｊ２と同様に二部材間を回動可能に連結する関節Ｊ３，J４を有して第１リンク２１及び第２リンク２２の先端に連結された第３リンク２３とを備えている。そして、車輪支持部１７は、図４に示されるような樹幹１０に対して柱体昇降機２が取り付けられた状態において、第３リンク２３における樹幹１０側の一端に設けられている。

本実施形態では、このような四節リンクを用いて各支持アーム１６が形成されている。そして、その四節リンクを構成する各要素（各関節Ｊ１〜Ｊ４の位置や相互距離等）を調整することにより、図５に示すように、各支持アーム１６の先端に支持された各車輪７が、その各支持アーム１６の動作に基づいて、それぞれ樹幹１０の軸中心Ｐ０に向かって移動するように構成されている。

尚、各支持アーム１６を構成する四節リンクを最適化した場合であっても、その樹幹１０の外周面１０ａに対する各車輪７の接地角は、各車輪７が樹幹１０の軸中心Ｐ０に向かって移動することにより僅かながら変化する。この点を踏まえ、本実施形態では、図６に示すように、各車輪７には、予め、その接地角の変化による影響を抑えるための補正角βが設定されている。具体的には、本実施形態の各支持アーム１６の場合、各車輪７が樹幹１０の外周面１０ａに対して直角に接する状態を基準として、左右の車輪７Ｌ，７Ｒが「逆ハの字型」となるような補正角βが設定されている。

また、図３及び図４に示すように、各車輪支持装置５は、これらの各支持アーム１６（１６Ｌ，１６Ｒ）を左右対称に同期して動作させる駆動装置としてのアームアクチュエータ３５を備えている。そして、本実施形態の各車輪支持装置５は、これにより、図５に示すように、その樹幹１０の外周面１０ａに当接する左右の車輪７Ｌ，７Ｒの軌跡（同図中、二点差線に示す軌跡）が樹幹１０の軸中心Ｐ０で交差するように各支持アーム１６Ｌ，１６Ｒを動作させることが可能となっている。

即ち、このような構成とすることにより、樹径変化により生ずる機体の傾きは、周方向に離間した位置で樹幹１０の外周面１０ａに当接する二つの車輪７（７Ｌ，７Ｒ）の各当接点Ｐ１，Ｐ２の中間点Ｐ３と樹幹の軸中心Ｐ０とを結ぶ直線Ｎに沿ったものとなる。そして、その軌跡が樹幹１０の軸中心Ｐ０で交差するように各車輪７（７Ｌ，７Ｒ）が左右対称に同期して移動することで、樹幹１０の外周面１０ａに対する各車輪７（７Ｌ，７Ｒ）の接触状態が安定する。

本実施形態では、このように各車輪７（の接地面）が樹径変化に依らず樹幹１０の軸中心Ｐ０に向かうようにすることで、各車輪７の転動方向と樹幹１０の軸線方向（上下方向）との間にずれが生ずることによる姿勢の乱れを抑制する（図１４（ａ）（ｂ）参照）。そして、その軸中心Ｐ０を外した状態で各車輪７間に樹幹１０を挟み込むような状態となること回避して、その円滑な動作を担保する構成となっている。

詳述すると、図３及び図４に示すように、各支持アーム１６を構成する第１リンク２１の基端には、その回動中心となる関節Ｊ１に対応したピッチ円中心を有するギヤ部としてのセクターギヤ３６が形成されている。また、アームアクチュエータ３５は、各支持アーム１６Ｒ，１６Ｌの基端にそれぞれ形成された二つのセクターギヤ３６に対して同時に歯合する駆動ギヤとしてのウォームギヤ３７を備えている。具体的には、各車輪支持装置５の基部１５には、駆動源としてのモータ３８が固定されている。そして、アームアクチュエータ３５は、そのモータ３８（の出力軸）を平歯車３９ａ，３９ｂを介してウォームギヤ３７（の回転軸）に接続することにより形成されている。

即ち、このように構成することで、モータ３８の回転は、左右の支持アーム１６Ｌ，１６Ｒに対して同時に伝達される。そして、そのモータ回転に基づいて、各支持アーム１６Ｌ，１６Ｒの第１リンク２１を回動させることにより、図５に示すように、その先端に設けられた各車輪７（７Ｌ，７Ｒ）が同期して樹幹１０の軸中心Ｐ０に向かうように、左右対称に各支持アーム１６Ｌ，１６Ｒを動作させることが可能となっている。

また、本実施形態のウォームギヤ３７は、その歯合するセクターギヤ３６側からの逆入力回転を伝達しないように設計されている。そして、本実施形態では、これにより、そのモータトルクを要することなく、各支持アーム１６の動作位置を保持することが可能となっている。

さらに、本実施形態の柱体昇降機２では、図３及び図４に示すように、各支持アーム１６の先端に設けられた車輪支持部１７には、モータ４１を駆動源として各車輪７を回転駆動する駆動アクチュエータ４２、及びモータ４３を駆動源として樹幹１０の外周面１０ａに当接する各車輪７の舵角を変更可能な操舵アクチュエータ４４が設けられている。そして、本実施形態では、これにより、各車輪支持装置５に支持された各車輪７が、駆動輪及び操舵輪としての機能を備えた能動車輪を構成するようになっている。

図１に示すように、本実施形態の柱体昇降機２では、このように構成された車輪支持装置５が上下一対で機枠４に固定されている。尚、上側の車輪支持装置５Ａは、その各支持アーム１６が機枠４の上側（同図中、上側）に配置されるように上側から機枠４に固定されている。そして、下側の車輪支持装置５Ｂは、その各支持アーム１６が機枠４の下側（同図中、下側）に配置されるように下側から機枠４に固定されている。

また、機枠４には、各車輪支持装置５に設けられたアームアクチュエータ３５、駆動アクチュエータ４２及び操舵アクチュエータ４４（図３参照）の図示しない制御回路や、駆動電源（バッテリー）等が収容された制御ボックス４５が固定されている。具体的には、この制御ボックス４５は、下側の車輪支持装置５Ｂの径方向外側において、その下側の車輪支持装置５Ｂよりも下型に配置されている。そして、本実施形態では、この制御ボックス４５の配置によって、その機体の重心Ｇ（図２（ａ）（ｂ）参照）が規定されるようになっている。

本実施形態の枝打ちロボット１は、このような構成を有する柱体昇降機２の機枠４に、切断装置としての電動チェーンソー３を固定することにより形成されている。具体的には、電動チェーンソー３は、駆動源となるモータ（図示略）を収容するモータボックス５１と、平板状に形成されたガイドバー５２と、モータ駆動によりガイドバー５２の外周を回転動作するチェーン刃５３とを備えている。尚、本実施形態では、モータ回転は、図示しないベルト等を介してモータボックス５１からチェーン刃５３へと伝達される。そして、本実施形態の電動チェーンソー３は、そのガイドバー５２が樹幹１０の外周面１０ａに対向するように、換言すると、樹幹１０の円周に対する接線方向に並行するように配置されている。

ここで、本実施形態の柱体昇降機２は、上記駆動アクチュエータ４２及び操舵アクチュエータ４４を作動させることにより、各車輪支持装置５が支持する各車輪７を能動車輪として樹幹１０の外周面１０ａを走行する態様で同樹幹１０を昇降動作することが可能な自走機能を有している。具体的には、柱体昇降機２は、その走行モードとして、樹幹１０に対して機体を回転させることなく昇降する直動昇降モードと、樹幹を中心に旋回しつつ昇降する旋回昇降モードとを備えている。そして、本実施形態の枝打ちロボット１は、枝打ち作業を行う際、その柱体昇降機２の走行モードを旋回昇降モードに切り替えることにより、機体と一体に旋回する電動チェーンソー３によって、そのチェーン刃５３に接触する枝を切断する構成となっている。

尚、本実施形態では、電動チェーンソー３の制御回路は、各車輪支持装置５に設けられた各アクチュエータの制御回路とともに、上記制御ボックス４５内に収容されている。また、制御ボックス４５内には、無線通信装置が収容されている。そして、柱体昇降機２の昇降モードの切り替えや電動チェーンソー３の作動等といった枝打ちロボット１の動作は、その無線通信機能を利用することにより、図示しないコントローラ（リモコン）を介して操作することが可能となっている。

次に、上記のように構成された本実施形態の枝打ちロボットの制御態様について説明する。
（姿勢制御）
まず、柱体昇降機の姿勢制御について説明する。

図７に示すように、本実施形態では、各車輪支持装置５（５Ａ，５Ｂ）に設けられたアームアクチュエータ（アームＡＣＴ）３５のモータ３８は、制御ボックス４５内に収容された制御回路６０に接続されている。そして、各アームアクチュエータ３５は、制御回路６０がモータ３８に供給する駆動電力に基づいて作動する。

詳述すると、制御回路６０は、各モータ３８に設けられた回転センサ６１の出力信号に基づいて、下側の車輪支持装置５Ｂにおけるモータ角ｑ１、及び上側の車輪支持装置５Ａにおけるモータ角ｑ２を検出する。また、制御回路６０には、傾斜角度（姿勢角度）センサ６２が接続されており、姿勢角度検出手段としての制御回路６０は、この傾斜角度センサ６２の出力信号に基づいて、機体の傾きを示す姿勢角度（傾斜角度）θを検出する。尚、傾斜角度センサ６２としては、例えば、周知のジャイロセンサ等を利用することができる。そして、制御回路６０は、機体の姿勢を維持すべく、その検出される姿勢角度θに基づいて、各車輪支持装置５（５Ａ，５Ｂ）に設けられた各アームアクチュエータ３５の作動、即ち当該各アームアクチュエータ３５により駆動される各支持アーム１６の動作位置（ε２，ε１）を制御する。

図５に示すように樹幹１０の直径（樹径）が変化する場合、その樹径の変化に合わせて、上側（の車輪支持装置５Ａ）の各支持アーム１６及び下側（の車輪支持装置５Ｂ）の各支持アーム１６の動作位置を変化させることにより、機体の姿勢を維持することができる。そして、本実施形態の制御回路６０は、その検出される姿勢角度θを目標姿勢角度に追従させるべく、その各支持アーム１６の動作位置を制御する。尚、本実施形態では、機枠４の水平を基準とする「姿勢角度θ＝０」が目標角度となっている。

つまり、樹径の変化に上側（の車輪支持装置５Ａ）の各支持アーム１６及び下側（の車輪支持装置５Ｂ）の各支持アーム１６の動作位置が対応してない場合には、機体の傾きを示す姿勢角度θが検出される。そして、その姿勢角度θが目標姿勢角度（θ＝０）になるように各支持アーム１６の動作位置を制御することで、その機体の傾きを修正することができる。

さらに詳述すると、本実施形態の制御回路６０は、下側の車輪支持装置５Ｂに設けられた各支持アーム１６を主アームＭＡとして、当該主アームＭＡについては、その検出される姿勢角度θと目標姿勢角度との偏差に基づくフィードバック制御演算を実行する。そして、その目標姿勢角度に検出される姿勢角度θが追従するように、その主アームＭＡの動作位置（ε１）を制御する。尚、このフィードバック制御演算は、以下の（１）式に示されるＰＩＤ（比例・積分・微分）制御の式に基づいて行われる。

但し、「u(t)」は制御入力、「k_P」「k_D」「K_I」は、それぞれ比例，微分，積分のフィードバックゲイン、「θ_d」「θ(t)」は、目標姿勢角度と実姿勢角度である。「t_s」は、積分開始時刻である。そして、添字の「m」は主アーム系を示し、「s」は従アーム系を示すものとする。

また、制御回路６０は、上側の車輪支持装置５Ａに設けられた各支持アーム１６を従アームＳＡとして、当該従アームＳＡについては、下側の車輪支持装置５Ｂにおけるモータ角ｑ１と上側の車輪支持装置５Ａにおけるモータ角ｑ２との偏差に基づくフィードバック制御演算を実行する。そして、下側の車輪支持装置５Ｂにおけるモータ角ｑ１に上側の車輪支持装置５Ａにおけるモータ角ｑ２が一致するように、その従アームＳＡの動作位置（ε２）を制御する。尚、このフィードバック制御演算は、以下の（２）式に示されるＰＩＤ（比例・積分・微分）制御の式に基づいて行われる。

但し、「q(t)」は、制御要素としてのモータ角を表す。

即ち、下側の車輪支持装置５Ｂにおけるモータ角ｑ１は、主アームＭＡの動作位置（ε１）に対応する制御要素であり、上側の車輪支持装置５Ａにおけるモータ角ｑ２は、従アームＳＡの動作位置（ε２）に対応する制御要素である。本実施形態では、その上側の車輪支持装置５Ａにおけるモータ角ｑ２が、下側の車輪支持装置５Ｂにおけるモータ角ｑ１に一致するように制御することにより、その主アームＭＡと従アームＳＡとの間に応答遅れが生じない構成となっている。そして、これにより、樹幹１０の軸中心Ｐ０と機体の軸中心とが常に略一致するようになっている。

さらに、制御回路６０は、検出される姿勢角度θが許容範囲を超える場合に、上記のような各支持アーム１６の動作位置制御を実行する。即ち、その検出される姿勢角度θが許容範囲内である場合には、各支持アーム１６の動作位置（ε２，ε１）を変更しない。そして、本実施形態では、これにより、その消費エネルギー（消費電力）の低減を図る構成となっている。尚、この省電力化制御は、主アーム系は以下の（３）〜（５）式、主アーム系は以下の（６）〜（８）式、にそれぞれ示される「場合分け」に基づいて実行される。

但し、「e_θ1」「e_q1」は許容姿勢誤差、「e_θ2(>e_θ1)」「e_q2(>e_q1)」は姿勢制御適用誤差である。

（枝打ち制御）
次に、枝打ち制御の態様について説明する。
本実施形態の枝打ちロボット１では、柱体昇降機２の走行モードを直動昇降モードから旋回昇降モードに切り替えることにより、電動チェーンソー３に対する駆動電力の供給が開始されるようになっている。

ここで、本実施形態では、上記制御ボックス４５内に収容された図示しない電動チェーンソー３の制御回路は、その電動チェーンソー３に作用する外力に応じて変化するモータ負荷に基づいて、当該電動チェーンソー３が樹幹１０から延びる枝を切断する枝打ち状態にあるか否かを判定する。

具体的には、電動チェーンソー３（のチェーン刃５３）に枝が接触し、その外力よりモータ負荷が増大することで、モータ電流が上昇し、及びモータ速度が低下する。本実施形態では、枝打ち判定手段としての電動チェーンソー３の制御回路は、これらのモータ電流及びモータ速度を、それぞれ閾値と比較することにより、そのモータ負荷の大きさ、即ち推定される外力の大きさが、枝打ち状態に対応するものであるか否かを判定する。そして、枝打ち状態にあると判定した場合には、電動チェーンソー３のモータ出力を増大させる構成となっている。

尚、本実施形態では、電動チェーンソー３に対する駆動電力の供給は、制御回路に設けられたドライバ（駆動回路）のオンＤｕｔｙを制御することにより行われる。そして、モータ出力の増減は、そのＤｕｔｙ制御に基づいてモータ入力電圧を変化させることにより行われる。

さらに、本実施形態では、この枝打ち状態判定の結果に基づいて、機体の旋回移動速度が切り替えられる。具体的には、枝打ち状態にあると判定された場合、上記駆動アクチュエータ４２は、その機体の旋回移動速度が遅くなるように制御される。尚、この旋回移動速度の増減は、能動車輪である各車輪７の駆動力（モータ４１の出力）を増減することにより行われる。

そして、本実施形態では、これら電動チェーンソー３の出力可変制御及び機体の旋回移動速度可変制御の実行によって、その切断する枝の大小にかかわらず、円滑な切断を可能とするとともに、併せて、その消費エネルギー（消費電力）の低減を図る構成となっている。

詳述すると、本実施形態では、柱体昇降機２の昇降モードが旋回昇降モードである場合、図８のフローチャートに示すように、先ず、モータ電流及びモータ速度が示すモータ負荷、即ち推定される外力の大きさが枝打ち状態を示すものであるか否かが判定される（ステップ１０１）。そして、そのモータ負荷が枝打ち状態に対応する場合（モータ負荷大（推定外力大）、ステップ１０１：ＹＥＳ）には、そのモータ出力が増大され（モータ入力電圧大、ステップ１０２）、及びその機体の旋回移動速度が減速される（旋回移動速度低、ステップ１０３）。

そして、上記ステップ１０１において、そのモータ負荷が枝打ち状態に対応するものではない場合（モータ負荷小（推定外力小）、ステップ１０１：ＮＯ）には、そのモータ出力が低減され（モータ入力電圧小、ステップ１０４）、及びその機体の旋回移動速度が増速される（旋回移動速度高、ステップ１０５）。

次に、上記枝打ち制御の作用について説明する。
図９に示すように、柱体昇降機２の走行モードが旋回昇降モードに切り替えられた時点、即ち電動チェーンソー３に対する駆動電力の供給が開始された時点（時間ｔ０）では、まだ、当該電動チェーンソー３が枝に接触していないことから、そのモータ負荷を示すモータ電流は小さい値となっている。

本実施形態では、このような場合、電動チェーンソー３に対するモータ入力電圧を低く抑えることで、そのモータ出力が小さくなっている。その結果、電動チェーンソー３は、そのチェーン刃５３が比較遅い速度で回転する状態となる。そして、柱体昇降機２もまた、その旋回移動速度が速い状態に制御されている。

その後、電動チェーンソー３が枝に接触することで（時間ｔ１）、その外力によりモータ負荷が増大し、モータ電流が上昇（及びモータ速度が低下）する。そして、そのモータ負荷の増大、即ち推定される外力の増大に基づいて、枝打ち状態にあることが検知される（ｔ２）。

本実施形態では、この枝打ち状態の検知によって、電動チェーンソー３に対するモータ入力電圧が増大され、これにより、モータ出力が大きくなる。また、併せて、その旋回移動速度が遅くなるように柱体昇降機２が制御される。そして、これにより、その接触する枝を円滑に切断することが可能になっている。

さらに、その後、その枝の切断が完了することで、モータ負荷が減少し、そのモータ電流が低下（及びモータ速度が上昇）する。そして、これにより、枝打ち状態ではないことが検知されることで（時間ｔ３）、その旋回移動速度が速い状態となるように柱体昇降機２が制御され、及び電動チェーンソー３に対するモータ入力電圧を低く抑えることにより、そのモータ出力が低減される（時間ｔ４）。

以上、本実施形態によれば、以下のような効果を得ることができる。
（１）柱体昇降機２は、柱体となる樹幹１０の径方向外側に配置される機枠４と、この機枠４に固定される上下一対の車輪支持装置５（５Ａ，５Ｂ）とを備え、樹幹１０を挟む反対側において上下方向に異なる位置で樹幹１０の外周面１０ａに当接する上下の車輪７を有して自重により樹幹１０に対する上下方向の相対位置を保持する。また、各車輪支持装置５は、左右一対の支持アーム１６（１６Ｌ，１６Ｒ）を有して二つの車輪７（７Ｌ，７Ｒ）を独立に支持することにより当該各車輪７（７Ｌ，７Ｒ）を周方向に離間した位置において樹幹１０の外周面１０ａに当接させる。そして、各車輪支持装置５は、その外周面１０ａに当接する各車輪７（７Ｌ，７Ｒ）の軌跡が樹幹１０の軸中心Ｐ０で交差するように各支持アーム１６（１６Ｌ，１６Ｒ）を左右対称に同期して動作させる。

上記構成によれば、樹径変化により生ずる機体の傾きは、周方向に離間した位置で樹幹１０の外周面１０ａに当接する二つの車輪７（７Ｌ，７Ｒ）の各当接点Ｐ１，Ｐ２の中間点Ｐ３と樹幹の軸中心Ｐ０とを結ぶ直線Ｎに沿ったものとなる。そして、その軌跡が樹幹１０の軸中心Ｐ０で交差するように各車輪７（７Ｌ，７Ｒ）が左右対称に同期して移動することで、樹幹１０の外周面１０ａに対する各車輪７（７Ｌ，７Ｒ）の接触状態が安定する。即ち、樹径変化に依らず各車輪７（の接地面）が樹幹１０の軸中心Ｐ０に向かうようにすることで、各車輪７の転動方向と樹幹１０の軸線方向（上下方向）との間にずれが生ずることを抑制することができる。その結果、例えば、所謂「樹幹の細り」が存在する場合であっても、姿勢の乱れを抑え、その軸中心Ｐ０を外した状態で各車輪７間に樹幹１０を挟み込むような状態となること回避することができる。そして、これにより、機体の円滑な動作を担保することができる。

また、動作が円滑になることで、その動作に要する消費エネルギーを低減することができる。更に、その移動に際して各車輪支持装置５や機枠４等、機体にかかる負荷が軽減される。そして，これにより機体に要求される剛性が低くなることで、その軽量化及び小型化を図ることができる。

（２）各支持アーム１６は、基端側に回動中心となる関節Ｊ１，Ｊ２を有して基部１５に連結された第１リンク２１及び第２リンク２２と、各関節Ｊ１，Ｊ２と同様に二部材間を回動可能に連結する関節Ｊ３，J４を有して第１リンク２１及び第２リンク２２の先端に連結された第３リンク２３とを備える。そして、車輪支持部１７は、樹幹１０に対して柱体昇降機２が取り付けられた状態において、第３リンク２３における樹幹１０側の一端に設けられる。

このように四節リンクを用いて各支持アーム１６を形成することで、簡素な構成で高い剛性を確保することができ、これによりその先端に支持する各車輪７を精度よく移動させることができる。そして、その四節リンクを構成する各要素（各関節Ｊ１〜Ｊ４の位置や相互距離等）を調整することで、その各支持アーム１６の動作に基づいて、それぞれ樹幹１０の軸中心Ｐ０に向かって直線的に移動するようにすることができる。

（３）各支持アーム１６を構成する第１リンク２１の基端には、その回動中心と関節Ｊ１に対応したピッチ円中心を有するギヤ部としてのセクターギヤ３６が形成される。そして、アームアクチュエータ３５は、各支持アーム１６Ｒ，１６Ｌの基端にそれぞれ形成された二つのセクターギヤ３６に対して同時に歯合する駆動ギヤとしてのウォームギヤ３７を備える。

上記構成によれば、一のアームアクチュエータ３５の駆動力（１自由度）が、左右の支持アーム１６Ｌ，１６Ｒ（２リンクアーム）に対して同時に伝達される。その結果、簡素な構成にて、容易且つ確実に各支持アーム１６Ｌ，１６Ｒを左右対称に同期して動作させることができる。

（４）ウォームギヤ３７は、その歯合するセクターギヤ３６側からの逆入力回転を伝達しないように設計される。これにより、そのモータトルクを要することなく、各支持アーム１６の動作位置を保持することができる。即ち、現状の姿勢を維持するためのエネルギーを必要としない。その結果、消費エネルギーの低減を図ることができる。

（５）各支持アーム１６の先端に設けられた車輪支持部１７には、モータ４１を駆動源として各車輪７を回転駆動する駆動アクチュエータ４２、及びモータ４３を駆動源として樹幹１０の外周面１０ａに当接する各車輪７の舵角を変更可能な操舵アクチュエータ４４が設けられる。

即ち、このような各車輪７が駆動輪及び操舵輪としての機能を有する能動車輪である構成では、軸中心Ｐ０を外した状態で各車輪７間に樹幹１０を挟み込むような状態となることによって、その機体を動作させるために各車輪７に要求される駆動力が顕著に大きく増大する。特に、各車輪７が操舵輪である場合には、各車輪７を操舵する際（転動方向を変える際）、その挟み込んだ樹幹１０が各車輪７に引っ掛かる。そして、これにより、消費エネルギーが大きく増大する。従って、このような構成に上記（１）〜（４）の構成を適用することで、より顕著な効果を得ることができる。

さらに、各車輪７に舵角が発生する旋回昇降時においても、当該車輪７が各車輪７（の接地面）が樹幹１０の軸中心Ｐ０に向かうことで、その姿勢を良好に維持することができる。そして、その電動チェーンソー３が機体と一体に旋回する枝打ちロボット１の場合、旋回昇降時においても機体を略水平に維持することが可能となることで、その接触する枝を、より円滑に切断することができる。

（６）各アームアクチュエータ３５は、制御回路６０によって、その作動が制御される。制御回路６０は、傾斜角度センサ６２の出力信号に基づいて、機体の傾きを示す姿勢角度（傾斜角度）θを検出する。そして、その検出される姿勢角度θに基づいて、各アームアクチュエータ３５が駆動する各支持アーム１６の動作位置を制御する。

即ち、機体の傾きは、各支持アーム１６が支持する各車輪７と樹幹１０の外周面１０ａとの間の隙間、即ち各支持アーム１６の動作位置により決定される。従って、上記構成のように、その検出される姿勢角度θに基づいて各支持アーム１６の動作位置を制御することで、その機体の傾きを制御することができる。そして、このような位置制御により各支持アーム１６を動作させる構成とすることで、樹幹１０に対する各車輪７の押し付け圧力を制御する構成と比較して、より高い信頼性を確保することができる。加えて、その制御内容を含め、構成を簡素化することができる。

（７）各車輪支持装置５（５Ａ，５Ｂ）に設けられた各支持アーム１６は、制御ボックス４５内に収容された一の制御回路６０によって、その動作位置が制御される。即ち、各車輪支持装置５（５Ａ，５Ｂ）は、各支持アーム１６の位置制御装置としての制御回路６０を共有する。このような構成とすれば、その上側の車輪支持装置５Ａに設けられた各支持アーム１６及び下側の車輪支持装置５Ｂに設けられた各支持アーム１６を同期して動作させることが容易になる。その結果、より好適に機体の姿勢を維持することができる。

（８）主アーム制御手段としての制御回路６０は、下側の車輪支持装置５Ｂに設けられた各支持アーム１６を主アームＭＡとして、当該主アームＭＡについては、その検出される姿勢角度θと目標姿勢角度との偏差に基づくフィードバック制御演算を実行する。そして、従アーム制御手段としての制御回路６０は、上側の車輪支持装置５Ａに設けられた各支持アーム１６については、従アームＳＡとして、下側の車輪支持装置５Ｂにおけるモータ角ｑ１と上側の車輪支持装置５Ａにおけるモータ角ｑ２との偏差に基づくフィードバック制御演算を実行する。

即ち、下側の車輪支持装置５Ｂにおけるモータ角ｑ１は、主アームＭＡの動作位置（ε１）に対応する制御要素であり、上側の車輪支持装置５Ａにおけるモータ角ｑ２は、従アームＳＡの動作位置（ε２）に対応する制御要素である。従って、上記構成により、上側の車輪支持装置５Ａにおけるモータ角ｑ２が、下側の車輪支持装置５Ｂにおけるモータ角ｑ１に一致するように制御することによって、その主アームＭＡと従アームＳＡとの間の応答遅れを抑制することができる。その結果、より好適に機体の姿勢を維持することができる。

（９）制御回路６０は、検出される姿勢角度θが許容範囲を超える場合に、上記のような各支持アーム１６の動作位置制御を実行する。これにより、その検出される姿勢角度θが許容範囲内である場合には、各支持アーム１６の動作位置を変更しないことで、その消費エネルギー（消費電力）の低減を図ることができる。

（１０）電動チェーンソー３の制御回路は、電動チェーンソー３が樹幹１０から延びる枝に接触して同枝を切断する枝打ち状態にあるか否かを判定する。この枝打ち状態判定は、モータ電流及びモータ速度が示すモータ負荷の大きさ、即ち推定される外力の大きさが、枝打ち状態に対応するものであるか否かに基づいて行われる。そして、枝打ち状態にあると判定した場合には、電動チェーンソー３のモータ出力を増大させる。

即ち、モータ出力を増大することで、より円滑に枝を切断することができる。その結果、作業効率を向上させることができる。そして、枝打ち状態ではない場合のモータ出力を予め低く抑えておくことで、その消費エネルギー（消費電力）の低減を図ることができる。

（１１）枝打ち状態にあると判定された場合、駆動アクチュエータ４２は、機体の旋回移動速度が遅くなるように制御される。
即ち、機体の旋回移動速度を遅くすることで、切断する枝が太い場合であっても、その機体の旋回に枝の切断が追いつかずチェーン刃５３に枝が噛み込むような事態を回避することができる。その結果、枝の大小にかかわらず円滑に切断することができる。また、枝打ち状態ではない場合における旋回移動速度を速く設定することで、全体としては、素早い枝打ち作業が可能になる。そして、これにより、作業効率を向上させることができる。

［第２の実施形態］
以下、本発明を具体化した第２の実施形態を図面に従って説明する。尚、第１の実施形態と同様の構成については、同一の符号を付して、その説明を省略する。

本実施形態は、上記第１の実施形態との比較において、柱体昇降機２の姿勢制御態様が相違する。
詳述すると、本実施形態では、上側の車輪支持装置５Ａに設けられた各支持アーム１６及び下側の車輪支持装置５Ｂに設けられた各支持アーム１６は、同一の制御内容で制御回路６０により制御される（図７参照）。

具体的には、本実施形態の制御回路６０は、各支持アーム１６を駆動するアームアクチュエータ３５のモータ角（ｑ）を、その各支持アーム１６の動作位置に対応する制御要素とする。そして、検出される姿勢角度θに基づいてモータ角（ｑ）の目標値を演算し、その目標値と実際値との偏差に基づくフィードバック制御演算を実行することにより、各支持アーム１６の動作位置を制御する。尚、このフィードバック制御演算は、以下の（９）式に示されるＰＩＤ（比例・積分・微分）制御の式に基づいて行われる。

さらに詳述すると、図１０及び図１１に示すように、柱体昇降機２においては、その検出される機体の姿勢角度θ、樹幹１０の直径Ｄ、及び各支持アーム１６の動作位置を示すモータ角ｑには、互いに相関関係がある。

即ち、図１０に示すように、機体に傾きが生じている場合、その機体を水平とするために必要な各支持アーム１６の動作位置の補正量δは、以下に示す（１０）式に基づいて、樹幹１０を挟む反対側において当該樹幹１０の外周面に当接する上下の車輪７（の当接点）間の距離Ｌと姿勢角度θとから求めることができる。

また、図１１に示すように、各車輪７の接点位置ベクトルを「ｐ」とすると、樹幹１０の直径Ｄは、次の（１１）式に表される。

そして、樹幹１０の軸中心Ｐ０を交点とした場合において、その外周面１０ａに当接する左右の車輪７Ｌ，７Ｒの挟み角（車輪取付角度、図５参照、∠「Ｐ１」「Ｐ０」「Ｐ２」）を「α」とすれば、更に以下の（１２）〜（１４）式が成り立つ。

但し、「p_d」は目標接点位置である。また、「f」は運動学の関係式、「f^-1」は逆運動学の関係式の関係を表す関係式である。

本実施形態の制御回路６０は、上記（１０）〜（１４）式に基づいて、各支持アーム１６の動作位置に対応するモータ角ｑの目標値を演算する。尚、樹幹１０の直径Ｄについては、樹幹１０に対し機体を水平に取り付けることにより、その初期値が演算される。そして、制御回路６０は、上記（９）式に基づいて、上下一対の車輪支持装置５（５Ａ，５Ｂ）に設けられた各支持アーム１６を同時に制御する。

ここで、図１２のフローチャートに示すように、本実施形態の制御回路６０は、樹幹１０を上昇する場合（ステップ２０１：ＹＥＳ）には、上記（１０）〜（１４）式を用いることにより、その姿勢角度θ及びモータ角ｑ（各支持アームの動作位置）から、樹幹１０の直径Ｄを演算する（ステップ２０２）。そして、その直前に演算された直径Ｄを用いてモータ角ｑの目標値を演算する（ステップ２０３）。

また、制御回路６０は、その上昇の際に演算した直径Ｄに関する情報（直径情報）を樹幹１０に対する上下方向の相対位置毎に記憶する（ステップ２０４）。即ち、本実施形態では、制御回路６０が直径演算手段及び記憶手段を構成する。そして、樹幹１０を降下する際（ステップ２０１：ＮＯ）には、その上昇の際に記憶された直径情報を読み出すことにより（ステップ２０５）、モータ角ｑの目標値を演算する。

具体的には、本実施形態の制御回路６０は、その記憶された直径情報に示される値を僅かに大きく補正して（ステップ２０６）、モータ角ｑの目標値を演算する（ステップ２０７）。そして、これにより、樹幹１０の外周面１０ａに当接する各車輪７の押し付け力を低減することで、速やかに樹幹１０を降下することが可能となっている。

さらに、制御回路６０は、検出される姿勢角度θが許容範囲を超える場合に、上記のような各支持アーム１６の動作位置制御を実行する。即ち、その検出される姿勢角度θが許容範囲内である場合には、各支持アーム１６の動作位置を変更しない。そして、本実施形態では、これにより、その消費エネルギー（消費電力）の低減を図る構成となっている。尚、この省電力化制御は、以下の（１５）〜（１７）式に示される「場合分け」に基づいて実行される。

以上、本実施形態によれば、上記第１の実施形態と同様の効果を得ることができる。さらに、より速やかに各支持アーム１６の動作位置を収束させることができる。その結果、より好適に機体の姿勢を維持することができる。そして、より速やかに樹幹１０から降下することが可能となることで、その作業効率を向上させることができる。

なお、上記各実施形態は以下のように変更してもよい。
・上記各実施形態では、本発明を枝打ちロボット１及びその柱体昇降機２に具体化した。しかし、これに限らず、枝打ち以外の用途に用いられる柱体昇降機に適用してもよい。即ち、その昇降する柱体は、例えば、電柱等、必ずしも樹幹１０でなくともよい。

・上記各実施形態では、四節リンクを用いて各支持アーム１６を形成することとしたが、必ずしもこれに限らず、任意に変更してもよい。また、駆動手段となるアームアクチュエータ３５の構成及びその各支持アーム１６の駆動形態についても任意に変更してもよい。例えば、セクターギヤ３６はサンギヤであってもよい。

・二つの車輪７を独立に支持して当該各車輪７を周方向に離間した位置において樹幹１０の外周面１０ａに当接させることが可能な左右一対の支持アームがあり、且つその各車輪７の軌跡が樹幹１０の軸中心Ｐ０で交差するように各支持アームが左右対称に同期して動作する構成であればよい。従って、左右の支持アーム１６Ｌ，１６Ｒが独立したアクチュエータによって駆動される構成についても、これを排除しない。

・上記各実施形態では、各支持アーム１６に支持された各車輪７が、それぞれ、駆動輪及び操舵輪としての機能を有する能動車輪であることした。しかし、これに限らず、別途駆動輪や操舵輪を備える構成であってもよく、また、その何れか一方の機能を有するものであってもよい。

・上記第１の実施形態では、上側の車輪支持装置５Ａに設けられた各支持アーム１６については、従アームＳＡとして、下側の車輪支持装置５Ｂにおけるモータ角ｑ１と上側の車輪支持装置５Ａにおけるモータ角ｑ２との偏差に基づくフィードバック制御演算を実行することとした。しかし、これに限らず、上側の車輪支持装置５Ａに設けられた各支持アーム１６を主アームＭＡとし、下側の車輪支持装置５Ｂに設けられた各支持アーム１６を従アームＳＡとしてもよい。また、主アームＭＡ及び従アームＳＡの区別なく、下側の車輪支持装置５Ｂに設けられた各支持アーム１６と同様に、その検出される姿勢角度θと目標姿勢角度との偏差に基づくフィードバック制御演算を実行する構成であってもよい。

・また、上記各実施形態では、各車輪支持装置５（５Ａ，５Ｂ）に設けられた各支持アーム１６は、制御ボックス４５内に収容された一の制御回路６０によって、その動作位置が制御されることとした。しかし、このように、各車輪支持装置５（５Ａ，５Ｂ）が、各支持アーム１６の位置制御装置を共有する構成でなく、それぞれが個別に位置制御装置を備える構成であってもよい。

・上記第２の実施形態では、検出される機体の姿勢角度θ、樹幹１０の直径Ｄ、及び各支持アーム１６の動作位置を示すモータ角ｑの相関関係を利用する幾何的制御手段により制御目標値を演算することとした。しかし、これに限らず、第１の実施形態に示されるような一般的なフィードバック制御による姿勢角制御手段を組み合わせる構成としてもよい。例えば、主アームＭＡ又は従アームＳＡの一方を姿勢角制御手段が制御し、他方を幾何的制御手段が制御する等としてもよい。

・さらに、上記第２の実施形態では、上昇の際に演算した直径Ｄに関する情報（直径情報）を樹幹１０に対する上下方向の相対位置毎に記憶する（ステップ２０４）。そして、樹幹１０を降下する際（ステップ２０１：ＮＯ）には、その上昇の際に記憶された直径情報を読み出すことにより（ステップ２０５）、モータ角ｑの目標値を演算することとした。しかし、これに限らず、降下する際についても上昇する際と同様の降下を行う構成であってもよい。そして、記憶された直径情報を読み出して目標値を演算する場合であっても、その直径情報に示される値の補正は行わなくともよい。

・また、上記実施形態では、各支持アーム１６を駆動するアームアクチュエータ３５のモータ角（ｑ）を各支持アーム１６の動作位置に対応する制御要素としたが、必ずしもこれに限らず、例えば、各支持アーム１６の関節角等、その他のものを制御要素として用いる構成であってもよい。

・上記各実施形態では、機体を水平（θ＝０）にするように姿勢制御の目標値を設定することとしたが、任意の値を目標値として設定可能な構成であってもよい。
・上記各実施形態では、検出される姿勢角度θが許容範囲を超える場合に、上記のような各支持アーム１６の動作位置制御を実行し、その検出される姿勢角度θが許容範囲内である場合には、各支持アーム１６の動作位置を変更しないこととしたが、このような許容範囲を設定しない構成であってもよい。

・上記各実施形態では、切断装置としての電動チェーンソー３に柱体昇降機２の機枠４に固定される。そして、機体と一体に旋回することにより、そのチェーン刃５３に接触する枝を切断することとした。しかし、これに限らず、切断装置自体が樹幹１０の周囲を移動する機能を備えた構成であってもよい。また、切断機は、エンジン付きチェーンソーでもよい。そして、例えば、回転刃を有するもの等、刃形状や駆動方法等は、どのようなものであってもよい。

・上記各実施形態では、その枝打ち制御として、モータ負荷に基づいて、枝打ち状態にあるか否かを判定し、枝打ち状態にある場合には、そのモータ出力を増大させ、及び機体の旋回移動速度を遅くすることとした。しかし、これに限らず、このようなモータ出力を変化させる出力可変手段及び機体の旋回移動速度を変化させる旋回移動速度可変手段を有しない構成としてもよい。そして、これらの何れかを備える構成であってもよい。

・上記各実施形態では、モータ負荷を示す状態量としてモータ電流及びモータ速度を用いることとした。しかし、これに限らず、例えば、モータ電流又はモータ速度の何れか一方、或いはモータ負荷を示すその他の状態量を用いて枝打ち状態判定を行う構成としてもよく、任意に選択し組み合わせて用いてもよい。尚、これらの各状態量は、電流センサや回転センサ等、周知のセンサを用いて検出すればよい。そして、モータ出力の変更についてもまた、電圧又は電流の何れを変化させてもよい。

・上記各実施形態では、枝打ちロボット１に設けられた切断装置としての電動チェーンソー３について、そのモータ負荷に基づいて、枝打ち状態にあるか否かを判定し、枝打ち状態にある場合には、そのモータ出力を増大させることとした。しかし、これに限らず、
図１３に示されるような単体で使用される電動チェーンソー８０について、このようなモータ出力の可変制御を適用してもよい。

この電動チェーンソー８０においては、筐体８１に内蔵された制御回路８２によって、その駆動源であるモータ８３が制御される。そして、制御回路８２は、その筐体８１に設けられたスイッチ８４が操作されることにより、モータ８３に対して駆動電力を供給し、及びその供給を停止する。

また、制御回路８２は、上記各実施形態と同様に、モータ電流及びモータ速度が示すモータ負荷の大きさ、即ち推定される外力の大きさが、被切断体を切断する切断状態に対応するものであるか否かを判定する。そして、切断状態にあると判定した場合には、そのモータ出力を増大させるように制御する。

尚、具体的な制御内容は、図８に示す上記各実施形態と同様である。即ち、この電動チェーンソー８０においては、その制御回路８２が切断状態判定手段及び出力可変手段を構成する。このような構成とすることで、作業効率が高く、且つ省エネルギー性に優れた電動チェーンソーを提供することができる。

・上記各実施形態では、フィードバック制御演算としてＰＩＤ（比例・積分・微分）制御を行うこととしたが、Ｐ制御（比例制御）でも、ＰＩ制御（比例・積分制御）でも、ＰＤ制御（比例・微分制御）でもよい。

次に、以上の実施形態から把握することのできる技術的思想を記載する。
（イ）モータ駆動により被切断体を切断する電動チェーンソーにおいて、モータ負荷に基づいて前記被切断体を切断する切断状態にあるか否かを判定する切断状態判定手段と、前記切断状態にあると判定された場合にモータ出力を増大させる出力可変手段と、を備えること、を特徴とする電動チェーンソー。

即ち、モータ出力を増大することで、より円滑に被切断体を切断することができる。その結果、作業効率を向上させることができる。そして、切断状態ではない場合のモータ出力を予め低く抑えておくことで、その消費エネルギー（消費電力）の低減を図ることができる。

１…枝打ちロボット、２…柱体昇降機、３…電動チェーンソー、４…機枠、５（５Ａ，５Ｂ）…車輪支持装置、７（７ａ，７ｂ，７Ｒ，７Ｌ）…車輪、１０…樹幹、１０ａ…外周面、１６（１６Ｌ，１６Ｒ）…支持アーム、１７…車輪支持部、２１…第１リンク、２２…第２リンク、２３…第３リンク、３５…アームアクチュエータ、３６…セクターギヤ、３７…ウォームギヤ、３８…モータ、４１…モータ、４２…駆動アクチュエータ、４３…モータ、４４…操舵アクチュエータ、４５…制御ボックス、５１…モータボックス、５２…ガイドバー、５３…チェーン刃、６０…制御回路、６１…回転センサ、６２…傾斜角度センサ、７０…柱体、７０ａ…外周面、７１…主車輪、７２…機体、Ｇ…重心、Ｆ１，Ｆ２…押付力、Ｊ１〜Ｊ４…関節、Ｐ０…軸中心、Ｐ１，Ｐ２…当接点、Ｐ３…中間点、Ｎ…直線、β…補正角、θ…姿勢角度、ＭＡ…主アーム、ＳＡ…従アーム、ｑ，ｑ１，ｑ２…モータ角、Ｄ…直径、Ｌ…距離、δ…補正量。

Claims (15)

1. 柱体を挟む反対側において上下方向に異なる位置で前記柱体の外周面に当接する上下の車輪を有して自重により前記柱体に対する上下方向の相対位置を保持可能な柱体昇降機において、
   前記柱体の径方向外側に配置される機枠と、
   前記機枠に固定される上下一対の車輪支持装置と、を備え、
   前記各車輪支持装置は、
   左右一対の支持アームを有して二つの車輪を独立に支持することにより該各車輪を周方向に離間した位置において前記柱体の外周面に当接させるとともに、
   前記各支持アームを左右対称に同期して動作させることにより前記各車輪が同期して前記柱体の軸中心に向かうように前記外周面に当接させること、を特徴とする柱体昇降機。
2. 請求項１に記載の柱体昇降機において、
   前記各支持アームは、基端側に回動中心を有する第１リンク及び第２リンクと、該第１リンク及び第２リンクの先端に対して回動可能に連結された第３リンクと、該第３リンクの一端に設けられた車輪支持部と、を備えてなること、を特徴とする柱体昇降機。
3. 請求項２に記載の柱体昇降機において、
   前記第１リンクの基端には、前記回動中心に対応するピッチ円中心を有したギヤ部が形成されるとともに、
   前記各車輪支持装置は、前記各支持アームの前記ギヤ部に対して同時に噛合する駆動ギヤを備えた駆動装置を有すること、を特徴とする柱体昇降機。
4. 請求項３に記載の柱体昇降機において、
   前記駆動ギヤは、前記ギヤ部側からの逆入力回転を伝達しないウォームギヤであること、を特徴とする柱体昇降機。
5. 請求項１〜請求項４の何れか一項に記載の柱体昇降機において、
   前記各車輪が操舵輪又は駆動輪の少なくとも何れかの機能を有すること、
   を特徴とする柱体昇降機。
6. 請求項１〜請求項５の何れか一項に記載の柱体昇降機において、
   機体の傾きを示す姿勢角度を検出する姿勢角度検出手段と、
   検出される前記姿勢角度に基づいて、前記各支持アームの動作位置を制御する位置制御装置と、を備えること、を特徴とする柱体昇降機。
7. 請求項６に記載の柱体昇降機において、
   前記位置制御装置は、検出される前記姿勢角度を目標姿勢角度に追従させるべく、該目標姿勢角度と前記姿勢角度との偏差に基づいて、前記各支持アームの動作位置を制御する姿勢角制御手段を備えること、を特徴とする柱体昇降機。
8. 請求項６又は請求項７に記載の柱体昇降機において、
   前記位置制御装置は、検出される前記姿勢角度、前記柱体の直径、及び前記動作位置の関係に基づいて、前記動作位置に対応する制御要素の目標値を演算し、該目標値に前記制御要素の実際値を追従させるべく制御する幾何的制御手段を備えること、
   を特徴とする柱体昇降機。
9. 請求項８に記載の柱体昇降機において、
   前記幾何的制御手段は、
   前記姿勢角度と前記動作位置とに基づいて前記柱体の直径を演算する直径演算手段と、
   前記柱体を上昇する際に演算される前記直径に関する情報を前記上下方向の相対位置毎に記憶する記憶手段と、を備え、
   前記柱体を下降する際には、その記憶された情報に示される前記直径に基づいて前記目標値を演算すること、を特徴とする柱体昇降機。
10. 請求項６〜請求項９の何れか一項に記載の柱体昇降機において、
    前記位置制御装置は、前記姿勢角度が許容範囲を超える場合に前記各支持アームの動作位置制御を実行すること、を備えること、を特徴とする柱体昇降機。
11. 請求項６〜請求項１０の何れか一項に記載の柱体昇降機において、
    前記各車輪支持装置は、前記位置制御装置を共有すること、
    を特徴とする柱体昇降機。
12. 請求項１１に記載の柱体昇降機において、
    前記位置制御装置は、
    前記各車輪支持装置のうち、一方の車輪支持装置における前記各支持アームを主アームとして、前記姿勢角度に基づき前記主アームの動作位置を制御する主アーム制御手段と、
    他方の前記車輪支持装置の前記各支持アームを従アームとして、該従アームの動作位置を前記主アームの動作位置に一致させるべく制御する従アーム制御手段と、
    を備えること、を特徴とする柱体昇降機。
13. 請求項１〜請求項１２の何れか一項に記載の柱体昇降機を有して樹幹を昇降動作するとともに、前記樹幹から延びる枝を切断可能な切断装置を備えた枝打ちロボット。
14. 請求項１３に記載の枝打ちロボットにおいて、
    前記切断装置は、モータ駆動により前記枝を切断するものであって、
    モータ負荷に基づいて前記切断装置が前記枝を切断する枝打ち状態にあるか否かを判定する枝打ち判定手段と、
    前記枝打ち状態にあると判定された場合に前記切断装置のモータ出力を増大させる出力可変手段を備えること、を特徴とする枝打ちロボット。
15. 請求項１３又は請求項１４に記載の枝打ちロボットにおいて、
    前記柱体昇降機は、樹幹を中心に旋回しつつ昇降する旋回昇降機能を有するとともに、前記切断装置は、前記柱体昇降機と一体に旋回しつつ前記切断装置に接触する前記枝をモータ駆動により切断するものであって、
    モータ負荷に基づいて前記切断装置が前記枝を切断する枝打ち状態にあるか否かを判定する枝打ち判定手段と、
    前記枝打ち状態にあると判定された場合に前記柱体昇降機の旋回移動速度を減速させる旋回移動速度可変手段とを備えること、を特徴とする枝打ちロボット。