JP2010012928A - Traveling vehicle for irregular ground - Google Patents
Traveling vehicle for irregular ground Download PDFInfo
- Publication number
- JP2010012928A JP2010012928A JP2008174580A JP2008174580A JP2010012928A JP 2010012928 A JP2010012928 A JP 2010012928A JP 2008174580 A JP2008174580 A JP 2008174580A JP 2008174580 A JP2008174580 A JP 2008174580A JP 2010012928 A JP2010012928 A JP 2010012928A
- Authority
- JP
- Japan
- Prior art keywords
- control valve
- traveling
- hydraulic cylinder
- electromagnetic proportional
- work machine
- 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.)
- Pending
Links
- 230000001788 irregular Effects 0.000 title abstract 2
- 238000005452 bending Methods 0.000 claims abstract description 8
- 239000010720 hydraulic oil Substances 0.000 claims abstract description 7
- 230000007246 mechanism Effects 0.000 claims description 18
- 230000004043 responsiveness Effects 0.000 abstract description 3
- 230000001276 controlling effect Effects 0.000 abstract 2
- 230000001105 regulatory effect Effects 0.000 abstract 1
- 210000002414 leg Anatomy 0.000 description 62
- 210000002683 foot Anatomy 0.000 description 46
- 230000036544 posture Effects 0.000 description 26
- 210000004394 hip joint Anatomy 0.000 description 21
- 210000000544 articulatio talocruralis Anatomy 0.000 description 20
- 238000001514 detection method Methods 0.000 description 20
- 210000000629 knee joint Anatomy 0.000 description 16
- 210000000689 upper leg Anatomy 0.000 description 12
- 210000001226 toe joint Anatomy 0.000 description 10
- 230000008859 change Effects 0.000 description 9
- 210000003108 foot joint Anatomy 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 230000004044 response Effects 0.000 description 4
- 210000003423 ankle Anatomy 0.000 description 3
- 210000001503 joint Anatomy 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 239000003921 oil Substances 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 239000012530 fluid Substances 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000000630 rising effect Effects 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 238000004040 coloring Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 210000003127 knee Anatomy 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 229920003051 synthetic elastomer Polymers 0.000 description 1
- 239000005061 synthetic rubber Substances 0.000 description 1
Images
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
Abstract
Description
本願発明は、山林で伐採した材木や植林用苗木の運搬等に使用する不整地用走行車両に係り、より詳しくは、走行部に左右の脚機構を介して作業機体を支持して、森林を構成する樹木の間を移動する不整地用走行車両に関するものである。 The present invention relates to a traveling vehicle for rough terrain used for transporting timbers and planting seedlings harvested in a forest, and more specifically, supports a work machine body via left and right leg mechanisms on a traveling part, The present invention relates to a traveling vehicle for rough terrain that moves between constituent trees.
この種の不整地用走行車両は、特許文献1に示すように、エンジンが搭載された作業機体と、作業機体を支持する左右の脚機構と、各脚機構の下端に設けられた前側走行部及び後側走行部と、各脚機構を屈曲作動させる油圧シリンダと、各油圧シリンダに対する作動油の給排量を調節する電磁比例制御弁と、各電磁比例制御弁の作動を制御するコントローラとを備えている。
As shown in
また、この種の不整地用走行車両において、コントローラの指令に基づく各電磁比例制御弁の作動にてこれに対応する油圧シリンダを伸縮作動させることにより、傾斜地等の不整地で、オペレータが搭乗する作業機体(キャビン)の姿勢を水平に保持するという技術も、従来からよく知られている。
ところで、前記従来の構成において例えば油圧シリンダを微少作動させる場合は、電磁比例制御弁におけるスプールの目標開度が小さいため、スプールを通過する作動油量が少なく、スプールの移動速度が遅くなる。このため、前記従来の構成では、油圧シリンダを微少作動させる際の電磁比例制御弁の応答性、ひいては油圧シリンダの応答性が悪く、姿勢制御機能の向上という点に鑑みて改善の余地があった。 By the way, when the hydraulic cylinder is slightly operated in the conventional configuration, for example, the target opening degree of the spool in the electromagnetic proportional control valve is small, so that the amount of hydraulic oil passing through the spool is small and the moving speed of the spool is slow. For this reason, in the conventional configuration, the response of the electromagnetic proportional control valve when the hydraulic cylinder is slightly operated, and thus the response of the hydraulic cylinder is poor, and there is room for improvement in view of improving the posture control function. .
そこで、本願発明はこのような問題を解消した不整地用走行車両を提供することを技術的課題とするものである。 In view of this, the present invention has a technical object to provide a traveling vehicle for rough terrain in which such problems are solved.
上記の技術的課題を達成するため、請求項1の発明に係る不整地用走行車両は、駆動源が搭載された作業機体と、前記作業機体を支持する左右の脚機構と、前記各脚機構の下端に設けられた前側走行部及び後側走行部と、前記各脚機構の関節を屈曲作動させる関節油圧シリンダと、前記各関節油圧シリンダに対する作動油の給排量を調節する電磁比例制御弁と、前記各電磁比例制御弁の作動を制御する制御手段とを備えている。そして、前記制御手段は、前記制御手段は、通常作動時の指令電流より大きい初期指令電流を一時的に前記各電磁比例制御弁に出力するように設定されている。
In order to achieve the above technical problem, an uneven terrain vehicle according to the invention of
請求項2の発明では、請求項1に記載した不整地用走行車両において、前記制御手段は、前記各関節油圧シリンダの目標位置を微分処理して当該微分値に基づき前記各電磁比例制御弁を作動させるフィードフォワード制御を実行するように設定されている。 According to a second aspect of the present invention, in the rough terrain traveling vehicle according to the first aspect, the control means performs a differential process on a target position of each joint hydraulic cylinder and controls each electromagnetic proportional control valve based on the differential value. It is set to execute feed forward control to be activated.
請求項3の発明では、請求項2に記載した不整地用走行車両において、前記制御手段は、前記各関節油圧シリンダが作動していない状態で前記微分値が零でない場合に、通常作動時の指令電流より小さい待機指令電流を前記各電磁比例制御弁に出力するように設定されている。 According to a third aspect of the present invention, in the rough terrain vehicle according to the second aspect, the control means is configured to perform a normal operation when the differential value is not zero in a state where the joint hydraulic cylinders are not operated. A standby command current smaller than the command current is set to be output to each of the electromagnetic proportional control valves.
本願発明の構成によると、各関節油圧シリンダに対する作動油の給排量を調節する電磁比例制御弁の作動を制御する制御手段が、通常作動時の指令電流より大きい初期指令電流を一時的に前記各電磁比例制御弁に出力するように設定されているから、前記各関節油圧シリンダを目標位置まで伸縮作動させる際は、前記各電磁比例制御弁におけるスプールの目標開度が小さくても、作動初期の段階でスプールを通過する作動油量を一時的に多くして、スプールの移動速度を増速できる。このため、前記各電磁比例制御弁における作動初期の立ち上がり特性が速やかに変化して、前記各電磁比例制御弁が機敏に応答することになる。その結果、前記各関節油圧シリンダの作動応答が迅速になり、水平姿勢制御機能を向上できるという効果を奏する。 According to the configuration of the present invention, the control means for controlling the operation of the electromagnetic proportional control valve for adjusting the supply / discharge amount of the hydraulic oil to each joint hydraulic cylinder temporarily outputs the initial command current larger than the command current during normal operation. Since it is set to output to each electromagnetic proportional control valve, when each of the joint hydraulic cylinders is extended and retracted to the target position, even if the target opening of the spool in each electromagnetic proportional control valve is small, the initial operation At this stage, the amount of hydraulic oil passing through the spool can be temporarily increased to increase the moving speed of the spool. For this reason, the start-up characteristic at the initial stage of operation of each electromagnetic proportional control valve changes quickly, and each electromagnetic proportional control valve responds quickly. As a result, the operation response of each joint hydraulic cylinder becomes quick, and the horizontal posture control function can be improved.
以下、本願発明の実施の形態を、不整地用走行車両としての材木運搬車に適用した場合の図面について説明する。なお、以下の説明では、材木運搬車1の前進方向に向かって左側を単に左側と称し、同じく前進方向に向かって右側を単に右側と称する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, drawings when an embodiment of the present invention is applied to a timber transport vehicle as a rough terrain vehicle will be described. In the following description, the left side in the forward direction of the
(1).材木運搬車の概要
図1乃至図3に示されるように、材木運搬車1は、左右の後側走行部2a,2bと、左右の前側走行部3a,3bと、後述する駆動源としてのエンジン20、油圧機器21、及び作業機としての丸太握持アーム22等を配置する作業機体4と、後側走行部2a,2b及び前側走行部3a,3bに作業機体4を支持する左右の脚体5a,5bとを備えている。
(1). Outline of the Timber Transport Vehicle As shown in FIGS. 1 to 3, the
図2に示されるように、作業機体4には、オペレータが搭乗する運転キャビン23と、丸太扼持アーム22によって丸太24を載せる荷台25とを備える。運転キャビン23は、オペレータが座乗する操縦座席26と、左の前側走行部2a及び後側走行部3aと右の前側走行部2b及び後側走行部3bとを差動させて進路を変更操作(舵取り)する操縦ハンドル27と、左右の後側走行部2a,2b及び左右の前側走行部3a,3bの駆動速度の変更(車速の変速)と回転方向の変更(前進と後進の切換)とを操作する走行変速レバー28と、左右の後側走行部2a,2b又は左右の前側走行部3a,3bを制動操作するブレーキペダル29とを有する。また、運転キャビン23内の設置台98に遠隔操縦器99を取外し可能に配置する。材木運搬車1は、主として遠隔操縦器99によって操縦して、材木の積み下ろし及び運搬等の作業を実行するが、オペレータが操縦座席26に座乗して材木を積み下ろしたり運搬できるように構成している。
As shown in FIG. 2, the
図3及び図4に示されるように、左右の後側走行部2a,2b及び左右の前側走行部3a,3bは、複数のトラックローラ30を軸支したトラックフレーム31と、トラックフレーム31に回動可能に配置した駆動スプロケット32と、トラックフレーム31にテンション調節機構33を介して配置したテンションローラ34と、駆動スプロケット32を駆動する走行駆動油圧モータ35と、合成ゴム製の履帯形状の走行クローラ36とを有する。駆動スプロケット32と、テンションローラ34と、複数のトラックローラ30とを介して、トラックフレーム31に走行クローラ36を支持している。走行駆動油圧モータ35によって走行クローラ36が前進方向又は後進方向に駆動されることになる。
As shown in FIGS. 3 and 4, the left and right
図5乃至図7に示されるように、左右の脚体5a,5bは、第1乃至第10の複数の軸によって、個別に折り曲げてそれぞれの姿勢を変更可能に構成している。即ち、第1軸及び第2軸として後述する左右の股関節軸7と、第3軸及び第4軸として後述する左右の膝関節軸6と、第5軸及び第6軸として後述する左右の足首関節軸5と、第7軸及び第8軸として後述する左右の後側足関節軸10と、第9軸及び第10軸として後述する左右の前側足関節軸11とを備えている。
As shown in FIGS. 5 to 7, the left and
図5乃至図7に示されるように、左右の脚体5a,5bは、それぞれ水平方向(横方向)に延びる足首関節軸5と、膝関節軸6と、股関節軸7とを有する。左右の脚体5a,5bに足首関節軸5を介して左右の後側走行部2a,2b及び左右の前側走行部3a,3bを連結する。左右の脚体5a,5bに股関節軸7を介して作業機体4を連結する。膝関節軸6を介して左右の脚体5a,5bが側面視でく形状に折り曲がるように構成している。
As shown in FIGS. 5 to 7, the left and
図5乃至図7に示されるように、左右の脚体5a,5bは、第1乃至第10の複数のフレームによって、個別に折り曲げてそれぞれの姿勢を変更可能に構成している。即ち、第1フレーム及び第2フレームとして後述する左右の後側足フレーム8a,8bと、第3フレーム及び第4フレームとして後述する左右の前側足フレーム9a,9bと、第5フレーム及び第6フレームとして後述する左右の足根フレーム12a,12bと、第7フレーム及び第8フレームとして後述する左右の脛フレーム13a,13bと、第9フレーム及び第10フレームとして後述する左右の大腿フレーム14a,14bとを備えている。
As shown in FIGS. 5 to 7, the left and
図5乃至図7に示されるように、左右の脚体5a,5bは、左右の後側走行部2a,2bを支持する左右の後側足フレーム8a,8bと、左右の前側走行部3a,3bを支持する左右の前側足フレーム9a,9bと、左右の後側足フレーム8a,8bの前端側(左右の前側足フレーム9a,9bの後端側)に左右の後側足関節軸10(前側足関節軸11)を介して後端側(前端側)を連結する左右の足根フレーム12a,12bと、左右の足根フレーム12a,12bの前後幅の中間の上端側に左右の足首関節軸5を介して下端側を連結する左右の脛フレーム13a,13bと、左右の脛フレーム13a,13bの上端側に左右の膝関節軸6を介して下端側を連結する左右の大腿フレーム14a,14bとを有している。左右の脚体5a,5bは、左右対称の構造に構成されている。
As shown in FIGS. 5 to 7, the left and
図2乃至図5に示されるように、左右の前側走行部3a,3bと、左右の後側走行部2a,2bと、駆動源としてのエンジン20及び作業機としての丸太握持アーム22を配置する作業機体4と、前側走行部3a,3b及び後側走行部2a,2bに作業機体4を支持する左右の脚体5a,5bとを備える。左右の脚体5a,5bは、足首関節軸5と、膝関節軸6と、股関節軸7とを有し、左右の脚体5a,5bに足首関節軸5を介して左右の前側走行部3a,3b及び左右の後側走行部2a,2bを連結し、左右の脚体5a,5bに股関節軸7を介して作業機体4を連結し、膝関節軸6を介して左右の脚体5a,5bが折り曲がるように構成している。したがって、左右の前側走行部3a,3b及び左右の後側走行部2a,2bを接地させた状態で、前後方向、左右方向、上下方向に機体重心を移動でき、作業機体4の地上高を簡単に変更できる。また、左右の脚体5a,5bを互い違いにして、前後の走行部2a,2b,3a,3bの前後方向の最大接地幅を簡単に大きくすることができ、進行方向の幅が大きなくぼ地を簡単に乗り越えることができる。
As shown in FIGS. 2 to 5, left and right
図5乃至図7に示されるように、作業機体4は坐フレーム15を有し、左右の脚体5a,5bの各大腿フレーム14a,14bの上下幅の中間に股関節軸7を介して坐フレーム15の前後幅の中間を連結している。股関節軸7回りに坐フレーム15が回動することによって、坐フレーム15の前端側(後端側)が上動(下動)又は下動(上動)し、坐フレーム15の前後方向の傾斜角が変更されることになる。
As shown in FIGS. 5 to 7, the
図5乃至図7に示されるように、左右の脚体5a,5bは、第1乃至第10の複数の油圧シリンダによって、個別に折り曲げてそれぞれの姿勢を変更可能に構成している。即ち、第1油圧シリンダ及び第2油圧シリンダとして後述する左右の股関節油圧シリンダ44a,44bと、第3油圧シリンダ及び第4油圧シリンダとして後述する左右の膝関節油圧シリンダ48a,48bと、第5油圧シリンダ及び第6油圧シリンダとして後述する左右の足首関節油圧シリンダ52a,52bと、第7油圧シリンダ及び第8油圧シリンダとして後述する左右のかかと関節油圧シリンダ56a,56bと、第9油圧シリンダ及び第10油圧シリンダとして後述する左右のつま先関節油圧シリンダ60a,60bとを備えている。
As shown in FIGS. 5 to 7, the left and
股関節軸7に側面視L形状の中間を回動可能に被嵌したピッチアーム40と、坐フレーム15の前後方向の傾斜角を調節するための水平機構としてのピッチ油圧シリンダ16とを備える。坐フレーム15の前端側に軸体41を介してピッチ油圧シリンダ16を連結する。ピッチ油圧シリンダ16のピストン16aの先端側に軸体42を介してピッチアーム40のL形状の一端側を連結する。また、左右の大腿フレーム14a,14bの下端側に軸体43を介して左右の股関節油圧シリンダ44a,44bを連結する。股関節油圧シリンダ44a,44bのピストン45の先端側に軸体46を介してピッチアーム40のL形状の他端側を連結する。
A
その結果、ピッチ油圧シリンダ16によって股関節軸7回りに坐フレーム15を回動して、坐フレーム15の前後方向の傾斜を修正して前後方向に水平に支持することになる。また、左右の股関節油圧シリンダ44a,44bによって股関節軸7回りに坐フレーム15が回動して、坐フレーム15と左右の大腿フレーム14a,14bとの相対的な連結角度を変更することになる。
As a result, the
即ち、左右の股関節油圧シリンダ44a,44bを作動させながら、ピッチ油圧シリンダ16を作動させることによって、坐フレーム15の前後方向の傾斜が略水平に維持された状態で、坐フレーム15と左右の大腿フレーム14a,14bとの相対角度が変更されることになる。なお、左右の股関節油圧シリンダ44a,44bを各別に作動することによって、坐フレーム15に対する左右の大腿フレーム14a,14bの相対角度は独立してそれぞれ変更される。
That is, by operating the pitch
なお、第1乃至第10の複数の油圧シリンダ44a,44b,48a,48b,52a,52b,56a,56b,60a,60bと、ピッチ油圧シリンダ16とは、特許請求の範囲に記載した関節油圧シリンダに相当する。
The first to tenth
図2乃至図5に示されるように、左右の脚体5a,5bは、足根フレーム12a,12bに足首関節軸11を介して連結する脛フレーム13a,13bと、脛フレーム13a,13bに膝関節軸6を介して連結する大腿フレーム14a,14bとを有し、作業機体4は坐フレーム15を有し、左右の脚体5a,5bの各大腿フレーム14a,14bに股関節軸7を介して坐フレーム15を連結し、坐フレーム15の前後方向の傾斜角を調節するための水平機構としてのピッチ油圧シリンダ16を備え、坐フレーム15を水平に支持するように構成している。したがって、作業機体4の地上高を確保しながら、作業機体4の左右方向及び前後方向の傾斜角を簡単に変更でき、作業機体4を安定した姿勢で支持できる。
As shown in FIGS. 2 to 5, the left and
左右の大腿フレーム14a,14bの上端側には、左右の軸体47を介して、左右の膝関節油圧シリンダ48a,48bをそれぞれ連結する。左右の膝関節油圧シリンダ48a,48bのピストン49の先端側には、左右の軸体50を介して、脛フレーム13a,13bの中間をそれぞれ連結する。その結果、左右の膝関節油圧シリンダ48a,48bを作動することによって、左右の膝関節軸6回りに左右の大腿フレーム14a,14bが回動して、左右の脛フレーム13a,13bと左右の大腿フレーム14a,14bとの相対的な連結角度がそれぞれ変更されることになる。なお、左右の膝関節油圧シリンダ48a,48bを各別に作動することによって、左右の脛フレーム13a,13bに対する左右の大腿フレーム14a,14bの相対角度は独立してそれぞれ変更される。
Left and right knee joint
左右の脛フレーム13a,13bの上端側には、左右の軸体51を介して、左右の足首関節油圧シリンダ52a,52bをそれぞれ連結する。左右の足首関節油圧シリンダ52a,52bのピストン53の先端側には、左右の軸体54を介して、左右の足根フレーム12a,12bの前端側をそれぞれ連結する。その結果、左右の足首関節油圧シリンダ52a,52bを作動することによって、左右の足首関節軸5回りに左右の脛フレーム13a,13bが回動して、左右の足根フレーム12a,12bと左右の脛フレーム13a,13bとの相対的な連結角度がそれぞれ変更されることになる。なお、左右の足首関節油圧シリンダ52a,52bを各別に作動することによって、左右の足根フレーム12a,12bに対する左右の脛フレーム13a,13bの相対角度は独立してそれぞれ変更される。
Left and right ankle joint
左右の足根フレーム12a,12bの後端側には、左右の軸体55を介して、左右のかかと関節油圧シリンダ56a,56bをそれぞれ連結する。左右のかかと関節油圧シリンダ56a,56bのピストン57の先端側には、左右の軸体58を介して、左右の後側足フレーム8a,8bの後端側をそれぞれ連結する。その結果、左右のかかと関節油圧シリンダ56a,56bを作動することによって、左右の後側足関節軸10回りに左右の後側足フレーム8a,8bが回動して、左右の後側足フレーム8a,8bと左右の足根フレーム12a,12bとの相対的な連結角度がそれぞれ変更されることになる。なお、左右のかかと関節油圧シリンダ56a,56bを各別に作動することによって、左右の足根フレーム12a,12bに対する左右の後側足フレーム8a,8bの相対角度は独立してそれぞれ変更される。
Left and right heel joint
左右の足根フレーム12a,12bの前端側には、左右の軸体59を介して、左右のつま先関節油圧シリンダ60a,60bをそれぞれ連結する。左右のつま先関節油圧シリンダ60a,60bのピストン61の先端側には、左右の軸体62を介して、左右の前側足フレーム9a,9bの前端側をそれぞれ連結する。その結果、左右のつま先関節油圧シリンダ60a,60bを作動することによって、左右の前側足関節軸11回りに左右の前側足フレーム9a,9bが回動して、左右の前側足フレーム9a,9bと左右の足根フレーム12a,12bとの相対的な連結角度がそれぞれ変更されることになる。なお、左右のつま先関節油圧シリンダ60a,60bを各別に作動することによって、左右の足根フレーム12a,12bに対する左右の前側足フレーム9a,9bの相対角度は独立してそれぞれ変更される。
Left and right toe joint
図2乃至図5に示されるように、左右の脚体5a,5bは、前側走行部3a,3bを支持する前側足フレーム9a,9bと、後側走行部2a,2bを支持する後側足フレーム8a,8bとを有し、前側足フレーム9a,9bに前側足関節軸11を介して足根フレーム12a,12bを連結し、後側足フレーム8a,8bに後側足関節軸10を介して足根フレーム12a,12bを連結している。したがって、前側走行部3a,3bの前側又は後側走行部2a,2bの後側を上下方向に移動して迎え角を大きくすることができるから、大きな段差地を簡単に移動できる。また、前側走行部3a,3bの前側と後側走行部2a,2bの後側とを同時に下方向に移動して足根フレーム12a,12bを持上げることができるから、左右の脚体5a,5bの全長より高く作業機体4を上昇できる。また、前側走行部3a,3bの前側と後側走行部2a,2bの後側とを同時に上方向に移動して前後の接地幅を小さくすることができるから、狭小場所でもUターン又は信地旋回等の方向転換を簡単に実行できる。
As shown in FIGS. 2 to 5, the left and
図8は本実施形態における材木運搬車1(不整地用走行車両)の油圧回路70を示している。材木運搬車1の油圧回路70は、左右の後側走行部2a,2b及び左右の前側走行部3a,3bの出力可変容量形の各走行駆動油圧モータ35をそれぞれ駆動する走行用油圧ポンプ71と、油圧機器21の各部にチャージ圧油を供給するチャージ用油圧ポンプ72と、左の脚体5aの各油圧シリンダ44a,48a,52a,56a,60aを作動する出力可変容量形の右側脚体用油圧ポンプ73と、右の脚体5bの各油圧シリンダ44b,48b,52b,56b,60bを作動する出力可変容量形の左側脚体用油圧ポンプ74とを備える。走行用油圧ポンプ71と、チャージ用油圧ポンプ72と、右側脚体用油圧ポンプ73と、左側脚体用油圧ポンプ74とは、エンジン20の回転力により作動する。なお、油圧回路70には、リリーフ弁や流量調整弁、チェック弁、オイルクーラ、オイルフィルタ等を備えている。
FIG. 8 shows a hydraulic circuit 70 of the timber transport vehicle 1 (a rough terrain vehicle) according to this embodiment. The hydraulic circuit 70 of the
また、右側脚体用油圧ポンプ73には、分流弁75aと、右の股関節制御弁76aとを介して右の股関節油圧シリンダ44aを接続している。右側脚体用油圧ポンプ73には、分流弁77aと、右の膝関節制御弁78aとを介して右の膝関節油圧シリンダ48aを接続している。右側脚体用油圧ポンプ73には、分流弁79aと、右の足首関節制御弁80aとを介して右の足首関節油圧シリンダ52aを接続している。右側脚体用油圧ポンプ73には、分流弁81aと、右のつま先関節制御弁82aとを介して右のつま先関節油圧シリンダ56aを接続している。右側脚体用油圧ポンプ73には、分流弁83aと、右のかかと関節制御弁84aとを介して右のかかと関節油圧シリンダ60aを接続している。右側脚体用油圧ポンプ73には、分流弁85と電磁比例流量制御弁構造のピッチ制御弁86とを介してピッチ油圧シリンダ16を接続している。
The right leg
また、上述した右側脚体用油圧ポンプ73と同様に、左側脚体用油圧ポンプ74には、分流弁75bと、左の股関節制御弁76bとを介して左の股関節油圧シリンダ44bを接続している。右側脚体用油圧ポンプ73には、分流弁77bと、左の膝関節制御弁78bとを介して左の膝関節油圧シリンダ48bを接続している。右側脚体用油圧ポンプ73には、分流弁79bと、左の足首関節制御弁80bとを介して左の足首関節油圧シリンダ52bを接続している。右側脚体用油圧ポンプ73には、分流弁81bと、左のつま先関節制御弁82bとを介して左のつま先関節油圧シリンダ56bを接続している。右側脚体用油圧ポンプ73には、分流弁83bと、左のかかと関節制御弁84bとを介して左のかかと関節油圧シリンダ60bを接続している。
Similarly to the right leg
上述した各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60bには、それらの作動油圧をそれぞれ検出する油圧センサ87を取付けている。また、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60bの各ピストン45,49,53,57,61には、それらの進退位置(進出量)を検出する位置センサ45a,49a,53a,57a,61a,45b,49b,53b,57b,61bがそれぞれ連結されている。ピッチ油圧シリンダ16のピストン16aには、その進退位置(進出量)を検出する位置センサ16bが連結されている。なお、上述した各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84b,86は、電磁比例流量制御弁(電磁比例制御弁とスプール形の方向切換弁とを組み合わせた弁)構造のものであり、位置制御及び力制御(インピーダンス制御)によって、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60b,16に供給する作動油の印加方向及び印加流量を制御可能に構成している。当該各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84b,86は、特許請求の範囲に記載した電磁比例制御弁に相当する。
Each of the
さらに走行用油圧ポンプ71には、左前変速制御弁88aを介して左前走行駆動油圧モータ35を接続する。左前走行駆動油圧モータ35の出力(回転速度)を変更する操向油圧シリンダ89を備える。左前変速制御弁88aに操向制御弁90aを介して操向油圧シリンダ89を接続している。走行用油圧ポンプ71には、右前変速制御弁88bを介して右前走行駆動油圧モータ35を接続する。右前走行駆動油圧モータ35の出力(回転速度)を変更する操向油圧シリンダ89を備える。右前変速制御弁88bに操向制御弁90bを介して操向油圧シリンダ89を接続している。
Further, the left front travel drive
また、走行用油圧ポンプ71には、左後変速制御弁88cを介して左後走行駆動油圧モータ35を接続する。左後走行駆動油圧モータ35の出力(回転速度)を変更する操向油圧シリンダ89を備える。左後変速制御弁88cに操向制御弁90cを介して操向油圧シリンダ89を接続している。走行用油圧ポンプ71には、右後変速制御弁88dを介して右後走行駆動油圧モータ35を接続する。右後走行駆動油圧モータ35の出力(回転速度)を変更する操向油圧シリンダ89を備える。右後変速制御弁88dに操向制御弁90dを介して操向油圧シリンダ89を接続している。各走行駆動油圧モータ35の出力軸の回転速度を検出する左前車速センサ91a、右前車速センサ91b、左後車速センサ91c、右後車速センサ91dを備える。
Further, the left rear travel drive
次に、本実施形態の材木運搬車1の走行制御について説明する。図9は、材木運搬車1の制御手段の機能ブロック図であり、マイクロコンピュータ等の走行コントローラ100は、制御プログラムを記憶したROMと各種データを記憶したRAMとを備える。図9に示されるように、走行コントローラ100の入力側には、坐フレーム15の左右方向の傾斜角を検出するロールセンサ101と、坐フレーム15の左右方向の傾斜角速度を検出するロール角速度センサ102と、坐フレーム15の前後方向の傾斜角を検出するピッチセンサ103と、右側脚体5aの縮小(坐フレーム15の右側の下動)リミット位置を検出する左下限センサ104と、左側脚体5bの縮小(坐フレーム15の左側の下動)リミット位置を検出する右下限センサ105と、上述した各油圧センサ87と、オペレータが操作する操縦ハンドル27の切り角(左旋回操作量及び右旋回操作量)を検出する操舵角センサ106と、走行変速レバー28の操作位置(前進操作位置及び後進操作位置)を検出する走行変速センサ107と、上述した各車速センサ91a〜dとを接続している。また、操舵角センサ106と、走行変速センサ107とは、遠隔操縦器99からの無線操縦信号を受信するように構成している。
Next, traveling control of the
また、図9に示されるように、走行コントローラ100の入力側には、位置センサ16b,45a,49a,53a,57a,61a,45b,49b,53b,57b,61bがそれぞれ連結されている。一方、走行コントローラ100の出力側には、上述した左右の脚体5a,5bの姿勢を制御する各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84bと、坐フレーム15の前後傾きを制御するピッチ制御弁86と、上述した左右の後側走行部2a,2b及び左右の前側走行部3a,3bの各走行駆動油圧モータ35を制御する各制御弁88a,88b,88c,88d,90a,90b,90c,90dとを接続している。
9,
上記の構成により、材木運搬車1が前進方向又は後進方向に移動している場合、ロール角速度センサ102の検出結果に基づき、各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84bが作動して、左下限センサ104及び右下限センサ105によって制限される高さ以上で、左右の脚体5a,5bを各別に伸縮させるための制御を開始する。ロールセンサ101の検出結果に基づき、各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84bの作動を中止して、坐フレーム15の左右方向の傾斜を修正する。また、ピッチセンサ103の検出結果に基づき、ピッチ制御弁86を作動して、坐フレーム15の前後方向の傾斜を修正する。その結果、坐フレーム15は、左右の脚体5a,5bを介して略水平に保持される。
With the above configuration, when the
また、左右の脚体5a,5b(坐フレーム15)を水平制御中、油圧センサ87の検出結果に基づき、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60bの駆動速度を制御して、走行部2a,2b,3a,3bから左右の脚体5a,5bに伝達される路面からの衝撃力を吸収する。走行部2a,2b,3a,3bからの衝撃力が、坐フレーム15に伝わるのを防止できる。
Further, during horizontal control of the left and
また、材木運搬車1外でオペレータが遠隔操縦器99を操作したり、材木運搬車1にオペレータが搭乗して操縦ハンドル27又は走行変速レバー28を操作したりすることによって、材木運搬車1が前進方向又は後進方向に移動している場合、オペレータにて遠隔操縦器99又は操縦ハンドル27又は走行変速レバー28が操作されることにより、操舵角センサ106又は走行変速センサ107の検出結果に基づき、各制御弁88a,88b,88c,88d又は各制御弁90a,90b,90c,90dが作動して、各走行駆動油圧モータ35の駆動油圧又は出力回転速度を制御する。その結果、左右の後側走行部2a,2bの各走行クローラ36及び左右の前側走行部3a,3bの各走行クローラ36が各別に駆動制御され、前進移動又は後進移動又はUターン又はスピンターン(信地旋回)等が実行され、オペレータが希望する方向に希望する速度で移動できる。
Further, when the operator operates the
一方、上記のように、作業機体4が移動中、位置センサ45a,49a,53a,57a,61a,45b,49b,53b,57b,61bによって、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52ab,56b,60bの各ピストン45,49,53,57,61の進退位置(進出量)がそれぞれ検出される。位置センサ53a,57a,61a,53b,57b,61bの検出結果に基づき、左右の後側走行部2a,2b及び左右の前側走行部3a,3bの各走行クローラ36が着地している地面(走行路面)の傾斜角度が算出される。そして、当該算出結果に基づいて作業機体4の姿勢制御が実行される。
On the other hand, as described above, when the
即ち、前側走行部3a,3bを有する前側のトラックフレーム31と、後側走行部2a,2bを有する後側のトラックフレーム31と、左右の前後トラックフレーム31に作業機体4を支持する脚機構としての脚体5a,5bとを備える。また、脚体5a,5bの関節のうち、地面に押付けられた関節としての後側足フレーム8a,8b及び前側足フレーム9a,9bの折曲げ角度を検出する角度センサとしての位置センサ57a,57b,61a,61bを備える。前側走行部3a,3bの後端側が浮上り前端側だけが着地した状態、又は後側走行部2a,2bの前端側が浮上り後端側だけが着地した状態の少なくともいずれか一方の着地状態になった場合、位置センサ57a,57b,61a,61bの検出結果に基づき、前側走行部3a,3bの前端側と後側走行部2a,2bの後端側が着地しているときの地面の傾斜角度を算出するように構成している。このため、従来の制御構造等に比べ、作業機体4の目標姿勢の演算によって累積される演算誤差を低減できる。したがって、作業機体4の目標姿勢の演算が発散するのを防止でき、作業機体4の姿勢制御機能を向上できる。なお、従来の制御構造では、前側走行部3a,3bと後側走行部2a,2bを連結したフレーム12a,12bの傾斜角度、具体的には、前後の走行部の足首関節の折り曲げ角度(足首関節軸5回りの足根フレーム12a,12bの回動角度)に基づき、前側走行部3a,3b及び後側走行部2a,2bが着地している地面(走行路面)の傾斜角度を算出していた。
That is, the
換言すると、前側走行部3a,3b及び後側走行部2a,2bの進行方向の傾斜角度を検出する走行部傾斜角度センサとしての位置センサ53a,53bと、前側走行部3a,3bの接地角度を検出する前接地角度センサとしての位置センサ61a,61bと、後側走行部2a,2bの接地角度を検出する後接地角度センサとしての位置センサ57a,57bとを備える。前側走行部3a,3b及び後側走行部2a,2bの進行方向の傾斜角度が、前側走行部3a,3bの後端側が浮上り前端側だけが着地した状態、又は後側走行部2a,2bの前端側が浮上り後端側だけが着地した状態の少なくともいずれか一方の着地状態になった場合、前側走行部3a,3b及び後側走行部2a,2bが着地している地面(走行路面)の傾斜角度として、前側走行部3a,3bの前端側と後側走行部2a,2bの後端側を結ぶ直線の傾斜角度を算出するように構成している。前側走行部3a,3b及び後側走行部2a,2bが着地している地面(走行路面)の傾斜角度を高精度で推定できる。前記作業機体4の目標姿勢の演算誤差を間単に低減でき、作業機体4の姿勢制御の精度を向上できる。
In other words, the
本願発明の実施形態では、前記脚体5a,5bには、第1制御手段(いわゆる足首関節制御手段)としての足首関節油圧シリンダ52a,52b及び第1角度センサ(いわゆる足首角度センサ)としての位置センサ53a,53bと、第2制御手段(いわゆるつま先制御手段)としてのつま先関節油圧シリンダ60a,60b及び第2角度センサ(いわゆるつま先角度センサ)としての位置センサ61a,61bと、第3制御手段(いわゆるかかと制御手段)としてのかかと関節油圧シリンダ56a,56b及び第3角度センサ(いわゆるかかと角度センサ)としての位置センサ57a,57bとが設けられている。足根フレーム12a,12bの傾斜角度を検出する位置センサ53a,53bの検出結果と、前側走行部3a,3bの進行方向の傾斜角度を検出する位置センサ61a,61bの検出結果と、後側走行部2a,2bの進行方向の傾斜角度を検出する位置センサ57a,57bの検出結果とに基づき、前側走行部3a,3b及び後側走行部2a,2bが着地している地面(走行路面)の傾斜角度を算出するように構成している。したがって、足根フレーム12a,12bの傾斜角度と、実際の地面(走行路面)の傾斜角度とが相違していても、前側走行部3a,3bの位置センサ61a,61bの出力と、後側走行部2a,2bの位置センサ57a,57bの出力とによって、それらの差を高精度に補正でき、前側走行部3a,3b及び後側走行部2a,2bが着地している地面の傾斜角度を高精度に算出できる。
In the embodiment of the present invention, the
即ち、前側走行部3a,3bの後端側が浮上り前端側だけが着地した状態、又は後側走行部2a,2bの前端側が浮上り後端側だけが着地した状態の少なくともいずれか一方の着地状態になった場合であっても、足根フレーム12a,12bの傾斜角度を検出する位置センサ53a,53bの出力と、前側走行部3a,3bの位置センサ61a,61bの出力と、後側走行部2a,2bの位置センサ57a,57bの出力とによって、前側走行部3a,3b及び後側走行部2a,2bが着地している地面の傾斜角度を高精度で推定できる。地面(走行路面)の傾斜角度の算出によって求められた作業機体4の目標姿勢と現在の作業機体4の姿勢との演算誤差を簡単に低減でき、前記作業機体4の姿勢制御機能を向上できる。
That is, at least one of the landings in which the rear end side of the front traveling
なお、従来の制御構造のように、足首関節軸5回りの足根フレーム12a,12bの回動角度(足根フレーム12a,12bの前後方向の傾斜角度)に基づき、前側走行部3a,3b及び後側走行部2a,2bが着地している地面(走行路面)の傾斜角度を算出していたのでは、前側走行部3a,3bの後端側が浮上り前端側だけが着地した状態、又は後側走行部2a,2bの前端側が浮上り後端側だけが着地した状態の少なくともいずれか一方の着地状態になった場合、足根フレーム12a,12bの前後方向の傾斜角度と、前側走行部3a,3b及び後側走行部2a,2bが着地している地面(走行路面)の傾斜角度とに差が生じる。したがって、従来のように、足根フレーム12a,12bの前後方向の傾斜角度に基づき、地面(走行路面)の傾斜角度を算出していたのでは、作業機体4の目標姿勢の演算によって演算誤差が累積され、作業機体4の目標姿勢の演算が発散する不具合があった。
As in the conventional control structure, based on the rotation angle of the foot frames 12a and 12b around the ankle joint axis 5 (the inclination angle in the front-rear direction of the foot frames 12a and 12b), the
次に、本実施形態の材木運搬車1を利用した森林情報マップの形成制御について説明する。図10は、森林情報マップの形成制御手段の機能ブロック図であり、制御プログラムを記憶したROMと各種データを記憶したRAMとを有するマイクロコンピュータ等によって構成された三次元データ処理コントローラ111と表示データ処理コントローラ112とを備える。上記の走行コントローラ100と、三次元データ処理コントローラ111と、表示データ処理コントローラ112とは、CAN通信線によってそれぞれ接続されている。
Next, the formation control of the forest information map using the
図10に示されるように、三次元データ処理コントローラ111の入力側には、作業機体4の周辺の森林(樹木等)を複数台のカメラ(図示省略)によって三次元的に撮像して三次元画像データとして検出するステレオカメラ115と、作業機体4の周辺の森林(樹木等)をレーザー距離センサ(図示省略)によって三次元的に検出する三次元距離画像センサ116と、人口衛星を利用して地上の作業機体4の位置を認識するGPS受信機117と、作業機体4の進行方向(方位)を検出する方位計118と、作業機体4の標高を計測する高度計119を接続している。また、自動的に水平姿勢に支持される作業機体4の左右幅中央にセンサフレーム17を設ける。センサフレーム17に、ステレオカメラ115、三次元距離画像センサ116、GPS受信機117、方位計118、高度計119が、水平姿勢に支持されるように配置されている。
As shown in FIG. 10, on the input side of the three-dimensional
三次元データ処理コントローラ111において、ステレオカメラ115又は三次元距離画像センサ116の少なくともいずれか一方又は両方の三次元画像出力と、GPS受信機117の作業機体4の現在位置出力と、方位計118の作業機体4の進行方向出力と、高度計119の作業機体4の標高出力が、互いに関連して記録されるように構成している。換言すると、ステレオカメラ115又は三次元距離画像センサ116の少なくともいずれか一方又は両方の三次元画像出力と、GPS受信機117の作業機体4の現在位置出力と、方位計118の作業機体4の進行方向出力と、高度計119の作業機体4の標高出力が、三次元データ処理コントローラ111に、図11に示す三次元森林情報マップ120として形成されて記録されるように構成している。
In the three-dimensional
図11に示す森林情報マップ120には、森林を構成する樹木(○印実線)、等高線(破線細線)、自車位置(進行方向を示す矢印実線)、間伐予定樹木(破断線が入った○印実線)、切り株(○印細線)が記録されるように構成している。なお、森林を構成する樹木、間伐予定樹木、及び切り株は、着色によって区別できるように構成してもよい。
In the
即ち、図10から明らかなように、水平制御機構としてのピッチ油圧シリンダ16を介して支持された作業機体4に、3次元的に森林情報を検出する3次元検出手段としてのステレオカメラ115又は三次元距離画像センサ116と、ステレオカメラ115又は三次元距離画像センサ116からの3次元データ出力を処理する3次元データ処理手段としての三次元データ処理コントローラ111とを配置する。森林を構成する樹木の位置及び太さ等を3次元データとして測定して、三次元森林情報マップ120を形成するように構成している。次回の間伐計画又は植林計画又は伐採計画等に森林情報マップ120を利用できる。森林情報マップ120に基づき、樹木を特定して、その太さ又は曲がり具合等や、間伐又は伐採の要否等を適正に判断できる。作業機体4の復路のナビゲーションができる。作業機体4の移動距離又は作業量等の作業実績を把握できる。間伐作業又は伐採作業又は植林作業等の作業性を向上できる。
That is, as apparent from FIG. 10, the
また、図10から明らかなように、ステレオカメラ115又は三次元距離画像センサ116によって3次元的に森林情報が検出されるときに、作業機体4の外部環境を検出する外部環境センサとしてのGPS受信機117又は方位計118又は高度計119を備え、GPS受信機117又は方位計118又は高度計119の検出結果に基づき、ステレオカメラ115又は三次元距離画像センサ116の3次元データ出力を補完するように構成している。三次元データ処理コントローラ111によって処理される3次元データの信頼性を向上できる。樹木のレイアウト(樹木の密度)や、樹木の直径(樹齢)等を高精度でデータ化できる。
Further, as is apparent from FIG. 10, when the stereo information is detected three-dimensionally by the
図8、図9、図10から明らかなように、地面に押付けられた関節としての後側足フレーム8a,8b又は前側足フレーム9a,9bの折曲げ角度を検出する角度センサとしての位置センサ57a,57b又は位置センサ61a,61bを備える構造であって、水平制御機構としてのピッチ油圧シリンダ16を介して支持された前記作業機体4に、3次元的に森林情報を検出する3次元検出手段としてのステレオカメラ115又は三次元距離画像センサ116と、ステレオカメラ115又は三次元距離画像センサ116からの3次元データ出力を処理する3次元データ処理手段としての三次元データ処理コントローラ111とを配置し、ステレオカメラ115又は三次元距離画像センサ116によって樹木の位置及び太さ等が測定された3次元データと、位置センサ57a,57b又は位置センサ61a,61bの検出結果に基づいて算出された地面の傾斜角度とによって、森林情報マップ120を形成するように構成している。樹木とその周辺の地面の傾斜角度を関連させて前記森林情報マップ120として記録できる。樹木の周辺の地形データ(等高線等)を前記森林情報マップ120に付加することによって、前記森林情報マップ120の信頼性を向上できる。前記作業機体の移動距離及び作業量等の作業実績を把握できる。次回の間伐計画又は植林計画又は伐採計画の検討等に前記森林情報マップ120を活用できる。例えば経験が豊富な作業者が間伐又は伐採又は植林を予め計画し、その計画に基づき他の作業者が間伐作業又は伐採作業又は植林作業等を実行できる。したがって、間伐作業又は伐採作業又は植林作業等の作業性を向上できるものである。
As is apparent from FIGS. 8, 9, and 10, a
図10に示されるように、表示データ処理コントローラ112の入力側には、作業機体4の周辺を360度の範囲で撮像して二次元画像データとして検出する360°カメラ(全周囲カメラ)125を接続している。なお、360°カメラ125に代えて、全方位を認識できるように配置した複数のカメラ(目視用カメラ)を設けてもよい。また、上述した遠隔操縦器99には、液晶画面を有するモニタ126を備えている。表示データ処理コントローラ112と遠隔操縦器99との間で、送受信機127,128を介してそれぞれのデータを無線でやり取りするように構成している。
As shown in FIG. 10, on the input side of the display
即ち、図10から明らかなように、2次元映像として作業機体4の周辺の森林情報を検出する2次元検出手段としての360°カメラ125(もしくは全方位を認識できるように配置した複数のカメラ)と、360°カメラ125の2次元データ出力によってステレオカメラ115又は三次元距離画像センサ116の3次元データ出力を補完して表示処理する表示データ処理手段としての表示データ処理コントローラ112とを、水平制御機構としてのピッチ油圧シリンダ16を介して支持された作業機体4に配置している。一方、森林情報マップ120に基づき作業機体4の移動等を遠隔操作可能な遠隔操縦器99を備え、360°カメラ125(もしくは全方位を認識できるように配置した複数のカメラ)からの2次元データによって補正された森林情報マップ120又は作業機体4の現在位置を、遠隔操縦器99に表示可能に構成している。したがって、森林情報マップ120の表示に基づき、作業機体4が樹木の間を移動可能か否かが、作業機体4から離れた場所の作業者によって適正に判断できる。遠隔操縦器99の遠隔操作によって、間伐作業又は伐採作業又は植林作業等の作業性を向上できる。
That is, as is apparent from FIG. 10, a 360 ° camera 125 (or a plurality of cameras arranged so that all directions can be recognized) as a two-dimensional detection means for detecting forest information around the
また、図10から明らかなように、遠隔操縦器99によって作業機体4の移動等を遠隔操作可能に構成し、作業機体4を後進(後退)させるときには、森林情報マップ120を利用する。2次元検出手段としての360°カメラ125(もしくは全方位を認識できるように配置した複数のカメラ)の検出結果に基づき、遠隔操縦器99の表示部としてのモニタ126に表示される森林情報マップ120画面上の作業機体4の現在位置を補正するように構成している。森林情報マップ120の表示に基づき、作業機体4が樹木の間を移動可能か否かが、遠隔地の作業者によって適正に判断できる。遠隔操縦器99の遠隔操作によって、間伐作業又は伐採作業又は植林作業等の作業性を向上できる。
As apparent from FIG. 10, the
一方、図10から明らかなように、前記3次元検出手段としてのステレオカメラ115又は三次元距離画像センサ116によって森林情報が検出されるときに、その森林情報の検出と関連させて作業機体4の外部環境を検出する外部環境センサとしてのGPS受信機117又は方位計118又は高度計119を備え、森林情報マップ120を形成する森林情報データの一部として作業機体4の外部環境を記録可能に構成する一方、森林情報マップ120に基づき作業機体4の移動等を遠隔操作する遠隔操縦器99を備え、GPS受信機117又は方位計118又は高度計119の検出結果に基づき、遠隔操縦器99の表示部に表示される森林情報マップ120上の作業機体4の現在位置を補正可能に構成している。樹木のレイアウト(樹木の密度)や、樹木の直径(樹齢)等の森林情報を高精度でデータ化して森林情報マップ120を形成できる。森林情報マップ120の精度を高めてその信頼性を向上できる。また、森林情報マップ120に基づく遠隔操縦器99の遠隔操作によって、例えば走行路面の凹部又は切り株又は倒木等を避けて、作業機体4を移動させることができる。間伐作業又は伐採作業又は植林作業等における作業者の労力を低減できる。間伐作業又は伐採作業又は植林作業等の作業性を向上できる。
On the other hand, as apparent from FIG. 10, when forest information is detected by the
次に、図9、図12及び図13を参照しながら、本実施形態における水平姿勢制御の一例について説明する。 Next, an example of horizontal posture control in the present embodiment will be described with reference to FIGS. 9, 12 and 13.
制御手段の一例としての走行コントローラ100は、通常作動時の指令電流Iaより大きい初期指令電流Iinを一時的に各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84b,86に出力すると共に、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60b,16の目標位置Xaを微分処理して、当該微分値Va(=dXa/dt)に基づいて各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84b,86を作動させるというフィードフォワード制御を実行するものである。
The
本実施形態の水平姿勢制御において、各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84b,86と、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60b,16とに対する指令態様は、基本的に同じである。そこで、以下に、ピッチ制御弁86とピッチ油圧シリンダ16とを例にとった制御態様について説明する。
In the horizontal posture control of the present embodiment, the
ここで、図示を省略しているが、ピッチ油圧シリンダ16における目標位置Xaの微分値Va(dXa/dt)と、ピッチ制御弁86への指令電流Iaとの関係は、例えばマップ形式又は関数表形式にて、走行コントローラ100(例えばROM等)に予め記憶されている。目標位置Xaの微分値Va(dXa/dt)は、ピッチ油圧シリンダ16の移動速度に対応するものである。なお、微分値Vaと指令電流Iaとの対のデータを、テーブルマップとして走行コントローラ100に記憶させてもよい。
Here, although not shown, the relationship between the differential value Va (dXa / dt) of the target position Xa in the pitch
また、走行コントローラ100(例えばROM等)には、ピッチセンサ103の前後方向の基準水平角θs(以下、前後基準水平角θsという)も予め記憶されている。ピッチセンサ103の前後基準水平角θsは、坐フレーム15が重力方向(鉛直方向)に対して略水平な姿勢のときの値を示すものである。
The travel controller 100 (for example, a ROM) also stores in advance a reference horizontal angle θs in the front-rear direction of the pitch sensor 103 (hereinafter referred to as a front-rear reference horizontal angle θs). The front-rear reference horizontal angle θs of the
図12のフローチャートに示すように、まずは水平姿勢制御のスタートに続いて、ピッチセンサ103の検出値θと、ピッチ油圧シリンダ16用の位置センサ16bの検出値Xと、走行コントローラ100に予め記憶された前後基準水平角θsとを読み込み(ステップS1)、前後基準水平角θsとピッチセンサ103の検出値θとから、座フレーム15が水平姿勢か否かを判別する(ステップS2)。
As shown in the flowchart of FIG. 12, first, following the start of the horizontal attitude control, the detected value θ of the
坐フレーム15が水平姿勢のとき(S2:YES)はそのままリターンする。坐フレーム15が水平姿勢でないとき(S2:NO)は、ピッチセンサ103の検出値θと前後基準水平角θsと位置センサ16bの検出値Xとから、ピッチ油圧シリンダ16の目標位置Xa及びその微分値Vaを求め(ステップS3)、走行コントローラ100に予め記憶されたマップ又は関数表と微分値Vaとに基づき、ピッチ制御弁86への指令電流Iaを演算する(ステップS4)。
When the
次いで、通常作動時の指令電流Iaより小さい待機指令電流Iwaを一旦、ピッチ制御弁86に出力してから(ステップS5)、通常作動時の指令電流Iaより大きい初期指令電流Iinを一時的(例えば設定時間Tだけ)に、ピッチ制御弁86に出力する(ステップS6、図13参照)。実施形態では、初期指令電流Iinの出力時間である設定時間Tが極めて短い時間(例えば50ms程度)に設定されている。そして、設定時間Tが経過した後は、ステップS4にて求められた指令電流Iaをピッチ制御弁86に出力するのである(ステップS7)。 Next, a standby command current Iwa smaller than the command current Ia during normal operation is temporarily output to the pitch control valve 86 (step S5), and then an initial command current Iin larger than the command current Ia during normal operation is temporarily (for example, At the set time T), the pitch is output to the pitch control valve 86 (see step S6, FIG. 13). In the embodiment, the set time T, which is the output time of the initial command current Iin, is set to an extremely short time (for example, about 50 ms). Then, after the set time T has elapsed, the command current Ia obtained in step S4 is output to the pitch control valve 86 (step S7).
以上の制御によると、ピッチ油圧シリンダ16を目標位置Xaまで伸縮作動させるに際して、走行コントローラ100が通常作動時の指令電流Iaより大きい初期指令電流Iinを一時的(例えば設定時間Tだけ)に、ピッチ制御弁86に出力するから、ピッチ制御弁86におけるスプールの目標開度が小さくても、作動初期の段階では、スプールを通過する作動油量を一時的に多くして、スプールの移動速度を増速できる。このため、ピッチ制御弁86における作動初期の立ち上がり特性が速やかに変化して、ピッチ制御弁86が機敏に応答することになる。その結果、ピッチ油圧シリンダ16の作動応答が迅速になり、水平姿勢制御機能を向上できるのである。
According to the above control, when the pitch
特に、実施形態では、走行コントローラ100がピッチ油圧シリンダ16の目標位置Xaを微分処理して、当該微分値Va(=dXa/dt)に基づいてピッチ制御弁86を作動させるというフィードフォワード制御を実行するから、電源電圧やソレノイド抵抗の変動といった外乱要因の影響を早くなくして、指令電流Ia,Iwa,Iinを過渡域で安定的に制御でき、ピッチ制御弁86、ひいてはピッチ油圧シリンダ16の良好な作動応答性を維持できる。
In particular, in the embodiment, the
また、実施形態では、ピッチ油圧シリンダ16が作動していない状態で微分値Vaが零でない場合に、通常作動時の指令電流Iaより小さい待機指令電流Iinをピッチ制御弁86に出力するから(ステップS5参照)、ピッチ制御弁86には、その作動(スプールの移動)に先立って待機指令電流Iinが通電されることになる。このため、通電していない状態から指令電流Iaを流す場合(図13の破線参照)に比べて、ピッチ制御弁86のスプールが目標開度まで迅速に移動できる。その結果、ピッチ制御弁86、ひいてはピッチ油圧シリンダ16の作動応答性を簡単に向上できるのである。
Further, in the embodiment, when the differential value Va is not zero when the pitch
本願発明は、前述の実施形態に限らず、様々な態様に具体化できる。例えば前述の水平姿勢制御は、ピッチ制御弁86及びピッチ油圧シリンダ16に限らず、各制御弁76a,78a,80a,82a,84a,76b,78b,80b,82b,84b、及び、各油圧シリンダ44a,48a,52a,56a,60a,44b,48b,52b,56b,60bにも用いることが可能である。その他、各部の構成は図示の実施形態に限定されるものではなく、本発明の趣旨を逸脱しない範囲で種々変更が可能である。
The present invention is not limited to the above-described embodiment, and can be embodied in various forms. For example, the horizontal posture control described above is not limited to the
2a,2b 後側走行部
3a,3b 前側走行部
4 作業機体
5a,5b 脚体(脚機構)
16 ピッチ油圧シリンダ(関節油圧シリンダ)
31 トラックフレーム
86 ピッチ制御弁(電磁比例制御弁)
100 走行コントローラ(制御手段)
2a, 2b Rear
16 pitch hydraulic cylinder (joint hydraulic cylinder)
31
100 Travel controller (control means)
Claims (3)
前記制御手段は、通常作動時の指令電流より大きい初期指令電流を一時的に前記各電磁比例制御弁に出力するように設定されている、
不整地用走行車両。 A work machine mounted with a drive source, left and right leg mechanisms that support the work machine, front and rear running units provided at the lower ends of the leg mechanisms, and bending the joints of the leg mechanisms Rough terrain travel comprising: a joint hydraulic cylinder to be actuated; an electromagnetic proportional control valve for adjusting a supply and discharge amount of hydraulic oil to each joint hydraulic cylinder; and a control means for controlling the operation of each electromagnetic proportional control valve. A vehicle,
The control means is set to temporarily output an initial command current larger than a command current during normal operation to each electromagnetic proportional control valve.
Rough terrain vehicle.
請求項1に記載した不整地用走行車両。 The control means is set to perform a feedforward control for differentiating a target position of each joint hydraulic cylinder and operating each electromagnetic proportional control valve with a command current based on the differential value.
The rough terrain vehicle according to claim 1.
請求項2に記載した不整地用走行車両。
The control means is set to output a standby command current smaller than the command current during normal operation to each electromagnetic proportional control valve when the differential value is not zero when each joint hydraulic cylinder is not operated. Being
The rough terrain vehicle according to claim 2.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008174580A JP2010012928A (en) | 2008-07-03 | 2008-07-03 | Traveling vehicle for irregular ground |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008174580A JP2010012928A (en) | 2008-07-03 | 2008-07-03 | Traveling vehicle for irregular ground |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2010012928A true JP2010012928A (en) | 2010-01-21 |
Family
ID=41699467
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2008174580A Pending JP2010012928A (en) | 2008-07-03 | 2008-07-03 | Traveling vehicle for irregular ground |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2010012928A (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103158797A (en) * | 2013-03-07 | 2013-06-19 | 深圳市中南宏业高新技术有限公司 | Underwater unmanned remote-control heavy-load work vehicle |
| CN114258265A (en) * | 2019-08-14 | 2022-03-29 | 蓬塞有限公司 | Method and system in a forest machine |
| JP7685307B1 (en) * | 2024-05-21 | 2025-05-29 | 株式会社和田電業社 | Thinning system and thinning method |
| CN120921900A (en) * | 2025-10-15 | 2025-11-11 | 四川省农业机械科学研究院 | Power chassis system of small crawler tractor |
-
2008
- 2008-07-03 JP JP2008174580A patent/JP2010012928A/en active Pending
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103158797A (en) * | 2013-03-07 | 2013-06-19 | 深圳市中南宏业高新技术有限公司 | Underwater unmanned remote-control heavy-load work vehicle |
| CN114258265A (en) * | 2019-08-14 | 2022-03-29 | 蓬塞有限公司 | Method and system in a forest machine |
| JP7685307B1 (en) * | 2024-05-21 | 2025-05-29 | 株式会社和田電業社 | Thinning system and thinning method |
| CN120921900A (en) * | 2025-10-15 | 2025-11-11 | 四川省农业机械科学研究院 | Power chassis system of small crawler tractor |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7192018B2 (en) | work vehicle | |
| JP2023024520A5 (en) | ||
| CN105636658B (en) | The correction system of hydraulic crawler excavator and bearing calibration | |
| CN109154150B (en) | Control system for construction machine, and control method for construction machine | |
| US11629477B2 (en) | Self-propelled work vehicle and control method for blade stabilization accounting for chassis movement | |
| JP4860508B2 (en) | Rough terrain vehicle | |
| JP6989255B2 (en) | Work equipment control device and work machine | |
| JP2021054269A (en) | Control system, work vehicle control method and work vehicle | |
| JP2009213400A (en) | Traveling vehicle for unleveled ground | |
| JP2019176801A (en) | Field work vehicle | |
| JP2019097503A (en) | Traveling working machine | |
| JP2010012928A (en) | Traveling vehicle for irregular ground | |
| JP6811655B2 (en) | Work platform | |
| JP2009214713A (en) | Traveling vehicle for irregular ground | |
| US12091832B2 (en) | System and method of tilting a track loader bucket to achieve desired cross slope | |
| US11821162B2 (en) | System and method for adaptive calibration of blade position control on self-propelled work vehicles | |
| JP2009213401A (en) | Traveling vehicle for unleveled ground | |
| US12234621B2 (en) | Grade control system and method for a work vehicle | |
| JP2010014535A (en) | Rotation detection apparatus and rough terrain vehicle | |
| US20240295096A1 (en) | System and method for controlling work machine | |
| WO2022209214A1 (en) | Computing device and computation method | |
| JP4874839B2 (en) | Rough terrain vehicle | |
| JP4874838B2 (en) | Rough terrain vehicle | |
| KR102915055B1 (en) | Working vehicle | |
| KR20260017458A (en) | Working vehicle |