JP2020203680A - Caterpillar band type travelling body - Google Patents
Caterpillar band type travelling body Download PDFInfo
- Publication number
- JP2020203680A JP2020203680A JP2020148402A JP2020148402A JP2020203680A JP 2020203680 A JP2020203680 A JP 2020203680A JP 2020148402 A JP2020148402 A JP 2020148402A JP 2020148402 A JP2020148402 A JP 2020148402A JP 2020203680 A JP2020203680 A JP 2020203680A
- Authority
- JP
- Japan
- Prior art keywords
- track
- traveling body
- main body
- type traveling
- wheel
- 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.)
- Withdrawn
Links
Images
Landscapes
- Non-Deflectable Wheels, Steering Of Trailers, Or Other Steering (AREA)
Abstract
Description
本発明は、履帯式走行体に関する。 The present invention relates to a track-type traveling body.
現在、農地等の不整地を走り回ることによって、監視作業や物資の搬送作業等を行う走行体の開発が進んでいる。このような走行体では、樹木間、畑の畝間などの狭い経路であっても、本体を安定させて安全に走行することを目標にして開発が進められている。 Currently, the development of a traveling body that performs monitoring work, transportation work of goods, etc. by running around on rough terrain such as farmland is in progress. Development of such a traveling body is being promoted with the goal of stabilizing the main body and traveling safely even on narrow routes such as between trees and ridges in fields.
このような走行体の一例として、履帯式走行体がある。履帯式走行体の中には、接地部の間隔を狭く変更して狭い経路を走行できるものがあるが、左右の履帯を駆動する駆動源が干渉して、接地部の間隔設定に制約が生じてしまう課題があった。また、接地部の間隔を狭くすると走行体の安定性が低下して、転倒のおそれがあるという課題があった。 An example of such a traveling body is a track-type traveling body. Some track-type vehicles can travel on narrow routes by narrowing the distance between the ground contact parts, but the drive sources that drive the left and right crawler belts interfere with each other, causing restrictions on the distance setting of the ground contact parts. There was a problem that would end up. Further, if the distance between the ground contact portions is narrowed, the stability of the traveling body is lowered, and there is a problem that the vehicle may fall over.
これらの課題に対して、例えば、特許文献1は、履帯の駆動にインホイールモータを利用することで、機体内部の機器類の収納空間を大きく確保することができる無人走行用移動体を開示している。また、インホイールモータは水密状態で駆動することが可能であると言及している。特許文献2は、三角クローラ装置に従動クローラ装置を付属することで、容易に段差を乗り越えることができるクローラロボットを開示している。さらに、特許文献3は、左右のクローラを可変脚シリンダで連結してクローラ幅が変更可能なスライド式可変脚構造を有するクローラ式走行装置を開示している。そして、特許文献4は、所定の重心高さの関係式から転倒を防止するように履帯型走行体の重心位置を設定することで、段差移動時に転倒を防止することができるクローラ式作業車を開示している。 In response to these problems, for example, Patent Document 1 discloses an unmanned traveling vehicle that can secure a large storage space for equipment inside the airframe by using an in-wheel motor to drive the track. ing. It also mentions that in-wheel motors can be driven in a watertight state. Patent Document 2 discloses a crawler robot that can easily get over a step by attaching a driven crawler device to the triangular crawler device. Further, Patent Document 3 discloses a crawler type traveling device having a slide type variable leg structure in which the left and right crawlers are connected by a variable leg cylinder and the crawler width can be changed. Further, Patent Document 4 describes a crawler type work vehicle capable of preventing a fall when moving a step by setting the position of the center of gravity of the track-type traveling body so as to prevent the fall from the relational expression of the height of the predetermined center of gravity. It is disclosed.
しかしながら、特許文献1に開示された無人走行用移動体にあっては、インホイールモータに防水機構を施す必要があるため、コストが増大してしまう。また、特許文献2に開示されたクローラロボットにあっては、左右の三角クローラの間隔は固定されているため、狭い経路の走行は困難である。さらに、特許文献3に開示されたクローラ式走行装置にあっては、左右のクローラ幅を変更したときに本体の安定性を確保する方法については言及されていない。そして、特許文献4に開示されたクローラ式作業車にあっては、予め設定する重心位置は、多様な地形を安定して走行させるために余裕度を大きく持たせて設計する必要がある。したがって、狭い経路を走行する時に本体の幅が狭くなった場合には、重心位置が高くなりすぎて、本体の安定性が損なわれるおそれがある。 However, in the moving body for unmanned traveling disclosed in Patent Document 1, it is necessary to provide a waterproof mechanism to the in-wheel motor, which increases the cost. Further, in the crawler robot disclosed in Patent Document 2, since the distance between the left and right triangular crawlers is fixed, it is difficult to travel on a narrow route. Further, in the crawler type traveling device disclosed in Patent Document 3, there is no mention of a method of ensuring the stability of the main body when the left and right crawler widths are changed. Further, in the crawler type work vehicle disclosed in Patent Document 4, it is necessary to design the position of the center of gravity set in advance with a large margin in order to stably travel on various terrains. Therefore, if the width of the main body is narrowed when traveling on a narrow route, the position of the center of gravity may become too high and the stability of the main body may be impaired.
本発明は、上記に鑑みてなされたものであって、起伏が多く地盤状況が変化している不整地であっても、姿勢を安定させて走行できる履帯式走行体を提供することを目的とするものである。 The present invention has been made in view of the above, and an object of the present invention is to provide a track-type traveling body capable of traveling in a stable posture even on rough terrain with many undulations and changing ground conditions. Is what you do.
上述した課題を解決し、目的を達成するために、本発明は、履帯と、インホイールモータを内蔵して、当該履帯に駆動力を与える起動輪と、少なくとも2つの転輪と、前記起動輪と前記転輪とを支持する支持体と、上方に配置した前記起動輪と下方に配置した前記転輪との間に前記履帯を掛け回した、少なくとも2つの走行ユニットと、前記支持体を介して、前記少なくとも2つの走行ユニットを、少なくとも前記起動輪の回転軸よりも下方において、走行可能な状態で支持する本体と、前記支持体を前記本体に懸架する、前後方向に距離をとって設置された懸架部と、を有することを特徴とする。 In order to solve the above-mentioned problems and achieve the object, the present invention has a crawler belt, a starter wheel having an in-wheel motor built-in to give a driving force to the crawler belt, at least two wheels, and the starter wheel. And the support, the crawler belt is hung between the starting wheel arranged above and the rolling wheel arranged below, and the support is provided. The at least two traveling units are installed at least below the rotation axis of the starting wheel at a distance in the front-rear direction so that the main body that supports the traveling unit and the support body are suspended from the main body. It is characterized by having a suspended portion.
本発明によれば、起伏が多く地盤状況が変化している不整地であっても、姿勢を安定させて走行できる履帯式走行体を提供することができる。 According to the present invention, it is possible to provide a track-type traveling body capable of traveling with a stable posture even on rough terrain where there are many undulations and the ground condition is changing.
(第1の実施形態)
以下、本発明を実施するための第1の実施形態について、図面を用いて具体的に説明する。図1は、本発明の第1の実施形態である履帯式走行体100aの外観図であり、図1(a)は、履帯式走行体100aの外観斜視図である。図1(b)は、履帯式走行体100aの側面図(P矢視図)である。図1(c)は、履帯式走行体100aの上面図(Q矢視図)である。
(First Embodiment)
Hereinafter, the first embodiment for carrying out the present invention will be specifically described with reference to the drawings. FIG. 1 is an external view of the track-
図1(a)に示すように、履帯式走行体100aは、本体10と、起動輪12a、12bと、転輪14a、14b、14c、14dと、履帯18a、18bと、サスペンション20a、20bと、テンショナー部22a、22bと、支持体28と、を備える。
As shown in FIG. 1A, the track-
起動輪12a、12bは、履帯式走行体100aに対して、移動するための駆動力を伝達する。起動輪12aの内部にはインホイールモータ13aが設置されている。インホイールモータ13aの回転軸は起動輪12aの回転軸と直結しており、インホイールモータ13aの回転力によって起動輪12aが回転する。そして、インホイールモータ13aの回転力が、駆動力として履帯式走行体100aに伝達される。
The
転輪14a、14b、14c、14dは、回転自在に本体10に取り付けられている。
The
履帯18a、18bは、クローラとも呼ばれて、金属またはゴムで形成されている。履帯18aは、起動輪12aと転輪14a、14bに掛け回される。履帯18bは、起動輪12bと転輪14c、14dに掛け回される。履帯18aは、起動輪12aの回転方向に従って移動しながら、転輪14a、14bを従動させることによって、履帯式走行体100aを移動させる。また、履帯18bは、起動輪12bの回転方向に従って移動しながら、転輪14c、14dを従動させることによって、履帯式走行体100aを移動させる。
The
サスペンション20a、20bは、転輪14a、14b、14c、14dを本体10に懸架する。サスペンション20a、20bは、本発明における懸架部の一例であり、車重を支えて地面からの衝撃を吸収するスプリングと、スプリングの振動を減衰するショックアブソーバと、を備える。サスペンション20a、20bは、履帯式走行体100aが不整地を走行するときに、地面の凹凸に応じて伸縮することによって振動を吸収する。なお、サスペンション20a、20bの形式は問わない。また、サスペンション20a、20bは、転輪14a、14b、14c、14dを本体10に懸架する代わりに、転輪14a、14b、14c、14dを、後述する支持体28に懸架してもよい。
The
テンショナー部22a(22b)は、バネ等の弾性部材で形成されて、後述する支持体28に支持されている。テンショナー部22a(22b)は、履帯18a(18b)の裏面側に押し当たるように設置されて、履帯18a(18b)にテンションを与える。テンショナー部22a(22b)は、履帯18a(18b)の弛みを調整することによって、履帯18a(18b)による正常な駆動力の伝達を維持する。なお、前述したサスペンション20a(20b)は、転輪14a、14b(14c、14d)を履帯18a(18b)に押し当てているため、サスペンション20a(20b)をテンショナー部22a(22b)の代替えとしてもよい。
The
本体10は、後述する走行体30a(図1(b)参照)を走行可能な状態で支持する支持部材であるとともに、前述したインホイールモータ13aを駆動する走行用モータドライバおよびインホイールモータ13aに電力を供給するバッテリー等を搭載する。
The
支持体28は、本体10に設置されて、前述したサスペンション20a、20b、テンショナー部22a、22b等を支持する支持部材である。
The
図1(b)は、履帯式走行体100aのP矢視図である。図1(b)に示す起動輪12aと、インホイールモータ13aと、転輪14a、14bと、履帯18aと、サスペンション20aと、テンショナー部22aと、は走行体30aを形成する。走行体30aは、本発明における走行ユニットの一例である。走行体30aは、インホイールモータ13aが起動輪12aに伝達した駆動力(回転力)を、履帯18aを介して、転輪14a、14bに伝達する。履帯式走行体100aは、図1(c)に示すように、2つの走行体30a、30bを備える。なお、走行体30bは、図1(c)に示す起動輪12bと、インホイールモータ13bと、転輪14c、14dと、履帯18bと、サスペンション20bと、テンショナー部22bと、を備える。
FIG. 1B is a P arrow view of the track-
図1(b)に示すように、走行体30aにおいて、起動輪12aは、転輪14a、14bの上方に配置されている。そして、起動輪12aと、転輪14aと、転輪14bと、によって三角形が形成される。履帯18aは、起動輪12aと、転輪14aと、転輪14bと、に掛け回されて、転輪14aと、転輪14bと、の間の範囲が接地する。すなわち、インホイールモータ13aが内蔵された起動輪12aは、地面に接地しない。したがって、水溜まりを走行した場合であってもインホイールモータ13aが浸水することはないため、インホイールモータ13aに対して特別な防水機構を設置する必要はない。なお、図1(b)には図示しないが、走行体30bを形成する起動輪12bおよび転輪14c、14dも同様のレイアウトで配置されている。なお、図1(b)の例は、2個の転輪14a、14bを備えているが、これは2個に限定されるものではなく、履帯18aを掛け回せる状態で、より多くの転輪を備えても構わない。
As shown in FIG. 1B, in the traveling
図1(c)は、履帯式走行体100aのQ矢視図である。図1(c)に示すように、2つの走行体30a、30bは、本体10を挟んで、履帯18a、18bが略平行になるように、すなわち履帯式走行体100aが走行可能な状態で設置される。本体10は、インホイールモータ13a、13bを駆動する、いずれも後述する、走行制御用モータドライバ70(図2参照)と、走行制御用モータドライバ70とインホイールモータ13a、13bとに電力を供給するバッテリー90(図2参照)と、バランス制御機構92(図3参照)と、を備えている。なお、走行体の数は2つに限定されるものではなく、例えば3つの走行体を平行に3列に整列させる等、履帯式走行体100aが走行可能な状態であれば、走行体の数は問わない。
FIG. 1C is a Q arrow view of the track-
(履帯式走行体のハードウェア構成の説明)
次に、図2を用いて、第1の実施形態の履帯式走行体100aのハードウェア構成について説明する。図2は、第1の実施形態の履帯式走行体100aのハードウェア構成を示すハードウェアブロック図である。
(Explanation of hardware configuration of track-type vehicle)
Next, the hardware configuration of the track-
図2に示すように、履帯式走行体100aは、ラジコン送信機50と、ラジコン受信機52と、CPU54と、メモリ56と、MEMSセンサ58と、ステレオカメラ60と、走行制御用モータドライバ70と、インホイールモータ13a、13bと、姿勢制御用モータドライバ80と、姿勢制御用モータ82a、82bと、バッテリー90と、を備える。なお、ラジコン受信機52と、CPU54と、メモリ56と、MEMSセンサ58と、ステレオカメラ60と、走行制御用モータドライバ70と、姿勢制御用モータドライバ80と、はシステムバス62を介して接続されている。
As shown in FIG. 2, the footwear
ラジコン送信機50は、履帯式走行体100aに対して動作指示を与える。
The radio-controlled
ラジコン受信機52は、ラジコン送信機50から送信される履帯式走行体100aの動作指示を受信する。
The radio-controlled
CPU54は、後述するメモリ56が記憶したプログラムP1を読み出して実行する。
The
メモリ56は、CPU54が実行するプログラムP1をはじめ、履帯式走行体100aを動作させるのに必要な各種データを記憶する。
The
プログラムP1は、メモリ56に予め組み込まれて提供される。また、プログラムP1は、インストール可能な形式、または実行可能な形式のファイルでCD−ROM、フレキシブルディスク(FD)、CD−R、DVD(Digital Versatile Disc)等のCPU54(コンピュータ)で読み取り可能な記録媒体に記録して提供するように構成してもよい。さらに、プログラムP1を、インターネット等のネットワークに接続されたコンピュータ上に格納し、ネットワーク経由で履帯式走行体100aにダウンロードさせることにより提供するように構成してもよい。また、プログラムP1をインターネット等のネットワーク経由で提供または配布するように構成してもよい。プログラムP1を外部から提供するときは、CPU54には、図2に非図示の通信I/Fを介してプログラムP1を読み込む。なお、履帯式走行体100aは、CPU54をプログラムP1に従って動作させる代わりに、プログラムP1が実行するのと同じ演算機能および制御機能を有する専用のASIC(Application Specific Integrated Circuit)を実装することによって、ハードウェア的に動作させてもよい。
The program P1 is provided in the
MEMSセンサ58は、xyz座標系の3軸方向の動きを計測するセンサである。より具体的には、3軸方向の角速度および加速度を計測する。なお、MEMS(Micro Electro Mechanical Systems)とは、機械要素部品、センサ、アクチュエータ、電子回路を一つのシリコン基板、ガラス基板、有機材料等の上に集積化したデバイスである。本実施形態で用いるMEMSセンサ58は、シリコン基板上に作成した片持ち梁構造によって形成されるジャイロスコープによって、前述した3軸方向の動きを計測する。なお、MEMSセンサ58は、さらに3軸方向の地磁気を計測する機能を加えた構成としてもよい。 The MEMS sensor 58 is a sensor that measures the movement of the xyz coordinate system in the three axial directions. More specifically, the angular velocity and acceleration in the three axial directions are measured. A MEMS (Micro Electro Mechanical Systems) is a device in which mechanical element parts, sensors, actuators, and electronic circuits are integrated on one silicon substrate, glass substrate, organic material, or the like. The MEMS sensor 58 used in the present embodiment measures the above-mentioned movement in the three axial directions by a gyroscope formed by a cantilever structure formed on a silicon substrate. The MEMS sensor 58 may be configured to further have a function of measuring the geomagnetism in the three axial directions.
ステレオカメラ60は、互いの光軸が略平行になるように配置された2台のカメラで構成されており、本体10に設置される。ステレオカメラ60は、履帯式走行体100aの前方の走行環境を監視して、本体10の傾きの算出および履帯式走行体100aの周囲の障害物の検出を行う。ステレオカメラ60は、ジンバル(Gimbal)を備えており、履帯式走行体100aの姿勢によらずに、ステレオカメラ60の向きを常に一定に保持する。なお、ジンバルを備える代わりに、前述したMEMSセンサ58の出力を用いて、ステレオカメラ60の向きを補正してもよい。
The
なお、履帯式走行体100aをラジコン操縦するときには、操縦者は履帯式走行体100aの周囲の障害物を視認することができるため、履帯式走行体100aは、必ずしも障害物を検出する機能を備える必要はない。さらに、本体10の傾きはMEMSセンサ58によって計測することができる。したがって、ステレオカメラ60がなくても、操縦者は、自ら視認した結果に基づいて履帯式走行体100aを操縦することができる。しかし、ステレオカメラ60を用いることによって、履帯式走行体100aが行う姿勢制御の精度をより一層向上させることができる。
When the track-
前述したMEMSセンサ58は、現在の本体10の傾きを計測する。これに対して、ステレオカメラ60は、履帯式走行体100aの進行方向前方の路面を撮像するため、履帯式走行体100aの前方の路面の傾斜を予め予測することができる。すなわち、ステレオカメラ60を用いることによって、履帯式走行体100aの将来の姿勢を予測することができる。したがって、MEMSセンサ58の出力を用いた場合と比べて、履帯式走行体100aの姿勢制御の精度をより一層向上させることができる。詳しくは後述する。
The MEMS sensor 58 described above measures the inclination of the current
再び図2に戻って、走行制御用モータドライバ70は、インホイールモータ13a、13bに対して、後述するモータ駆動信号76a、76bをそれぞれ供給することによって、インホイールモータ13a、13bを駆動する。
Returning to FIG. 2 again, the travel
インホイールモータ13a、13bは、前述した起動輪12a、12bに回転力を伝達する。より具体的には、インホイールモータ13a、13bは、起動輪12a、12bに対して、履帯式走行体100aを前進させる正方向の回転、または履帯式走行体100aを後退させる負方向の回転を与える。さらに、インホイールモータ13a、13bは、一方の起動輪12aまたは12bのみを正方向または負方向に回転させて、他方の起動輪12bまたは12aを停止させることによって、履帯式走行体100aを信地旋回させる。また、インホイールモータ13a、13bは、一方の起動輪12aまたは12bを正方向に回転させて、他方の起動輪12bまたは12aを負方向に回転させることによって、履帯式走行体100aを超信地旋回させる。
The in-
姿勢制御用モータドライバ80は、姿勢制御用モータ82a、82bに対して、後述するモータ駆動信号86a、86bをそれぞれ供給することによって、姿勢制御用モータ82a、82bを駆動する。
The attitude
姿勢制御用モータ82a、82bは、本体10の姿勢を制御することによって、履帯式走行体100aの転倒を防止する。
The
バッテリー90は、インホイールモータ13a、13bおよび姿勢制御用モータ82a、82bに対して電力を供給する。
The
(バランス制御機構の構造の説明)
次に、図3を用いて、履帯式走行体100aが備えるバランス制御機構92について説明する。図3は、履帯式走行体100aが備えるバランス制御機構92の概略構造を示す三面図である。図3に示すバランス制御機構92は、履帯式走行体100aの本体10の内部または本体10の上部に設置されて、本体10を水平に保つことによって履帯式走行体100aの姿勢制御を行う。
(Explanation of the structure of the balance control mechanism)
Next, the
バランス制御機構92は、本発明におけるバランス機構の一例である。バランス制御機構92は、Xステージ94と、Yステージ96と、姿勢制御用モータ82a、82bと、Xシャフト95と、Yシャフト97と、錘98と、を備えている。
The
姿勢制御用モータ82aは、例えばステップモータである。姿勢制御用モータ82aは、前述した姿勢制御用モータドライバ80(図2)によって駆動されて、Xステージ94をx方向に沿って移動させる。
The
Xシャフト95は、姿勢制御用モータ82aの回転軸に直結している。Xシャフト95は、姿勢制御用モータ82aの回転に応じた向きに回転する。Xシャフト95の外面にはねじ切り加工がなされて、雄ねじが形成されている。
The
図3に示すように、Xステージ94の裏面側には、Xステージ支持部94eが設置されている。Xステージ支持部94eには、x方向に沿って孔部94hが延設されている。孔部94hの内面には、Xシャフト95に螺合された、ボールネジを形成する雌ねじ(ナット)が形成されている。したがって、Xステージ94は、x方向に沿って、Xシャフト95の回転に応じた方向に、Xシャフト95の回転量に応じた量だけ摺動する。なお、図3に示すように、Xステージ94の前端部および後端部には、それぞれ、x方向に沿うリブ94a、94bが形成されている。これらのリブ94a、94bは、本体10の前端部および後端部に、それぞれx方向に沿って形成された溝部10a、10bとそれぞれ係合している。したがって、Xステージ94は、Xシャフト95の回転に応じて、x方向に沿ってがたつくことなく円滑に摺動する。
As shown in FIG. 3, an X
姿勢制御用モータ82bは、例えばステップモータである。姿勢制御用モータ82bは、前述した姿勢制御用モータドライバ80(図2)によって駆動されて、Yステージ96をy方向に沿って移動させる。
The
Yシャフト97は、姿勢制御用モータ82bの回転軸に直結している。Yシャフト97は、姿勢制御用モータ82bの回転に応じた向きに回転する。Yシャフト97の表面にはねじ切り加工がなされて、雄ねじが形成されている。
The
図3に示すように、Yステージ96には、y方向に沿って孔部96hが延設されている。孔部96hの内面には、Yシャフト97に螺合された、ボールネジを形成する雌ねじ(ナット)が形成されている。したがって、Yステージ96は、y方向に沿って、Yシャフト97の回転に応じた方向に、Yシャフト97の回転量に応じた量だけ摺動する。なお、図3に示すように、Yステージ96の左右端部には、それぞれ、y方向に沿うリブ96a、96bが形成されている。これらのリブ96a、96bは、Xステージ94の左右端部に、それぞれy方向に沿って形成された溝部94c、94dとそれぞれ係合している。したがって、Yステージ96は、Yシャフト97の回転に応じて、y方向に沿ってがたつくことなく円滑に摺動する。
As shown in FIG. 3, the
錘98は、Yステージ96上に設置されている。錘98は、Yステージ96の移動に応じて、図3のx方向およびy方向に沿って移動する。そして、錘98の移動に応じて本体10の重心位置が移動する。したがって、傾斜地等を走行したときに履帯式走行体100aの姿勢が崩れた場合には、錘98の位置を移動させることによって、本体10の重心位置を移動させて、履帯式走行体100aの転倒を防止することができる。
The
(履帯式走行体の機能構成の説明)
次に、図4を用いて、履帯式走行体100aの機能構成について説明する。図4は、第1の実施形態の履帯式走行体100aの機能構成を示す機能ブロック図である。
(Explanation of the functional configuration of the track-type vehicle)
Next, the functional configuration of the track-
図4に示すように、履帯式走行体100aは、操作信号デコード部64と、姿勢推定部66と、インホイールモータ回転制御部74と、姿勢制御用モータ回転制御部84と、を備える。
As shown in FIG. 4, the track-
操作信号デコード部64は、ラジコン送信機50(図2)が送信した履帯式走行体100aの操作信号をラジコン受信機52で受信した後で復号(デコード)して、履帯式走行体100aに対する操作者の操作指示を解読する。操作信号デコード部64は、CPU54(図2)がメモリ56上のプログラムP1を実行することによって実現される。
The operation
姿勢推定部66は、MEMSセンサ58の出力、またはステレオカメラ60の出力に基づいて、本体10の姿勢(左右傾き、前後傾き)を推定する。姿勢推定部66は、CPU54(図2)がメモリ56上のプログラムP1を実行することによって実現される。なお、詳しくは後述するが、姿勢推定を行う際にMEMSセンサ58の出力を用いるか、ステレオカメラ60の出力を用いるか、によって姿勢推定部66が行う処理の内容は異なる。
The posture estimation unit 66 estimates the posture (left-right tilt, front-back tilt) of the
インホイールモータ回転制御部74は、操作信号デコード部64がデコードした操作指示に基づいて、インホイールモータ13a、13bをそれぞれ駆動するためのモータ駆動信号76a、76bを生成する。より具体的には、インホイールモータ回転制御部74は、CPU54(図2)がメモリ56上のプログラムP1を実行して、走行制御用モータドライバ70と協働することによって、モータ駆動信号76a、76bを生成してインホイールモータ13a、13bに供給し、履帯式走行体100aの走行制御を行う。なお、モータ駆動信号76aは、インホイールモータ13aを駆動する信号であり、モータ駆動信号76bは、インホイールモータ13bを駆動する信号である。
The in-wheel motor rotation control unit 74 generates motor drive signals 76a and 76b for driving the in-
姿勢制御用モータ回転制御部84は、本発明におけるバランス制御部の一例である。姿勢制御用モータ回転制御部84は、姿勢推定部66が推定した本体10の姿勢に基づいて、姿勢制御用モータ82a、82bをそれぞれ駆動するためのモータ駆動信号86a、86bを生成する。より具体的には、姿勢制御用モータ回転制御部84は、CPU54(図2)がメモリ56上のプログラムP1を実行して、姿勢制御用モータドライバ80と協働することによって、モータ駆動信号86a、86bを生成して姿勢制御用モータ82a、82bに供給し、履帯式走行体100aの姿勢制御を行う。なお、モータ駆動信号86aは、姿勢制御用モータ82aを駆動する信号であり、モータ駆動信号86bは、姿勢制御用モータ82bを駆動する信号である。なお、詳しくは後述するが、姿勢推定を行う際にMEMSセンサ58の出力を用いるか、ステレオカメラ60の出力を用いるか、によって、姿勢制御用モータ回転制御部84が行う制御の内容は異なる。
The attitude control motor rotation control unit 84 is an example of the balance control unit in the present invention. The attitude control motor rotation control unit 84 generates motor drive signals 86a and 86b for driving the
(バランス制御の流れの説明)
次に、図5を用いて、バランス制御機構92が行うバランス制御の流れについて説明する。図5は、バランス制御機構92が行うバランス制御の流れを示すフローチャートである。
(Explanation of balance control flow)
Next, the flow of balance control performed by the
姿勢制御用モータ回転制御部84は、本体10の左右傾きθxを0にするためのXステージ94の移動量を算出する(ステップS12)。具体的には、姿勢推定部66が、MEMSセンサ58の出力に基づいて本体10の姿勢推定を行ったときには、姿勢制御用モータ回転制御部84は、MEMSセンサ58の出力に基づいて、本体10の左右傾きθxを算出して、左右傾きθxを0にするための錘98のx方向位置を算出する。
The attitude control motor rotation control unit 84 calculates the amount of movement of the
一方、姿勢推定部66が、ステレオカメラ60の出力に基づいて本体10の姿勢推定を行うときには、姿勢制御用モータ回転制御部84は、履帯式走行体100aが予測される走行経路に沿って走行したときの本体10の左右傾きθxの時間変化に基づいて錘98のx方向移動量を算出する。すなわち、予測される左右傾きθxの時間変化θxi(i=0、1、…、n)に対して、予測される左右傾きθxiをできるだけ0に保つための錘98のx方向位置Xi(i=0、1、…、n)を計算する。
On the other hand, when the posture estimation unit 66 estimates the posture of the
姿勢制御用モータ回転制御部84は、錘98のx方向位置Xiを、時刻t0においてX0、時刻t0+ΔtにおいてX1、…、時刻t0+nΔtにおいてXnと移動させるための制御問題を、所定のコスト関数が最大または最小になるように解く。コスト関数としては様々なものが考えられ、そのいずれを用いてもよい。例えば、最も忠実に錘98が動くように錘98のx方向位置のエラーをコスト関数とすることができる。他には、錘98の移動による履帯式走行体100aへの影響が最も少なくなるように加速度(及び減速度)の大きさをコスト関数としてもよい。コスト関数の設定によって、例えば、加速度が大きくなり過ぎないように、錘98のx方向位置のエラーはある程度(転倒しない程度)まで許容する解などを抽出することが可能となる。このような制御方法をとることによって、制御が急になり過ぎてかえって安定性を失う、或いは、制御が遅すぎて間に合わない等のリスクを軽減することができる。なお、制御問題を解く際に使用するソルバーについては、提案されている様々なアルゴリズム(例えば、非線形プログラミングソルバーであるSNOPT)を利用することができる。
The attitude control motor rotation control unit 84 has a predetermined cost function that maximizes the control problem for moving the position Xi of the
なお、姿勢推定部66における本体10の姿勢推定精度を向上させるために、ステレオ画像と本体10の傾きとを取得しながら、履帯式走行体100aを実際に走行させて、本体10の傾きの正解を得ながら、機械学習を行う。そして、機械学習によるトレーニングを行うことによって、履帯式走行体100aは、姿勢推定部66における姿勢推定のルール、判断基準等を学習する。なお、本体10の傾きはステレオカメラ60の傾きと等しいものとみなせるが、ジンバル等でステレオカメラ60の傾きをゼロ補正しておくことができれば、傾きの取得は不要である。
In order to improve the posture estimation accuracy of the
姿勢制御用モータ回転制御部84は、決定した錘98のx方向位置、または錘98のx方向位置Xiに従って姿勢制御用モータ82aを制御する(ステップS14)。具体的には、姿勢制御用モータ回転制御部84は、目標値と制御量との偏差に応じて、比例動作と、積分動作と、微分動作と、を組み合わせたPID(Proportional Integral Differential)制御を行う。PID制御は広く一般に用いられている制御方法であるため、詳しい説明は省略する。
The attitude control motor rotation control unit 84 controls the
姿勢制御用モータ回転制御部84は、Xステージ94の制御が完了したかを判定する(ステップS16)。Xステージ94の制御が完了したとき(ステップS16;Yes)はステップS20に進み、それ以外のとき(ステップS16;No)はステップS12に戻る。
The attitude control motor rotation control unit 84 determines whether the control of the
姿勢制御用モータ回転制御部84は、前後傾きθyを0にするためのYステージ96の移動量を算出する(ステップS20)。具体的には、姿勢推定部66が、MEMSセンサ58の出力に基づいて本体10の姿勢推定を行ったときには、MEMSセンサ58の出力に基づいて、本体10の前後傾きθyを算出して、前後傾きθyを0にするための錘98のy方向位置を算出する。
The attitude control motor rotation control unit 84 calculates the amount of movement of the
一方、姿勢推定部66が、ステレオカメラ60の出力に基づいて本体10の姿勢推定を行うときには、姿勢制御用モータ回転制御部84は、履帯式走行体100aが予測される走行経路に沿って走行したときの本体10の前後傾きθyの時間変化に基づいて錘98のy方向移動量を算出する。すなわち、予測される前後傾きθyの時間変化θyi(i=0、1、…、n)に対して、予測される前後傾きθyiをできるだけ0に保つための錘98のy方向位置Yi(i=0、1、…、n)を計算する。
On the other hand, when the posture estimation unit 66 estimates the posture of the
姿勢制御用モータ回転制御部84は、錘98のy方向位置Yiを、時刻t0においてY0、時刻t0+ΔtにおいてY1、…、時刻t0+nΔtにおいてYnと移動させるための制御問題を、所定のコスト関数が最大または最小になるように解く。このy方向制御は、前述した錘98のx方向位置Xiの制御と同様にして解くことができる。
The attitude control motor rotation control unit 84 solves a control problem for moving the y-direction position Yi of the
姿勢制御用モータ回転制御部84は、決定した錘98のy方向位置、または錘98のy方向位置Yiに従って姿勢制御用モータ82bを制御する(ステップS22)。
The attitude control motor rotation control unit 84 controls the
姿勢制御用モータ回転制御部84は、Yステージ96の制御が完了したかを判定する(ステップS24)。Yステージ96の制御が完了したとき(ステップS24;Yes)は図5の処理を終了し、それ以外のとき(ステップS24;No)はステップS20に戻る。
The attitude control motor rotation control unit 84 determines whether the control of the
(履帯式走行体が行う制御の全体の流れの説明)
次に、図6を用いて、MEMSセンサ58の出力を用いた際に履帯式走行体100aが行う走行制御および姿勢制御の全体の流れを説明する。図6は、MEMSセンサ58の出力に基づいて本体10の現在の傾きを算出して、算出した傾きに基づいて履帯式走行体100aの制御を行う際の制御の流れを示すフローチャートである。
(Explanation of the overall flow of control performed by the tracked vehicle)
Next, with reference to FIG. 6, the overall flow of the running control and the attitude control performed by the track-
操作信号デコード部64は、ラジコン受信機52が受信した信号をデコードする(ステップS30)。
The operation
インホイールモータ回転制御部74は、インホイールモータ13a、13bを駆動するモータ駆動信号76a、76bを生成する(ステップS32)。
The in-wheel motor rotation control unit 74 generates motor drive signals 76a and 76b for driving the in-
走行制御用モータドライバ70は、インホイールモータ13a、13bを駆動する走行制御を実行する(ステップS34)。
The travel
姿勢推定部66は、MEMSセンサ58の出力に基づいて、本体10の左右傾きθxおよび前後傾きθyを推定する(ステップS35)。
The posture estimation unit 66 estimates the left-right tilt θx and the front-back tilt θy of the
姿勢推定部66は、本体10の左右傾きθxおよび前後傾きθyがともに0になるように本体10の姿勢を制御する姿勢制御を実行する(ステップS36)。具体的な姿勢の制御方法は前述(図5)した通りである。ステップS36が完了すると、図6の処理を終了する。
The posture estimation unit 66 executes posture control for controlling the posture of the
ステップS36で行うフィードバック制御は、路面の傾斜が徐々に変化している場合などには有効な手法である。しかし、不整地を走行したときには、地面の起伏や、地盤状況の変化によって、履帯式走行体100aの姿勢が急激に変化する場合がある。このようなときにフィードバック制御を用いて姿勢制御を行うと、制御が間に合わずに、履帯式走行体100aが転倒してしまうおそれがある。そのため、事前に履帯式走行体100aの将来の姿勢を予測することによって、予め姿勢制御を開始する、いわゆるオープンループ制御を行うのが望ましい。本実施形態にあっては、ステレオカメラ60が取得した画像の中から、ラジコンの操作信号によって特定できる履帯式走行体100aの進行方向に対応する領域を抽出することができる。したがって、履帯式走行体100aが進行する方向の路面の傾斜を予め予測することができる。そのため、前述したオープンループ制御を行うことができる。
The feedback control performed in step S36 is an effective method when the slope of the road surface is gradually changing. However, when traveling on rough terrain, the posture of the track-
以下、図7を用いて、ステレオカメラ60が取得した画像を用いた際に履帯式走行体100aが行う走行制御および姿勢制御の全体の流れを説明する。図7は、ステレオカメラ60が取得した画像に基づいて本体10の将来の傾きを予測して、予測した傾きに基づいて履帯式走行体100aの制御を行う際の制御の流れを示すフローチャートである。
Hereinafter, with reference to FIG. 7, the overall flow of travel control and attitude control performed by the track-
操作信号デコード部64は、ラジコン受信機52が受信した信号をデコードする(ステップS40)。
The operation
インホイールモータ回転制御部74は、インホイールモータ13a、13bを駆動するモータ駆動信号76a、76bを生成する(ステップS42)。
The in-wheel motor rotation control unit 74 generates motor drive signals 76a and 76b for driving the in-
走行制御用モータドライバ70は、インホイールモータ13a、13bを駆動する走行制御を行う(ステップS44)。
The travel
ステレオカメラ60は、ステレオ画像を取得する(ステップS46)。
The
姿勢推定部66は、ステップS46で取得したステレオ画像の中から、履帯式走行体100aが将来走行すると予想される走行経路に対応する領域を切り出す(ステップS48)。なお、将来走行すると予想される走行経路は、操作信号デコード部64がデコードした信号に基づいて予測する。
The posture estimation unit 66 cuts out a region corresponding to the traveling path where the track-
姿勢推定部66は、ステップS48で切り出したステレオ画像に基づいて、予測される本体10の左右傾きθxの時間変化θxi(i=0、1、…、n)と、予測される本体10の前後傾きθyの時間変化θyi(i=0、1、…、n)を推定する(ステップS49)。
The posture estimation unit 66 determines the time change θxi (i = 0, 1, ..., N) of the predicted left-right inclination θx of the
姿勢制御用モータ回転制御部84は、予測される本体10の左右傾きθxの時間変化θxiおよび前後傾きθyの時間変化θyiに基づいて、錘98のx方向位置Xiとy方向位置Yiを制御する姿勢制御を行う(ステップS50)。具体的な姿勢の制御方法は前述(図5)した通りである。ステップS50が完了すると、図7の処理を終了する。
The attitude control motor rotation control unit 84 controls the x-direction position Xi and the y-direction position Yi of the
(第2の実施形態)
次に、本発明を実施するための第2の実施形態について、図面を用いて具体的に説明する。図8は、本発明の第2の実施形態である履帯式走行体100bの上面図である。なお、第1の実施形態と同じ構造を有する部位は、同一符号を用いて示し、その詳細説明は省略する。
(Second Embodiment)
Next, a second embodiment for carrying out the present invention will be specifically described with reference to the drawings. FIG. 8 is a top view of the track-
第2の実施形態の履帯式走行体100bは、走行体30a、30bの間隔(距離)を変更できるものである。具体的には、図8に示すように、走行体30aは、本体10との間に伸縮自在な伸縮シャフト32a、32cを備える。伸縮シャフト32a、32cは、本発明における走行ユニット接続部の一例である。伸縮シャフト32a、32cは、後述するように、それぞれ伸縮用モータ34a、34bの回転軸と接続されており、伸縮用モータ34a、34bの回転に応じて伸縮する。なお、2本の伸縮シャフト32a、32cは平行に配置されている。伸縮シャフト32a、32cの走行体30a側の端部は、支持体28に固定されている。伸縮シャフト32a、32cの具体的な構造については後述する。
The track-
同様に、走行体30bは、本体10との間に伸縮自在な伸縮シャフト32b、32dを備える。伸縮シャフト32b、32dは、本発明における走行ユニット接続部の一例である。伸縮シャフト32b、32dは、後述するように、それぞれ伸縮用モータ34a、34bの回転軸と接続されており、伸縮用モータ34a、34bの回転に応じて伸縮する。2本の伸縮シャフト32b、32dは平行に配置されている。伸縮シャフト32b、32dの走行体30b側の端部は、支持体28に固定されている。
Similarly, the traveling
次に、図9を用いて、伸縮用モータ34aによって伸縮を制御される伸縮シャフト32a、32bの機能について説明する。図9(a)は、伸縮シャフト32a、32bが伸びた状態を示す履帯式走行体100bの正面図(R矢視図)である。図9(b)は、伸縮シャフト32a、32bが縮んだ状態を示す履帯式走行体100bの正面図(R矢視図)である。
Next, with reference to FIG. 9, the functions of the
図9(a)、図9(b)に示すように、伸縮シャフト32a、32bは、伸縮用モータ34aによって、ともに同じ長さになるように伸縮する。これによって、履帯式走行体100bにおける走行体30a、30bの間隔Wは、最も広い間隔Wa(図9(a))と、最も狭い間隔Wb(図9(b))と、の間で任意に変更することができる。なお、図9には図示しないが、伸縮シャフト32c、32dも同様の機能を有する。したがって、走行体30aと、走行体30bと、は平行な状態を保ったまま、その間隔Wを変更することができる。
As shown in FIGS. 9 (a) and 9 (b), the
(履帯式走行体のハードウェア構成の説明)
次に、図10を用いて、第2の実施形態の履帯式走行体100bのハードウェア構成について説明する。図10は、第2の実施形態の履帯式走行体100bのハードウェア構成を示すハードウェアブロック図である。
(Explanation of hardware configuration of track-type vehicle)
Next, the hardware configuration of the track-
履帯式走行体100bは、履帯式走行体100aのハードウェア構成(図2)に加えて、伸縮制御用モータドライバ82と、伸縮用モータ34a、34bと、を備える。伸縮用モータ34a、34bには、バッテリー90から電力が供給される。
The track-
伸縮制御用モータドライバ82は、伸縮用モータ34a、34bに対して、モータ駆動信号をそれぞれ供給することによって、伸縮用モータ34a、34bを駆動する。なお、伸縮制御用モータドライバ82に対する操作指示は、ラジコン送信機50からの送信によって行われる。
The expansion / contraction
伸縮用モータ34a(34b)は、前述した伸縮シャフト32a、32b(32c、32d)の長さを変更することによって、走行体30aと走行体30bとの間隔Wを変更する。
The expansion /
なお、履帯式走行体100bにおいて、CPU54は、メモリ56に記憶されたプログラムP2を読み出して実行することによって、履帯式走行体100bの全体の動作を制御する。
In the track-
(履帯式走行体の機能構成の説明)
次に、図11を用いて、履帯式走行体100bの機能構成について説明する。図11は、第2の実施形態の履帯式走行体100bの機能構成を示す機能ブロック図である。
(Explanation of the functional configuration of the track-type vehicle)
Next, the functional configuration of the track-
図11に示すように、履帯式走行体100bは、第1の実施形態で説明した履帯式走行体100aの構成要素(図4)に加えて、伸縮用モータ回転制御部88を備える。
As shown in FIG. 11, the track-
伸縮用モータ回転制御部88は、本発明における走行ユニット接続制御部の一例である。伸縮用モータ回転制御部88は、操作信号デコード部64がデコードした操作指示に基づいて、伸縮用モータ34a、34bをそれぞれ駆動するためのモータ駆動信号89a、89bを生成する。より具体的には、伸縮用モータ回転制御部88は、CPU54(図10)がメモリ56上のプログラムP2を実行して、伸縮制御用モータドライバ82と協働することによって、モータ駆動信号89a、89bを生成して伸縮用モータ34a、34bに供給し、伸縮シャフト32a、32b、32c、32d(図8)の伸縮を制御する。なお、モータ駆動信号89aは、伸縮用モータ34aを駆動する信号であり、モータ駆動信号89bは、伸縮用モータ34bを駆動する信号である。
The expansion / contraction motor
(伸縮シャフトの構造と動作の説明)
次に、図12を用いて、伸縮シャフト32a、32b(32c、32d)の構造および動作について説明する。図12は、伸縮シャフト32a、32bの構造を示す構造図であり、図8に示した履帯式走行体100bの正面図(R矢視図)である。図12に示すように、2本の伸縮シャフト32a、32bは、それぞれ、ベベルギア40(傘歯車)を介して、伸縮用モータ34aの回転軸36aと接続している。そして、伸縮用モータ34aの回転軸36aの回転力が、2本の伸縮シャフト32a、32bに伝達される。
(Explanation of structure and operation of telescopic shaft)
Next, the structure and operation of the
伸縮シャフト32a(32b)は、ねじ軸37a(37b)と、ねじ軸37a(37b)に螺合されてボールネジを形成するナット38a(38b)と、シャフト部39a(39b)と、を備える。ねじ軸37a(37b)の一端は、ベベルギア40に接続されており、ねじ軸37a(37b)は、ベベルギア40とともに回転する。ねじ軸37a(37b)は、ナット38a(38b)に螺合されて、ボールネジを形成している。そして、シャフト部39a(39b)の一方の端部は、ナット38a(38b)に固定されており、シャフト部39a(39b)の他方の端部は、支持体28(28)に接続されている。なお、回転軸36aと、ベベルギア40と、ねじ軸37a(37b)と、ナット38a(38b)と、シャフト部39a(39b)と、はハウジング35aに内包されている。
The
伸縮用モータ34aの回転に伴って回転軸36aが矢印Pa方向に回転すると、ベベルギア40を介して、ねじ軸37a(37b)が回転する。すると、ねじ軸37a(37b)に螺合されたナット38a(38b)が矢印Ra(Rb)方向に移動する。これにより、ナット38a(38b)に固定されたシャフト部39a(39b)も、矢印Ra(Rb)方向に移動する。また、回転軸36aが矢印Pb方向に回転すると、シャフト部39a(39b)は、矢印Qa(Qb)方向に移動する。すなわち、伸縮シャフト32a(32b)は、伸縮用モータ34aの回転方向に応じた方向に、伸縮用モータ34aの回転量に応じた量だけ伸縮する。そして、伸縮シャフト32a(32b)の伸縮に応じて、左右の支持体28の間隔、すなわち、図9に示した走行体30a、30bの間隔Wが変更される。
When the
なお、ベベルギア40に接続したねじ軸37aとねじ軸37bの回転方向は互いに異なる。そのため、回転軸36aが回転したときに、ナット38a(38b)が互いに異なる方向に移動するように、ねじ軸37aとねじ軸37bとは、互いに逆ねじになるようにねじ切り加工されている。
The rotation directions of the
(第3の実施形態)
次に、本発明を実施するための第3の実施形態について、図面を用いて具体的に説明する。図13は、本発明の第3の実施形態である履帯式走行体100cの概略構造を示す上面図である。なお、第1の実施形態および第2の実施形態と同じ構造を有する部位は、同一符号を用いて示し、その詳細説明は省略する。
(Third Embodiment)
Next, a third embodiment for carrying out the present invention will be specifically described with reference to the drawings. FIG. 13 is a top view showing a schematic structure of the track-
図13に示すように、履帯式走行体100cは、本体10の左右にそれぞれ2個ずつの走行体30c、30e(30d、30f)(走行ユニット)を備える。各走行体30c(30e、30d、30f)には、それぞれ2本の伸縮シャフト32e、32f(32i、32j、32g、32h、32k、32l)が、支持体28a(28b、28c、28d)を介して接続されている。
As shown in FIG. 13, the track-
伸縮シャフト32e、32f(32g、32h、32i、32j、32k、32l)は、それぞれ、伸縮用モータ34c、34d(34e、34f、34g、34h、34i、34j)と接続されている。伸縮シャフト32e、32fは、伸縮用モータ34c、34dの回転方向に応じた方向に、伸縮用モータ34c、34dの回転量に応じた量だけ伸縮する。伸縮シャフト32e、32fが伸び縮みする構造は、第2の実施形態で説明した通りである。なお、伸縮用モータ34c、34d(34e、34f、34g、34h、34i、34j)は、それぞれ、伸縮制御用モータドライバ82(図10)によって駆動制御される。
The
伸縮シャフト32eと伸縮シャフト32fと、は互いに連動して伸縮する。そして、図13に示すように、伸縮シャフト32eが縮んで、伸縮シャフト32fが伸びることによって、走行体30cは方向ωを右に変える。逆に、伸縮シャフト32eが伸びて、伸縮シャフト32fが縮むことによって、走行体30cは方向ωを左に変える。すなわち、伸縮制御用モータドライバ82(図10)は、同一の走行体30c(30d、30e、30f)に接続された2本の伸縮シャフト32e、32f(32g、32h、32i、32j、32k、32l)の長さを、互いに連携させて伸縮させることによって、走行体30c(30d、30e、30f)の進行方向を変更する。なお、各伸縮シャフト32e、32fの伸縮状態は、ラジコン送信機50から送信された履帯式走行体100cに対する動作指示に応じて、伸縮用モータ回転制御部88(図11)が決定して、伸縮制御用モータドライバ82が伸縮用モータ34c、34dに対して回転方向と回転量を指示することによって制御される。
The
なお、伸縮シャフト32e、32f(32g、32h、32i、32j、32k、32l)は、走行体30c(30d、30e、30f)の向きを変更させるだけでなく、第2の実施形態で説明したように、走行体30cと走行体30dとの間隔W(図9)、および走行体30eと走行体30fとの間隔Wを変更する機能も有している。
The
以上説明したように、本実施の形態に係る履帯式走行体100aは、履帯18a(18b)と、インホイールモータ13a(13b)を内蔵して、履帯18a(18b)に駆動力を与える起動輪12a(12b)と、少なくとも2つの転輪14a、14b(14c、14d)と、を備えて、上方に配置した起動輪12a(12b)と下方に配置した転輪14a、14b(14c、14d)との間に履帯18a(18b)を掛け回した、少なくとも2つの走行体30a(30b)(走行ユニット)と、走行体30a(30b)を、走行可能な状態で支持する本体10と、を有する。したがって、走行体30a(30b)に対するインホイールモータ13a(13b)の突出を無くすことによって、走行体30a(30b)の配置の自由度を向上させることができる。また、起動輪12a(12b)と、転輪14a(14c)と、転輪14b(14d)とで形成される三角形の上方、すなわち、起動輪12a(12b)の内部にインホイールモータ13a(13b)を配置することによって、水溜りの走行時でも泥水の浸入を阻止することができるため、特別な防水機構の設置が不要となる。
As described above, the crawler belt
また、本実施の形態に係る履帯式走行体100aは、転輪14a、14b(14c、14d)を支えるサスペンション20a(20b)(懸架部)と、履帯18a(18b)にかかるテンションを調整するテンショナー部22a(22b)と、を備える。したがって、不整地を走行したときの走行体の揺れが低減できるため、本体10の姿勢を安定させることができる。また、テンショナー部22a(22b)を備えることで、履帯18a(18b)に適正なテンションをかけておくことができるとともに、履帯18a(18b)の着脱が容易になる。
Further, in the track-
また、本実施の形態に係る履帯式走行体100aは、本体10の安定性を保持するバランス制御機構92(バランス機構)と、バランス制御機構92の傾きを制御する姿勢制御用モータ回転制御部84(バランス制御部)と、を備える。したがって、不整地を走行したときに履帯式走行体100aの安定性を向上させることができる。
Further, in the track-
そして、本実施の形態に係る履帯式走行体100aは、姿勢制御用モータ回転制御部84(バランス制御部)が、ステレオカメラ60が取得したステレオ画像に基づいて、履帯式走行体100aの予測経路の傾きを推定して、推定された予測経路の傾きに基づいて本体10の姿勢を制御するオープンループ制御を行う。したがって、本体10の現在の姿勢をフィードバックすることによって本体10の姿勢の制御を行う場合と比較して、急な段差の発生等によって、本体10の姿勢制御の遅れを招くことがない。すなわち、履帯式走行体100aが転倒するリスクをより一層低減することができる。
Then, in the footwear
また、本実施の形態に係る履帯式走行体100aは、姿勢制御用モータ回転制御部84(バランス制御部)が、機械学習によって予め生成された、本体10の姿勢(傾き)を推定する姿勢推定部66の推定結果に基づいて、本体10の姿勢制御を行う。したがって、例えば、ステレオカメラ60で取得した地面の凹凸の情報に基づいて、履帯式走行体100aの将来の姿勢を物理的に推定する場合と比較して、より一層外乱に対して安定な(ロバストな)姿勢制御を行うことができる。
Further, in the track-
さらに、本実施の形態に係る履帯式走行体100bは、走行体30a(30b)(走行ユニット)と本体10との距離を変更可能な伸縮シャフト32a、32b(32c、32d)(走行ユニット接続部)と、伸縮シャフト32a、32b(32c、32d)の伸縮を制御する伸縮用モータ回転制御部88(走行ユニット接続制御部)と、を備える。したがって、走行体30aと走行体30bとの間隔Wを変更することができるため、通常は間隔Wを広げることによって、履帯式走行体100bの安定性を向上させることができるとともに、間隔Wを狭くすることによって、狭い経路の走行も可能とすることができる。
Further, the track-
また、本実施の形態に係る履帯式走行体100cによれば、伸縮用モータ回転制御部88(走行ユニット接続制御部)は、伸縮シャフト32e、32f(32g、32h、32i、32j、32k、32l)(走行ユニット接続部)の伸縮を制御することによって、走行体30c(30d、30e、30f)(走行ユニット)の方向ωを変更する。したがって、履帯式走行体100cをより一層スムーズに転回させることができる。
Further, according to the track-
以上、実施の形態について説明したが、その各部の具体的な構成、処理の内容等は、実施の形態で説明したものに限るものではない。 Although the embodiment has been described above, the specific configuration of each part, the content of the process, and the like are not limited to those described in the embodiment.
10 本体
12a、12b 起動輪
13a、13b インホイールモータ
14a、14b、14c、14d 転輪
18a、18b 履帯
20a、20b サスペンション(懸架部)
22a、22b テンショナー部
30a、30b、30c、30d、30e、30f 走行体(走行ユニット)
32a、32b、32c、32d、32e、32f、32g、32h、32i、32j、32k、32l 伸縮シャフト(走行ユニット接続部)
66 姿勢推定部
84 姿勢制御用モータ回転制御部(バランス制御部)
88 伸縮用モータ回転制御部(走行ユニット接続制御部)
92 バランス制御機構(バランス機構)
100a、100b、100c 履帯式走行体
ω 方向
10
22a,
32a, 32b, 32c, 32d, 32e, 32f, 32g, 32h, 32i, 32j, 32k, 32l telescopic shaft (traveling unit connection)
66 Attitude estimation unit 84 Attitude control motor rotation control unit (balance control unit)
88 Telescopic motor rotation control unit (travel unit connection control unit)
92 Balance control mechanism (balance mechanism)
100a, 100b, 100c Track type running body ω direction
Claims (7)
インホイールモータを内蔵して、当該履帯に駆動力を与える起動輪と、
少なくとも2つの転輪と、
前記起動輪と前記転輪とを支持する支持体と、
上方に配置した前記起動輪と下方に配置した前記転輪との間に前記履帯を掛け回した、少なくとも2つの走行ユニットと、
前記支持体を介して、前記少なくとも2つの走行ユニットを、少なくとも前記起動輪の回転軸よりも下方において、走行可能な状態で支持する本体と、
前記支持体を前記本体に懸架する、前後方向に距離をとって設置された懸架部と、を有する
ことを特徴とする履帯式走行体。 Tracks and
A starting wheel with a built-in in-wheel motor that gives driving force to the track,
At least two wheels and
A support that supports the starting wheel and the rolling wheel,
At least two traveling units in which the tracks are hung between the starting wheels arranged above and the rolling wheels arranged below.
A main body that supports the at least two traveling units in a travelable state at least below the rotation axis of the starting wheel via the support.
A crawler-type traveling body having a suspension portion installed at a distance in the front-rear direction, which suspends the support body from the main body.
ことを特徴とする請求項1に記載の履帯式走行体。 The track-type traveling body according to claim 1, further comprising a tensioner portion for adjusting the tension applied to the track, which is installed in the main body.
前記バランス機構の傾きを制御するバランス制御部と、を備える
ことを特徴とする請求項1または請求項2に記載の履帯式走行体。 A balance mechanism that holds the main body horizontally,
The track-type traveling body according to claim 1 or 2, wherein the balance control unit for controlling the inclination of the balance mechanism is provided.
ことを特徴とする請求項3に記載の履帯式走行体。 The balance control unit performs open loop control.
The track-type traveling body according to claim 3.
ことを特徴とする請求項4に記載の履帯式走行体。 The balance control unit performs control based on the estimation result of the posture estimation unit that estimates the inclination of the main body, which is generated in advance by machine learning.
The track-type traveling body according to claim 4.
前記距離を制御する走行ユニット接続制御部と、を備える
ことを特徴とする請求項1から請求項5のいずれか1項に記載の履帯式走行体。 A traveling unit connection portion capable of changing the distance between the traveling unit and the main body,
The track-type traveling body according to any one of claims 1 to 5, further comprising a traveling unit connection control unit that controls the distance.
前記走行ユニット接続制御部は、前記方向を制御するものである、
ことを特徴とする請求項6に記載の履帯式走行体。 The traveling unit connecting portion can change the direction of the traveling unit with respect to the main body.
The traveling unit connection control unit controls the direction.
The track-type traveling body according to claim 6.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020148402A JP2020203680A (en) | 2020-09-03 | 2020-09-03 | Caterpillar band type travelling body |
JP2022043515A JP7338727B2 (en) | 2020-09-03 | 2022-03-18 | Track type running body |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020148402A JP2020203680A (en) | 2020-09-03 | 2020-09-03 | Caterpillar band type travelling body |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016115900A Division JP6759734B2 (en) | 2016-06-10 | 2016-06-10 | Tracked vehicle |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022043515A Division JP7338727B2 (en) | 2020-09-03 | 2022-03-18 | Track type running body |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2020203680A true JP2020203680A (en) | 2020-12-24 |
Family
ID=73837844
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020148402A Withdrawn JP2020203680A (en) | 2020-09-03 | 2020-09-03 | Caterpillar band type travelling body |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2020203680A (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58221779A (en) * | 1982-06-17 | 1983-12-23 | Toshiba Corp | Stabilizer of running vehicle |
JPH09240520A (en) * | 1996-03-08 | 1997-09-16 | Suzuki Motor Corp | Traveling vehicle |
JP2016068727A (en) * | 2014-09-29 | 2016-05-09 | ヤンマー株式会社 | Traveling vehicle |
JP2016115900A (en) * | 2014-12-18 | 2016-06-23 | 三菱電機株式会社 | Semiconductor module and semiconductor device |
-
2020
- 2020-09-03 JP JP2020148402A patent/JP2020203680A/en not_active Withdrawn
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58221779A (en) * | 1982-06-17 | 1983-12-23 | Toshiba Corp | Stabilizer of running vehicle |
JPH09240520A (en) * | 1996-03-08 | 1997-09-16 | Suzuki Motor Corp | Traveling vehicle |
JP2016068727A (en) * | 2014-09-29 | 2016-05-09 | ヤンマー株式会社 | Traveling vehicle |
JP2016115900A (en) * | 2014-12-18 | 2016-06-23 | 三菱電機株式会社 | Semiconductor module and semiconductor device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6759734B2 (en) | Tracked vehicle | |
EP1504855B1 (en) | System for estimating attitude of leg type moving robot itself | |
US8457830B2 (en) | In-line legged robot vehicle and method for operating | |
US8935050B2 (en) | Moving body control system, moving body control method, and non-transitory computer readable medium storing control program | |
CN100544898C (en) | The ambulation control method of legged mobile robot and legged mobile robot | |
KR100950953B1 (en) | Moving robot | |
CN113348129B (en) | Gyroscope-stabilized leg type robot | |
US20110040410A1 (en) | Apparatus and method controlling legged mobile robot | |
US20080167771A1 (en) | Methods, devices, and systems for high-speed autonomous vehicle and high-speed autonomous vehicle | |
US20100121538A1 (en) | Travel device | |
US11975787B2 (en) | Control device for mobile body | |
US20110172823A1 (en) | Robot and control method thereof | |
JP2009154256A (en) | Transfer device comprising leg with wheel | |
Liu et al. | Active balance control of humanoid locomotion based on foot position compensation | |
KR101190294B1 (en) | Vision stabilization apparatus for mobile robot | |
JP2020203680A (en) | Caterpillar band type travelling body | |
JP7338727B2 (en) | Track type running body | |
WO2016016960A1 (en) | Moving body | |
Ojeda et al. | The FLEXnav precision dead-reckoning system | |
JP5268107B2 (en) | Hybrid control device and method for multi-legged walking device | |
US9367066B2 (en) | Inverted pendulum type vehicle | |
Edrisi et al. | Modifying the attitude of quadruped robot body against disturbances via data fusion | |
Kumar et al. | Self-balancing vehicle using Kalman Filter | |
Harkins et al. | Design and Testing of an Autonomous Highly Mobile Robot in a Beach Environment | |
KR20190019374A (en) | Passive Revolving Joint and Rough Terrain Driving Mobile Robot thereof |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201002 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210824 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20211025 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220118 |
|
A761 | Written withdrawal of application |
Free format text: JAPANESE INTERMEDIATE CODE: A761 Effective date: 20220426 |