JP6180292B2 - 遠隔操作システム - Google Patents
遠隔操作システム Download PDFInfo
- Publication number
- JP6180292B2 JP6180292B2 JP2013237343A JP2013237343A JP6180292B2 JP 6180292 B2 JP6180292 B2 JP 6180292B2 JP 2013237343 A JP2013237343 A JP 2013237343A JP 2013237343 A JP2013237343 A JP 2013237343A JP 6180292 B2 JP6180292 B2 JP 6180292B2
- Authority
- JP
- Japan
- Prior art keywords
- elastic
- pressurized fluid
- control
- gain
- unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 239000012530 fluid Substances 0.000 claims description 32
- 238000001514 detection method Methods 0.000 claims description 20
- 230000005540 biological transmission Effects 0.000 claims description 17
- 238000004891 communication Methods 0.000 claims description 13
- 230000000704 physical effect Effects 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 description 18
- 230000008602 contraction Effects 0.000 description 16
- 239000011159 matrix material Substances 0.000 description 14
- 238000000034 method Methods 0.000 description 10
- 230000001133 acceleration Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 230000033001 locomotion Effects 0.000 description 5
- 238000013500 data storage Methods 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 239000013013 elastic material Substances 0.000 description 3
- 239000003381 stabilizer Substances 0.000 description 3
- 238000007599 discharging Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 239000000835 fiber Substances 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000003014 reinforcing effect Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000002285 radioactive effect Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 239000002023 wood Substances 0.000 description 1
Images
Landscapes
- Operation Control Of Excavators (AREA)
- Manipulator (AREA)
Description
また、運転操作手段は、操作者が作業車を操作する場合に使用するための各種の手段であり、作業レバー、走行レバー、アクセルレバー、ハンドル、エンジンキー又はアクセルペダル等を意味している。
また、弾性収縮体は、運転操作手段の種類によって任意の数を使用することができる。
本遠隔操作システムEは、操作者が、スタビライザー装置12にアタッチメントとしてのフェラバンチャ14が付設している作業車Cを遠隔操作するために用いられることを想定している。
図1に示すように、作業車Cは、運転室11がスタビライザー装置12の上方に設けられている。運転室11の前方には、略への字状に形成されたブーム15と、ブーム15に接続されたアーム16を備えており、当該アーム16は、ブーム15の上面に延設されている油圧シリンダ17により操作可能となっている。また、アーム16の先端部には、フェラバンチャ14が設けられており、ブーム15の下面に付設されているウインチ19及びアーム16の上面に延設されている油圧シリンダ18により操作可能となっている。
2本の作業レバーR1は、前後方向への揺動及びこの前後方向と交叉する左右方向への揺動の組み合わせにより、作業車Cによる各種作業を行うための操作がなされるように構成されている。
また、2本の走行レバーR2は、前後方向に揺動することにより、作業車Cの走行、旋回動作がなされるように構成されている。
そして、左右の作業レバーR1の間に、2本の左右の走行レバーR2が設けられており、4本のレバーが横方向に並設されている。
図2に示すように、操作指令伝達装置Dは、各運転操作部21と、運転操作部21から入力された操作信号に基づいて、作業レバーR1と走行レバーR2を遠隔操作するための操作指令情報(作業アーム43及び走行アーム53の目標推力等)を生成する操作者側中央制御部22と、作業車側通信制御部73との間で操作指令情報等のデータの送受信を行うための操作者側通信制御部23とを備えている。上記操作者側中央制御部22は、マイクロコンピュータによって構成されている。
また、この運転操作部21には、操作者の嗜好に合った快適な操作感覚となるように、下記作業車搭載ユニットUに使用されているものと同様の空気圧作動式のゴム状弾性材料で形成される伸縮体(弾性伸縮体、以下、「伸縮体」という。)が設けられている(図示せず)。このような構成より、伸縮体の内圧を制御することにより、ジョイスティック21A,21Bの使用時において、所望の操作感覚が実現されるようになっている。
図2に示すように、作業車搭載ユニットUは、作業レバーR1と走行レバーR2を動作させる動作実行装置40(動作実行手段)と、動作実行装置40を制御する作業車側制御装置70(制御手段)と、を一体として、作業車Cの運転席13に取り付け可能としたものである。
図4及び図5に示すように、取付部30は、側面視で倒立したL字形状の箱体31と、その下部に設けられている側面視で逆L字形状のフレーム部材32から形成されている。箱体31の内部には、制御装置70、バルブマニホールド68及び当該バルブマニホールド68に接続されているソレノイドバルブ69(制御弁)が収容されている。
そして、この箱体31の垂直面31aとフレーム部材32の垂直材33の部分が運転席13に固定されている。
動作実行装置40は、作業レバーR1及び走行レバーR2を操作するための装置であり、操作部41と、操作部41を構成する伸縮体44,54に圧縮空気を供給するための圧縮空気供給装置65と、センサ部61を備えている。
操作部41は、2本の作業レバーR1及び2本の走行レバーR2を操作するための装置である。この操作部41は、左右の作業レバー操作部42と、左右の走行レバー操作部52とから構成されており、左右の作業レバー操作部42の間に、左右の走行レバー操作部52が配置されている。
また、取付部材49を介して、2本の作業アーム43が、側面視凸状の円形上部支持板48の前方に突設した状態で並設され、鉛直方向に回動可能及び水平方向に旋回可能となるように軸支されている。
また、取付部材59を介して、走行アーム53が、上部支持板58の前方に突設した状態で、鉛直方向に回動可能となるように軸支されている。
センサ部61は、各作業アーム43及び各走行アーム53の加速度を検出する4個の加速度センサ62(動作検出装置)と、各伸縮体44,54の長さを検出する長さセンサ63(物理特性検出装置)と、各伸縮体44,54の内圧を検出する圧力センサ64とを備えている。これらの各センサ62〜64によって、それぞれの値が常時検出されており、検出値は所定の信号に変換され、後記する作業車側制御装置70に送信されている(図2参照)。
圧縮空気供給装置65は、空気圧縮機66(加圧流体供給装置)とエアタンク67とバルブマニホールド68とソレノイドバルブ69を主な構成要素としている。
作業車側制御装置70は、操作指令伝達装置Dから送信された操作指令情報(各伸縮体44,54の目標推力、作業アーム43及び走行アーム53の目標加速度等)を受信し、上記センサ部61により計測された検出値に基づいて各種制御を行う装置であり、マイクロコンピュータによって構成されている。
PID補償演算部82は、制御目標である作業アーム43及び走行アーム53の目標推力(以下、「目標推力」という。)に対して、PID制御を行うためのデータを算出するための装置である。なお、PID制御は公知の制御方法を用いることができる。
PID補償演算部82では、入力された目標推力fmと、圧力センサ64によって検出された実推力fnと、後記ゲイン決定部で決定された比例ゲインPg、微分ゲインDg及び積分ゲインIgの値に基づいて、比例項、微分項及び積分項を算出し、その和をPID出力値とすることができるようになっている(式1)。
PID出力値=Pg×(fn―fm)+Dg×{(fn―fm)―(fn-1―fm-1)}
+Ig×Σ(fn−fm) (式1)
((式1)中における「−1」の符号は、一時点前の検出時の状態を示している。)
FF補償演算部83は、制御目標である作業アーム43及び走行アーム53の目標推力に対して、FF制御を行うためのデータを算出するための装置である。なお、FF制御は公知の制御方法を用いることができる。
FF出力値=Fg×{fn―fm)―(fn-1―fm-1)+ff} (式2)
ゲイン決定部84は、長さセンサ63により検出された伸縮体44,54の長さと、圧力センサ64により検出された当該伸縮体44,54の内圧に対応する比例ゲインPg、微分ゲインDg、積分ゲインIg及びFFゲインFgの値を決定する装置である。
PWM指令出力部85は、ソレノイドバルブ69の弁開度を決定するアクチュエータ制御量ΔTHnをPWM信号(Pulse Width Modulation信号)として出力し、ソレノイドバルブ69に伝えるための装置である。
ΔTHn=(PID出力+FF出力)×制御対象 (式3)
(アクチュエータ制御量ΔTHnは、ソレノイドバルブ69の開度の一時点前の検出時に対する今回検出時の変更量を示している。)
次に、図8を参照して、本遠隔制御システムEの動作について説明する。
操作者は、作業車Cから一定距離離れた地点から、操作指令伝達装置Dの運転操作部21により所望の操作を行う(ST1)。すると、操作者側中央制御部22により目標推力fmのデータが作成され、通信手段を介して、操作者側通信制御部23及び作業車側通信制御部73を通じて作業機側制御装置70に送信される(ST2)。
本遠隔操作システムEによれば、ソレノイドバルブ制御部81が、予め算出され、データ記憶部91に記憶された伸縮体44,54の長さと当該伸縮体44,54の内圧値に対応した比例ゲインPg、微分ゲインDg、積分ゲインIg及びFFゲインFgの値の対応テーブルを備えており、伸縮体44,54の長さに対応する当該比例ゲインPg、微分ゲインDg、積分ゲインIg及びFFゲインFgの値に基づき、PIDFF制御方法によりソレノイドバルブ69の開度を調節することができる。そのため、伸縮体44,54の長さと当該伸縮体44,54の内圧が非線形の作動特性を有する場合であり、伸縮体44,54の長さが常時変化している状態であっても、空気圧縮機66からの圧縮空気の供給量を最適な量に調節することにより、伸縮体44,54の内圧を制御することができる。したがって、伸縮体44,54の安定的な動作に基づき、作業アーム43及び走行アーム53の位置決めを容易に行うことが可能となるため、作業車Cの作業レバーR1及び走行レバーR2をスムーズに動作させることができる。
例えば、2種類の異なる動作特性を有する伸縮体(A、B)を並設して、操作部材を形成する場合においても、各々の伸縮体の動作特性と、当該伸縮体の内圧値に応じた各種ゲイン値の対応表を算出して記憶させておくことや、各伸縮体のゲイン値の相対的な換算比率(A/B=0.5、A/B=0.65など)を変えることによって、目標推力に対して外乱が生じた場合であっても、安定した制御を実現することができることになる。
また、通信手段は、無線でも有線でもよく、両者を併用することもできる。
また、作業アーム及び走行アームを構成する伸縮体の数及びバルブマニホールドに設けられているソレノイドバルブの数も、適宜変更可能である。
さらに、各伸縮体における物理特性に関して、伸縮体の長さではなく、伸び率、比重、温度などの値として、それらの値と、内圧値との関係に対応したゲイン値を対応表として記憶させ、PID出力値及びFF出力値を算出する際に用いることもできる。
C 作業車
D 操作指令伝達装置(操作指令伝達手段)
U 作業車搭載ユニット
21 運転操作部
22 操作者側中央制御部
23 操作者側通信制御部
30 取付部
40 動作実行装置(動作実行手段)
41 操作部
42 作業レバー操作部
43 作業アーム
44,54 伸縮体
52 走行レバー操作部
53 走行アーム
61 センサ部
62 加速度センサ
63 長さセンサ(物理特性検出装置)
64 圧力センサ
65 圧縮空気供給装置
66 空気圧縮機(加圧流体供給装置)
69 ソレノイドバルブ(制御弁)
70 作業車側制御装置(制御手段)
73 作業車側通信制御部
81 ソレノイドバルブ制御部(加圧流体量制御装置)
82 PID補償演算部
83 フィードフォーワード(FF)補償演算部
84 ゲイン決定部
85 PWM指令出力部
91 データ記憶部(記憶手段)
Claims (2)
- 操作指令伝達手段を用い、通信手段を介して、運転操作手段を備える作業車を遠隔操作する遠隔操作システムにおいて、
前記運転操作手段を動作させる動作実行手段と、
前記操作指令伝達手段から送信された操作指令情報に基づいて前記動作実行手段を制御する制御手段と、を備え、
前記動作実行手段は、前記運転操作手段を操作するための操作部材と、
前記操作部材を支持するための、内部に加圧流体が供給されることによって所定方向に沿って軸力を発生する所定数の弾性伸縮体と、
前記各弾性伸縮体における少なくとも一つの物理特性を検出する物理特性検出装置と、
前記各弾性伸縮体内の内圧を検出する圧力検出装置と、
前記加圧流体を供給するための加圧流体供給装置と、を有し、
前記制御手段は、前記操作指令情報と前記圧力検出装置の検出結果に基づいて、前記各弾性伸縮体に供給する加圧流体量を制御するための加圧流体量制御装置と、を有するとともに、
前記加圧流体量制御装置は、予め算出され、記憶手段に記憶された、前記弾性伸縮体の物理特性と当該弾性伸縮体内の内圧値に対応した比例ゲイン値、微分ゲイン値及び積分ゲイン値の組み合わせから構成される対応表を備えており、
検出された前記各弾性伸縮体の内圧値と、検出された前記弾性伸縮体の物理特性と前記内圧に対応する前記比例ゲイン値、前記微分ゲイン値及び前記積分ゲイン値とを用い、PID制御により前記加圧流体供給装置における制御弁の開度を決定するためのアクチュエータ制御量を算出することを特徴とする遠隔操作システム。 - 前記加圧流体量制御装置は、予め算出され、記憶手段に記憶された、前記弾性伸縮体の物理特性と当該弾性伸縮体内の内圧値に対応したフィードフォワードゲイン値の組み合わせから構成される対応表をさらに備えており、
前記加圧流体量制御装置は、さらに検出された前記弾性伸縮体の物理特性と前記フィードフォワードゲイン値を用い、
PIDフィードフォーワード制御により、前記アクチュエータ制御量を算出することを特徴とする請求項1に記載の遠隔操作システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013237343A JP6180292B2 (ja) | 2013-11-15 | 2013-11-15 | 遠隔操作システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013237343A JP6180292B2 (ja) | 2013-11-15 | 2013-11-15 | 遠隔操作システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2015096291A JP2015096291A (ja) | 2015-05-21 |
JP6180292B2 true JP6180292B2 (ja) | 2017-08-16 |
Family
ID=53373862
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013237343A Active JP6180292B2 (ja) | 2013-11-15 | 2013-11-15 | 遠隔操作システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6180292B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019214831A (ja) * | 2018-06-11 | 2019-12-19 | 株式会社フジタ | 作業機械の遠隔制御システム |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61146483A (ja) * | 1984-12-21 | 1986-07-04 | 株式会社小松製作所 | マスタスレイブ方式マニピユレ−タ |
JP2005186218A (ja) * | 2003-12-25 | 2005-07-14 | Fujita Corp | 遠隔操作システム |
JP2006177560A (ja) * | 2006-01-10 | 2006-07-06 | Komatsu Ltd | 油圧駆動機械の制御装置 |
CN102448683B (zh) * | 2009-07-02 | 2014-08-27 | 松下电器产业株式会社 | 机器人、机器人手臂的控制装置及机器人手臂的控制程序 |
-
2013
- 2013-11-15 JP JP2013237343A patent/JP6180292B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2015096291A (ja) | 2015-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8244438B2 (en) | Tool control system | |
US8527158B2 (en) | Control system for a machine | |
US20140172246A1 (en) | Automatic Swing and Radius Control System and Method for a Machine Implement | |
US20200299930A1 (en) | Selectable velocity-based or position-based work vehicle operator control system | |
CN109099033A (zh) | 用于在机器中控制流体压力的传感器融合反馈 | |
US20140343697A1 (en) | Selectable Operating Modes for Machine Operator Input Devices | |
US20100050803A1 (en) | Manual control device | |
US20140166362A1 (en) | Implement Pose Control System and Method | |
US20140305012A1 (en) | Single boom system having dual arm linkage | |
JP6180292B2 (ja) | 遠隔操作システム | |
JP3749308B2 (ja) | 建設作業用マニュアルマニピュレータの操作制御機構 | |
CN219733777U (zh) | 致动器、平地机和液压缸 | |
CN219733778U (zh) | 致动器、平地机和液压缸 | |
CN219733781U (zh) | 致动器、平地机和液压缸 | |
CN219733782U (zh) | 致动器、平地机和液压缸 | |
CN219733780U (zh) | 致动器、平地机和液压缸 | |
CN217926538U (zh) | 致动器、平地机和液压缸 | |
CN219733783U (zh) | 致动器、平地机和液压缸 | |
CN217926540U (zh) | 致动器、平地机和液压缸 | |
CN219733779U (zh) | 致动器、平地机和液压缸 | |
CN217926544U (zh) | 致动器、平地机和液压缸 | |
CN217926541U (zh) | 致动器、平地机和液压缸 | |
CN217926542U (zh) | 致动器、平地机和液压缸 | |
CN217080955U (zh) | 致动器和平地机 | |
CN217926537U (zh) | 致动器、平地机和液压缸 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160902 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170609 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20170620 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170718 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6180292 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |