JP2009269590A - Caster device and wheel type robot - Google Patents
Caster device and wheel type robot Download PDFInfo
- Publication number
- JP2009269590A JP2009269590A JP2008170029A JP2008170029A JP2009269590A JP 2009269590 A JP2009269590 A JP 2009269590A JP 2008170029 A JP2008170029 A JP 2008170029A JP 2008170029 A JP2008170029 A JP 2008170029A JP 2009269590 A JP2009269590 A JP 2009269590A
- Authority
- JP
- Japan
- Prior art keywords
- caster
- floor reaction
- reaction force
- wheel
- pressure
- 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
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、キャスタを備えるキャスタ装置およびこれを適用した車輪型ロボットに係り、特に、小型化および軽量化を図るのに好適なキャスタ装置および車輪型ロボットに関する。 The present invention relates to a caster device including casters and a wheeled robot to which the caster device is applied, and more particularly to a caster device and a wheeled robot suitable for reducing size and weight.
従来、車輪型ロボットとしては、特許文献1記載の移動ロボットが知られている。
特許文献1記載の移動ロボットは、本体フレームと、走路方向前方に設けられている従動輪と、走路方向の距離をある俯角で検出する距離センサ部と、俯角をほぼ一定に維持したまま従動輪および距離センサを一体的に本体フレーム上で上下動させる上下動機構とを有して構成されている。上下動機構は、一端が回転可能に本体フレームに支持されたリンクアームと、リンクアームの他端を回転可能に支持し従動輪を連結するブラケットと、リンクアームの他端に設けられた支持回転軸を回転させるモータとを有して構成されている(同文献〔0016〕、〔0017〕、図1、2)。
Conventionally, a mobile robot described in
The mobile robot described in
また、床反力を検出する移動ロボットとしては、特許文献2記載の移動ロボットが知られている。
特許文献2記載の移動ロボットは、上体と、上体に第1関節を介して連結される複数本の脚部と、脚部の先端に第2関節を介して連結される足部と、第2関節と足部の接地端の間に配置された弾性体の内部および弾性体の付近の少なくともいずれかに設けられ、第2関節に対する足部の接地端の変位を示す出力を生じる変位センサと、変位センサの出力に基づいて足部に作用する床反力を算出する床反力算出部とを有して構成されている。
The mobile robot described in Patent Document 2 includes an upper body, a plurality of legs connected to the upper body via a first joint, a foot connected to the tip of the leg via a second joint, A displacement sensor provided in at least one of the inside of the elastic body disposed between the second joint and the ground contact end of the foot and in the vicinity of the elastic body and generating an output indicating the displacement of the ground contact end of the foot with respect to the second joint And a floor reaction force calculator that calculates a floor reaction force acting on the foot based on the output of the displacement sensor.
しかしながら、特許文献1記載の移動ロボットにあっては、上下動機構がリンク機構として構成されているため、上下動の範囲を大きくするにはリンクアームを長くする必要があり、かつ、リンクアームの長さに応じてモータの必要トルクが大きくなり、大型のモータおよび減速機が必要となる。したがって、全体として大型化するとともに重量が増加するという問題があった。
However, in the mobile robot described in
また、特許文献2記載の移動ロボットにあっては、脚型ロボット用の検出機構であり、車輪型ロボットには適用が困難であるという問題があった。
そこで、本発明は、このような従来の技術の有する未解決の課題に着目してなされたものであって、小型化および軽量化を図るのに好適なキャスタ装置および車輪型ロボットを提供することを目的としている。
Further, the mobile robot described in Patent Document 2 is a detection mechanism for legged robots, and there is a problem that it is difficult to apply to wheeled robots.
Therefore, the present invention has been made paying attention to such an unsolved problem of the conventional technology, and provides a caster device and a wheel-type robot suitable for reducing the size and weight. It is an object.
〔発明1〕 上記目的を達成するために、発明1のキャスタ装置は、車輪と、前記車輪を回転可能に支持する車輪支持部と、前記車輪の回転軸と直交する方向を軸方向として前記車輪支持部に取り付けられたキャスタ支持軸とを有するキャスタを備えるキャスタ装置であって、直動軸を有するリニアアクチュエータを備え、前記キャスタ支持軸および前記直動軸が軸方向に連結されている。
[Invention 1] In order to achieve the above object, a caster device according to
このような構成であれば、キャスタおよびリニアアクチュエータを軸方向に連結した構成を採用しているので、上下動の範囲を大きくする場合でも、必要トルクがさほど大きくならず、リニアアクチュエータが極端に大型化することがない。また、減速機も必要ない。
そして、リニアアクチュエータを駆動すると、キャスタは、リニアアクチュエータにより上下動する。
具体的な用途としては、例えば、リニアアクチュエータをロボットの基体に取り付けることによりロボットの車輪として適用することができる。
With such a configuration, a configuration in which casters and linear actuators are connected in the axial direction is adopted, so even when the range of vertical movement is increased, the required torque does not increase so much, and the linear actuator is extremely large. It will not become. Also, no reduction gear is required.
When the linear actuator is driven, the caster moves up and down by the linear actuator.
As a specific use, for example, it can be applied as a robot wheel by attaching a linear actuator to a robot base.
〔発明2〕 さらに、発明2のキャスタ装置は、発明1のキャスタ装置において、さらに、前記キャスタが受けた床反力を検出する床反力検出手段を備え、前記キャスタ支持軸および前記直動軸が前記床反力検出手段を介して軸方向に連結されている。
このような構成であれば、キャスタが床反力を受けると、キャスタ支持軸と直動軸の間に床反力検出手段が介在しているので、床反力検出手段により床反力が検出される。そして、例えば、検出された床反力に応じてリニアアクチュエータを制御することにより、キャスタは、リニアアクチュエータにより上下動する。
[Invention 2] The caster device according to Invention 2 is the caster device according to
With such a configuration, when the caster receives a floor reaction force, the floor reaction force detection means is interposed between the caster support shaft and the linear motion shaft, so the floor reaction force detection means detects the floor reaction force. Is done. Then, for example, by controlling the linear actuator according to the detected floor reaction force, the caster moves up and down by the linear actuator.
〔発明3〕 さらに、発明3のキャスタ装置は、発明2のキャスタ装置において、前記床反力検出手段は、複数の貫通穴が形成され、その上面に前記直動軸が連結された上板と、その下面に前記キャスタ支持軸が連結された下板と、前記上板と前記下板の間に配置された感圧センサと、前記貫通穴に挿通され、前記下板にその先端がそれぞれ固定された複数のボルトと、前記ボルトの軸部を挿通し、前記ボルトの頭部と前記上板の間に介挿された複数のコイルばねとを有する。 [Invention 3] The caster device according to Invention 3 is the caster device according to Invention 2, wherein the floor reaction force detecting means includes an upper plate in which a plurality of through holes are formed and the linear motion shaft is connected to the upper surface thereof. The lower plate with the caster support shaft connected to the lower surface thereof, the pressure-sensitive sensor disposed between the upper plate and the lower plate, and the through-holes are inserted into the lower plate with their tips fixed respectively. A plurality of bolts and a plurality of coil springs inserted through the bolt heads and between the bolt heads and the upper plate.
このような構成であれば、キャスタが接地していない場合は、キャスタおよび下板の自重により各ボルトが押し下げられ、ボルトの頭部と上板の間でコイルばねが付勢されて収縮する。そのため、コイルばねの付勢力により上板と下板の間に間隔が生じにくく、接地時に感圧センサに強い衝撃が加わるのを防止することができる。また、予圧を必要とする感圧センサを用いる場合、コイルばねを強くすることで対応することができる。 With such a configuration, when the caster is not grounded, each bolt is pushed down by the weight of the caster and the lower plate, and the coil spring is urged and contracted between the head of the bolt and the upper plate. Therefore, the space between the upper plate and the lower plate is hardly generated by the urging force of the coil spring, and it is possible to prevent a strong shock from being applied to the pressure sensor at the time of grounding. Moreover, when using the pressure-sensitive sensor which requires preload, it can respond by strengthening a coil spring.
〔発明4〕 さらに、発明4のキャスタ装置は、発明3のキャスタ装置において、前記キャスタ支持軸は、前記車輪支持部または前記下板に回転可能に取り付けられ、前記床反力検出手段は、前記貫通穴に嵌挿され、前記ボルトをそれぞれ嵌挿する複数のリニアブッシュを有する。
このような構成であれば、リニアブッシュによりボルトが支持されるので、キャスタ支持軸が床面に対して垂直な状態に保持される。そのため、床面に接地したキャスタがキャスタ支持軸を軸回りに回転しやすい。
[Invention 4] The caster device according to
With such a configuration, since the bolt is supported by the linear bush, the caster support shaft is held in a state perpendicular to the floor surface. Therefore, the caster that is grounded on the floor surface easily rotates around the caster support shaft.
〔発明5〕 さらに、発明5のキャスタ装置は、発明1ないし4のいずれか1のキャスタ装置において、さらに、ニードルガイドを備え、前記キャスタ支持軸および前記直動軸が前記ニードルガイドを介して連結されている。
このような構成であれば、ニードルガイドにより、リニアアクチュエータの軸方向に直交する曲げモーメントを受けることができるので、曲げモーメントに対する強度が向上する。
[Invention 5] The caster device according to Invention 5 is the caster device according to any one of
With such a configuration, the needle guide can receive a bending moment orthogonal to the axial direction of the linear actuator, so that the strength against the bending moment is improved.
〔発明6〕 一方、上記目的を達成するために、発明6の車輪型ロボットは、発明1ないし5のいずれか1項に記載のキャスタ装置を備える。
〔発明7〕 一方、上記目的を達成するために、発明7のキャスタ装置は、発明2のキャスタ装置において、前記床反力検出手段は、所定の位相をもって配置された複数の感圧センサを有する。
このような構成であれば、キャスタ装置の傾斜角が得られれば、キャスタ装置が傾斜している場合の床反力を比較的正確に算出することができる。
[Invention 6] On the other hand, in order to achieve the above object, a wheel-type robot according to Invention 6 includes the caster device according to any one of
[Invention 7] On the other hand, in order to achieve the above object, the caster device according to Invention 7 is the caster device according to Invention 2, wherein the floor reaction force detection means has a plurality of pressure sensitive sensors arranged with a predetermined phase. .
With such a configuration, if the tilt angle of the caster device is obtained, the floor reaction force when the caster device is tilted can be calculated relatively accurately.
〔発明8〕 さらに、発明8のキャスタ装置は、発明7のキャスタ装置において、前記床反力検出手段は、少なくとも2つの前記感圧センサを有し、第1の前記感圧センサを第1平面に配置し、第2の前記感圧センサを、前記第1平面に対して所定角度をなす第2平面に配置した。 [Invention 8] Further, the caster apparatus according to Invention 8 is the caster apparatus according to Invention 7, wherein the floor reaction force detecting means has at least two pressure-sensitive sensors, and the first pressure-sensitive sensor is arranged on the first plane. The second pressure-sensitive sensor is arranged on a second plane that forms a predetermined angle with respect to the first plane.
〔発明9〕 さらに、発明9のキャスタ装置は、発明7のキャスタ装置において、前記床反力検出手段は、少なくとも4つの前記感圧センサを有し、第1の前記感圧センサを第1平面に配置し、第2の前記感圧センサを、前記第1平面に対して所定角度をなす第2平面に配置し、第3の前記感圧センサを、前記第1平面および前記第2平面に対して所定角度をなす第3平面に配置し、第4の前記感圧センサを、前記第1平面ないし前記第3平面に対して所定角度をなす第4平面に配置した。
このような構成であれば、キャスタ装置が傾斜している場合の床反力をさらに正確に算出することができる。
[Invention 9] The caster device according to Invention 9 is the caster device according to Invention 7, wherein the floor reaction force detecting means includes at least four pressure-sensitive sensors, and the first pressure-sensitive sensor is arranged on the first plane. The second pressure-sensitive sensor is disposed on a second plane that forms a predetermined angle with respect to the first plane, and the third pressure-sensitive sensor is disposed on the first plane and the second plane. The fourth pressure sensor is disposed on a fourth plane that forms a predetermined angle with respect to the first plane or the third plane.
With such a configuration, the floor reaction force when the caster device is tilted can be calculated more accurately.
〔発明10〕 一方、上記目的を達成するために、発明10の車輪型ロボットは、発明7ないし9のいずれか1項に記載のキャスタ装置を備える。
[Invention 10] On the other hand, in order to achieve the above object, a wheel type robot according to
以上説明したように、発明1のキャスタ装置によれば、キャスタおよびリニアアクチュエータを軸方向に連結した構成を採用しているので、従来に比して、大型化および重量の増加を抑制することができるという効果が得られる。
さらに、発明2のキャスタ装置によれば、キャスタ支持軸と直動軸の間に床反力検出手段が介在しているので、キャスタが受けた床反力を容易に検出することができるという効果が得られる。
As described above, according to the caster device of the first aspect, since the configuration in which the caster and the linear actuator are coupled in the axial direction is adopted, it is possible to suppress an increase in size and an increase in weight as compared with the conventional case. The effect that it can be obtained.
Further, according to the caster device of the second aspect, since the floor reaction force detecting means is interposed between the caster support shaft and the linear motion shaft, the floor reaction force received by the caster can be easily detected. Is obtained.
さらに、発明3のキャスタ装置によれば、キャスタが接地していない場合、コイルばねの付勢力により上板と下板の間に間隔が生じにくく、接地時に感圧センサに強い衝撃が加わるのを防止することができるという効果が得られる。また、予圧を必要とする感圧センサを用いる場合、コイルばねを強くすることで対応することができる。
さらに、発明4のキャスタ装置によれば、キャスタ支持軸が床面に対して垂直な状態に保持されるので、床面に接地したキャスタがキャスタ支持軸を軸回りに回転しやすくなるという効果が得られる。
Furthermore, according to the caster device of the third aspect, when the caster is not grounded, the biasing force of the coil spring hardly causes a gap between the upper plate and the lower plate, thereby preventing a strong shock from being applied to the pressure sensor at the time of grounding. The effect that it can be obtained. Moreover, when using the pressure-sensitive sensor which requires preload, it can respond by strengthening a coil spring.
Furthermore, according to the caster device of the
さらに、発明5のキャスタ装置によれば、ニードルガイドにより、リニアアクチュエータの軸方向に直交する曲げモーメントを受けることができるので、曲げモーメントに対する強度を向上することができるという効果が得られる。
さらに、発明7のキャスタ装置によれば、キャスタ装置の傾斜角が得られれば、キャスタ装置が傾斜している場合の床反力を比較的正確に算出することができるという効果が得られる。
Furthermore, according to the caster device of the fifth aspect of the invention, the needle guide can receive a bending moment orthogonal to the axial direction of the linear actuator, so that the effect of improving the strength against the bending moment can be obtained.
Furthermore, according to the caster device of the invention 7, if the tilt angle of the caster device is obtained, the floor reaction force when the caster device is tilted can be calculated relatively accurately.
さらに、発明9のキャスタ装置によれば、キャスタ装置が傾斜している場合の床反力をさらに正確に算出することができるという効果が得られる。 Furthermore, according to the caster device of the ninth aspect, it is possible to obtain an effect that the floor reaction force when the caster device is inclined can be calculated more accurately.
〔第1の実施の形態〕
以下、本発明の第1の実施の形態を図面を参照しながら説明する。図1ないし図7は、本発明に係るキャスタ装置および車輪型ロボットの第1の実施の形態を示す図である。
まず、本発明を適用する車輪型ロボット100の構成を説明する。
図1は、車輪型ロボット100の正面図である。
[First Embodiment]
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. FIG. 1 to FIG. 7 are diagrams showing a first embodiment of a caster device and a wheel type robot according to the present invention.
First, the configuration of the
FIG. 1 is a front view of the
図2は、車輪型ロボット100の側面図である。
車輪型ロボット100は、図1および図2に示すように、基体10と、基体10の両側面にそれぞれ回転可能に設けられた1対の駆動輪20と、基体10の前部および後部にそれぞれ設けられた2つのキャスタ装置30と、基体10の後上部に設けられたハンドル40とを有して構成されている。
FIG. 2 is a side view of the
As shown in FIGS. 1 and 2, the
次に、キャスタ装置30の構成を説明する。
図3は、キャスタ装置30の正面図である。
キャスタ装置30は、図3に示すように、キャスタ31と、キャスタ31を上下動させるリニアアクチュエータ32と、キャスタ31が受けた床反力を検出する床反力検出部33とを有して構成されている。
Next, the configuration of the
FIG. 3 is a front view of the
As shown in FIG. 3, the
リニアアクチュエータ32は、直線運動する直動軸32aを有し、フレーム34により支持されている。
フレーム34は、金属板を断面逆U字状に形成してなり、U字の開口端部の両側から水平方向にそれぞれ伸長するフランジ34aを有する。フランジ34aは、基体10の内底面に取り付けられている。フレーム34の上面には、貫通穴(不図示)が形成されている。リニアアクチュエータ32は、出力軸面32bを下向きにし、フレーム34の貫通穴に直動軸32aを挿通させてフレーム34の上方に設置されている。出力軸面32bは、ボルト34bによりフレーム34の上面に固定されている。
The
The
床反力検出部33は、基体10の下方に設置され、高剛性ニードルガイド35を介してリニアアクチュエータ32に連結されている。リニアアクチュエータ32は、推力は強いが軸方向に直交する曲げモーメントに弱いという性質がある。そこで、高剛性ニードルガイド35で曲げモーメントを受ける構成を採用することにより、曲げモーメントに対する強度を向上することができる。
The floor reaction
基体10の底面のうちフレーム34の開口部の真下には、貫通穴10aが形成されている。高剛性ニードルガイド35は、シャフト35aを有し、シャフト35aを貫通穴10aに挿通させてフレーム34に固定されている。シャフト35aの上端は、直動軸32aに連結され、シャフト35aの下端は、床反力検出部33の上部に連結されている。
一方、キャスタ31は、従動輪31aと、従動輪31aを回転可能に支持し収容する車輪支持枠31bと、車輪支持枠31bの上部に取り付けられたキャスタ支持軸31cとを有して構成されている。
A through
On the other hand, the
キャスタ支持軸31cは、従動輪31aの回転軸と直交する方向に回転可能に車輪支持枠31bに取り付けられている。キャスタ支持軸31cの上端は、床反力検出部33の下部に連結されている。
The
次に、床反力検出部33の構成を説明する。
図4は、床反力検出部33の軸方向の断面図である。
床反力検出部33は、図4に示すように、上板33aと、下板33bと、上板33aと下板33bの間に配置された感圧センサ33cとを有して構成されている。
上板33aの四隅には、貫通穴33dがそれぞれ形成されている。(図4では、このうち2つの貫通穴33dを示している。以下、ボルト穴33e等の実個数と図4の表示個数の関係についても同様である。)上板33aの上面には、シャフト35aの下端が連結されている。
Next, the configuration of the floor reaction
FIG. 4 is a sectional view of the floor
As shown in FIG. 4, the floor reaction
Through
下板33bには、各貫通穴33dに対向する位置に4つのボルト穴33eが形成されている。下板33bの下面には、キャスタ支持軸31cの上端が連結されている。
感圧センサ33cは、印加される圧力に応じた電圧のセンサ信号を出力する。例えば、印加される圧力の変化に伴って電気抵抗値が変化する特性を有する感圧センサを採用することができる。
In the
The pressure-
床反力検出部33は、さらに、貫通穴33dにそれぞれ嵌挿された4つのリニアブッシュ33fと、リニアブッシュ33fに嵌挿され、ボルト穴33eにその先端がそれぞれ螺合した4つのストリッパボルト33gと、ストリッパボルト33gの軸部を挿通し、ストリッパボルト33gの頭部とリニアブッシュ33fの間に介挿された4つのコイルばね33hとを有して構成されている。
The floor reaction
これにより、キャスタ31が接地していない場合は、キャスタ31および下板33bの自重により各ストリッパボルト33gが押し下げられ、ストリッパボルト33gの頭部とリニアブッシュ33fの間でコイルばね33hが付勢されて収縮する。そのため、コイルばね33hの付勢力により上板33aと下板33bの間に間隔が生じにくく、接地時に感圧センサ33cに強い衝撃が加わるのを防止することができる。また、感圧センサ33cとして予圧を必要とする感圧センサを用いる場合、コイルばね33hを強くすることで対応することができる。
Thus, when the
また、リニアブッシュ33fによりストリッパボルト33gが支持されるので、キャスタ支持軸31cが床面に対して垂直な状態に保持される。そのため、床面に接地したキャスタ31がキャスタ支持軸31cを軸回り(ヨー軸回り)に回転しやすい。
Further, since the
次に、車輪型ロボット100の移動制御システムを説明する。
図5は、車輪型ロボット100の移動制御システムを示すブロック図である。
各リニアアクチュエータ32には、図5に示すように、リニアアクチュエータ32の直動位置を検出するエンコーダ42と、アクチュエータ指令信号およびエンコーダ42の直動位置検出信号に基づいてリニアアクチュエータ32の駆動を制御するドライバ44が設けられている。
Next, the movement control system of the
FIG. 5 is a block diagram showing a movement control system of the
As shown in FIG. 5, each
各駆動輪20には、駆動輪20を回転駆動する車輪モータ50がそれぞれ設けられている。各車輪モータ50には、車輪モータ50の回転角度位置を検出するエンコーダ52と、モータ指令信号およびエンコーダ52の角度位置検出信号に基づいて車輪モータ50の駆動を制御するドライバ54が設けられている。
Each
車輪型ロボット100は、さらに、CPU60と、外部のPC等と無線通信を行う無線通信部74と、無線通信部74とCPU60の入出力を中継するハブ76と、警告音等を出力するスピーカ78とを有して構成されている。
CPU60は、指令信号出力I/F61を介してドライバ44、54に指令信号を出力し、位置検出信号入力I/F62を介してエンコーダ42、52の位置検出信号を入力する。また、センサ信号入力I/F63を介して各感圧センサ33cからセンサ信号を入力する。また、通信I/F64を介してハブ76と信号の入出力を行い、サウンド出力I/F65を介してスピーカ78に音声信号を出力する。
The wheel-
The
次に、CPU60で実行される処理を説明する。
CPU60は、ROM等の所定領域に格納されている制御プログラムを起動させ、その制御プログラムに従って、図6のフローチャートに示すキャスタ装置制御処理を実行する。
図6は、キャスタ装置制御処理を示すフローチャートである。
キャスタ装置制御処理は、キャスタ装置30を上下動させる制御を行う処理であって、CPU60において実行されると、まず、図6に示すように、ステップS100に移行する。
ステップS100では、前部のキャスタ装置30の感圧センサ33cからセンサ信号を入力し、ステップS102に移行して、入力したセンサ信号に基づいて、前部のキャスタ装置30のキャスタ31が受けた床反力FFを算出し、ステップS104に移行する。
Next, processing executed by the
The
FIG. 6 is a flowchart showing caster device control processing.
The caster device control process is a process for controlling the
In step S100, a sensor signal is input from the pressure-
ステップS104では、後部のキャスタ装置30の感圧センサ33cからセンサ信号を入力し、ステップS106に移行して、入力したセンサ信号に基づいて、後部のキャスタ装置30のキャスタ31が受けた床反力FBを算出し、ステップS108に移行する。
ステップS108では、算出した床反力FF、FBがいずれも標準床反力FNよりも大きいか否かを判定し、標準床反力FNよりも大きいと判定したとき(Yes)は、ステップS110に移行する。ここで、標準床反力FNとは、キャスタ31が受ける標準的な床反力をいい、例えば、両方のキャスタ装置30を標準の長さに設定し、車輪型ロボット100を平面に接地させたときにキャスタ31が受ける床反力として設定することができる。
In step S104, a sensor signal is input from the
In step S108, it is determined whether or not the calculated floor reaction forces FF and FB are both greater than the standard floor reaction force FN. If it is determined that the calculated floor reaction forces FF and FB are greater than the standard floor reaction force FN (Yes), the process proceeds to step S110. Transition. Here, the standard floor reaction force FN means a standard floor reaction force that the
ステップS110では、両方のキャスタ31に荷重がかかり過ぎていると判定し、床反力FF、FBと標準床反力FNの差が小さくなるように、両方のキャスタ装置30のキャスタ31を短縮(上移動)させるため、ドライバ44へのアクチュエータ指令信号を生成し、生成したアクチュエータ指令信号をドライバ44に出力し、一連の処理を終了して元の処理に復帰させる。
In step S110, it is determined that both
一方、ステップS108で、床反力FF、FBのいずれかが標準床反力FN以下であると判定したとき(No)は、ステップS112に移行して、床反力FF、FBがいずれも標準床反力FNよりも小さいか否かを判定し、標準床反力FNよりも小さいと判定したとき(Yes)は、ステップS114に移行する。
ステップS114では、両方のキャスタ31が浮いていると判定し、床反力FF、FBと標準床反力FNの差が小さくなるように、両方のキャスタ装置30のキャスタ31を伸長(下移動)させるため、ドライバ44へのアクチュエータ指令信号を生成し、生成したアクチュエータ指令信号をドライバ44に出力し、一連の処理を終了して元の処理に復帰させる。
On the other hand, when it is determined in step S108 that any one of the floor reaction forces FF and FB is equal to or less than the standard floor reaction force FN (No), the process proceeds to step S112, and both the floor reaction forces FF and FB are standard. It is determined whether or not it is smaller than the floor reaction force FN, and when it is determined that it is smaller than the standard floor reaction force FN (Yes), the process proceeds to step S114.
In step S114, it is determined that both
一方、ステップS112で、床反力FF、FBのいずれかが標準床反力FN以上であると判定したとき(No)は、ステップS116に移行して、床反力FFが床反力FBよりも大きいか否かを判定し、床反力FBよりも大きいと判定したとき(Yes)は、ステップS118に移行する。
ステップS118では、車輪型ロボット100が前傾姿勢または下り坂を走行中であると判定し、床反力FFと床反力FBの差が小さくなるように、前部のキャスタ装置30のキャスタ31を伸長させるため、ドライバ44へのアクチュエータ指令信号を生成し、生成したアクチュエータ指令信号をドライバ44に出力し、一連の処理を終了して元の処理に復帰させる。
On the other hand, when it is determined in step S112 that one of the floor reaction forces FF and FB is greater than or equal to the standard floor reaction force FN (No), the process proceeds to step S116, where the floor reaction force FF is greater than the floor reaction force FB. Is greater than the floor reaction force FB (Yes), the process proceeds to step S118.
In step S118, it is determined that the
一方、ステップS116で、床反力FFが床反力FB以下であると判定したとき(No)は、ステップS120に移行して、床反力FBが床反力FFよりも大きいか否かを判定し、床反力FFよりも大きいと判定したとき(Yes)は、ステップS122に移行する。
ステップS122では、車輪型ロボット100が後傾姿勢または上り坂を走行中であると判定し、床反力FFと床反力FBの差が小さくなるように、後部のキャスタ装置30のキャスタ31を伸長させるため、ドライバ44へのアクチュエータ指令信号を生成し、生成したアクチュエータ指令信号をドライバ44に出力し、一連の処理を終了して元の処理に復帰させる。
一方、ステップS120で、床反力FBが床反力FF以下であると判定したとき(No)は、一連の処理を終了して元の処理に復帰させる。
On the other hand, when it is determined in step S116 that the floor reaction force FF is equal to or less than the floor reaction force FB (No), the process proceeds to step S120, and whether or not the floor reaction force FB is greater than the floor reaction force FF. If it is determined that it is greater than the floor reaction force FF (Yes), the process proceeds to step S122.
In step S122, it is determined that the wheel-
On the other hand, when it is determined in step S120 that the floor reaction force FB is equal to or less than the floor reaction force FF (No), the series of processes is terminated and the original process is restored.
次に、本実施の形態の動作を説明する。
車輪型ロボット100は、車輪モータ50が駆動されると、車輪モータ50の動力が駆動輪20に伝達され、駆動輪20の駆動により走行することができる。前部および後部のキャスタ装置30は、従動輪31aであるので、車輪型ロボット100の走行に伴って回転する。このとき、接地したキャスタ31のキャスタ支持軸31cと直動軸32aの間に床反力検出部33が介在しているので、感圧センサ33cにより、キャスタ31が受けた床反力が検出される。そして、ステップS100〜S106を経て、感圧センサ33cからのセンサ信号に基づいて床反力FF、FBが算出される。
Next, the operation of the present embodiment will be described.
When the
両方のキャスタ31に荷重がかかり過ぎている場合は、床反力FF、FBがいずれも標準床反力FNよりも大きくなるので、ステップS108、S110を経て、アクチュエータ指令信号に基づいてドライバ44がリニアアクチュエータ32を駆動し、両方のキャスタ装置30のキャスタ31が短縮する。
両方のキャスタ31が浮いている場合は、床反力FF、FBがいずれも標準床反力FNよりも小さくなるので、ステップS112、S114を経て、アクチュエータ指令信号に基づいてドライバ44がリニアアクチュエータ32を駆動し、両方のキャスタ装置30のキャスタ31が伸長する。
When both the
When both
車輪型ロボット100が前傾姿勢または下り坂を走行中である場合は、床反力FFが床反力FBよりも大きくなるので、ステップS116、S118を経て、アクチュエータ指令信号に基づいてドライバ44がリニアアクチュエータ32を駆動し、前部のキャスタ装置30のキャスタ31が伸長する。
図7は、車輪型ロボット100が上り坂を走行中である場合を示す図である。
When the
FIG. 7 is a diagram illustrating a case where the
車輪型ロボット100が上り坂を走行中である場合は、図7(a)に示すように、床反力FBが床反力FFよりも大きくなるので、ステップS120、S122を経て、図7(b)に示すように、アクチュエータ指令信号に基づいてドライバ44がリニアアクチュエータ32を駆動し、後部のキャスタ装置30のキャスタ31が伸長する。
この制御は、車輪型ロボット100が後傾姿勢である場合も同様に行われる。
When the
This control is performed in the same manner when the
なお、床反力FF、FBがいずれも標準床反力FNに等しいときは、キャスタ31にかかる荷重が適切な状態であるので、キャスタ装置30を上下動させる制御は行われない。
このようにして、本実施の形態では、キャスタ装置30は、従動輪31aの回転軸と直交する方向に回転可能に車輪支持枠31bに取り付けられたキャスタ支持軸31cを有するキャスタ31と、直動軸32aを有するリニアアクチュエータ32とを備え、キャスタ支持軸31cおよび直動軸32aが軸方向に連結されている。
When the floor reaction forces FF and FB are both equal to the standard floor reaction force FN, the load applied to the
In this way, in the present embodiment, the
これにより、キャスタ31およびリニアアクチュエータ32を軸方向に連結した構成を採用しているので、上下動の範囲を大きくする場合でも、必要トルクがさほど大きくならず、リニアアクチュエータ32が極端に大型化することがない。また、減速機も必要ない。したがって、従来に比して、大型化および重量の増加を抑制することができる。
さらに、本実施の形態では、キャスタ装置30は、キャスタ31が受けた床反力を検出する床反力検出部33を備え、キャスタ支持軸31cおよび直動軸32aが床反力検出部33を介して軸方向に連結されている。
Thereby, since the structure which connected the
Further, in the present embodiment, the
これにより、キャスタ支持軸31cと直動軸32aの間に床反力検出部33が介在しているので、キャスタ31が受けた床反力を容易に検出することができる。
さらに、本実施の形態では、床反力検出部33は、複数の貫通穴33dが形成され、その上面に直動軸32aが連結された上板33aと、その下面にキャスタ支持軸31cが連結された下板33bと、上板33aと下板33bの間に配置された感圧センサ33cと、貫通穴33dに挿通され、下板33bにその先端がそれぞれ固定された複数のストリッパボルト33gと、ストリッパボルト33gの軸部を挿通し、ストリッパボルト33gの頭部と上板33aの間に介挿された複数のコイルばね33hとを有する。
Thereby, since the floor
Further, in the present embodiment, the floor
これにより、キャスタ31が接地していない場合、コイルばね33hの付勢力により上板33aと下板33bの間に間隔が生じにくく、接地時に感圧センサ33cに強い衝撃が加わるのを防止することができる。また、感圧センサ33cとして予圧を必要とする感圧センサを用いる場合、コイルばね33hを強くすることで対応することができる。
さらに、本実施の形態では、床反力検出部33は、貫通穴33dに嵌挿され、ストリッパボルト33gをそれぞれ嵌挿する複数のリニアブッシュ33fを有する。
Accordingly, when the
Further, in the present embodiment, the floor reaction
これにより、キャスタ支持軸31cが床面に対して垂直な状態に保持されるので、床面に接地したキャスタ31がキャスタ支持軸31cを軸回りに回転しやすくなる。
さらに、本実施の形態では、キャスタ支持軸31cおよび直動軸32aは、高剛性ニードルガイド35を介して連結されている。
これにより、高剛性ニードルガイド35により、軸方向に直交する曲げモーメントを受けることができるので、曲げモーメントに対する強度を向上することができる。
Thereby, since the
Further, in the present embodiment, the
Thereby, since the bending moment orthogonal to an axial direction can be received by the highly
さらに、本実施の形態では、車輪型ロボット100は、基体10の上下方向にキャスタ31を伸縮駆動するキャスタ装置30と、キャスタ31が受けた床反力を検出する床反力検出部33とを備え、床反力検出部33の検出結果に基づいてキャスタ装置30の駆動を制御する。
これにより、床反力検出部33の検出結果に基づいてキャスタ装置30の駆動が制御されるので、距離センサでは検出しにくい段差や床全体の傾きに対応することができる。したがって、段差や傾斜のある環境であってもスムースに移動することができるので、段差に対して高い適応性を実現することができる。
Furthermore, in the present embodiment, the
Thereby, since the drive of the
さらに、本実施の形態では、車輪型ロボット100は、感圧センサ33cからセンサ信号を入力し、入力したセンサ信号に基づいて、前部および後部のキャスタ31が受けた床反力FF、FBを算出し、算出した床反力FF、FBに基づいてリニアアクチュエータ32を制御する。
これにより、複数の床反力検出部33の検出結果に基づいて各キャスタ装置30の駆動が制御されるので、距離センサでは検出しにくい段差や床全体の傾きにさらに好適に対応することができる。したがって、段差に対してさらに高い適応性を実現することができる。
Furthermore, in the present embodiment, the
Thereby, since the drive of each
さらに、本実施の形態では、車輪型ロボット100は、床反力FF、FBがいずれも標準床反力FNよりも大きいと判定したときは、両方のキャスタ装置30のキャスタ31が短縮するようにリニアアクチュエータ32を制御する。
これにより、両方のキャスタ31に荷重がかかり過ぎているような場合に、車輪型ロボット100を安定な姿勢に保つことができる。
Furthermore, in the present embodiment, when the
Thereby, the
さらに、本実施の形態では、車輪型ロボット100は、床反力FF、FBがいずれも標準床反力FNよりも小さいと判定したときは、両方のキャスタ装置30のキャスタ31が伸長するようにリニアアクチュエータ32を制御する。
これにより、両方のキャスタ31が浮いているような場合に、車輪型ロボット100を安定な姿勢に保つことができる。
Further, in the present embodiment, when the
Thereby, when both
さらに、本実施の形態では、車輪型ロボット100は、床反力FFが床反力FBよりも大きいと判定したときは、前部のキャスタ装置30のキャスタ31が伸長するようにリニアアクチュエータ32を制御する。
これにより、車輪型ロボット100が前傾姿勢または下り坂を走行中であるような場合に、車輪型ロボット100を安定な姿勢に保つことができる。
Furthermore, in this embodiment, when the
Thereby, when the
さらに、本実施の形態では、車輪型ロボット100は、床反力FBが床反力FFよりも大きいと判定したときは、後部のキャスタ装置30のキャスタ31が伸長するようにリニアアクチュエータ32を制御する。
これにより、車輪型ロボット100が後傾姿勢または上り坂を走行中であるような場合に、車輪型ロボット100を安定な姿勢に保つことができる。
上記第1の実施の形態において、車輪支持枠31bは、発明1または4の車輪支持部に対応し、床反力検出部33は、発明2ないし4の床反力検出手段に対応している。
Furthermore, in the present embodiment, when the
Thereby, when the
In the said 1st Embodiment, the
〔第1の実施の形態の変形例〕
なお、上記第1の実施の形態においては、リニアブッシュ33fにストリッパボルト33gを嵌挿し支持したが、これに限らず、リニアブッシュ33fを設けず、ストリッパボルト33gを貫通穴33dに挿通するだけの構成であってもよい。
[Modification of First Embodiment]
In the first embodiment, the
また、上記第1の実施の形態において、キャスタ支持軸31cを回転可能に車輪支持枠31bに取り付けたが、これに限らず、下板33bに回転可能に取り付けてもよい。
また、上記第1の実施の形態においては、床反力FFが床反力FBよりも大きいと判定したときは、前部のキャスタ装置30のキャスタ31が伸長するようにリニアアクチュエータ32を制御したが、これに限らず、後部のキャスタ装置30のキャスタ31が短縮するようにリニアアクチュエータ32を制御することもできる。
Moreover, in the said 1st Embodiment, although the
In the first embodiment, when it is determined that the floor reaction force FF is larger than the floor reaction force FB, the
また、上記第1の実施の形態においては、床反力FBが床反力FFよりも大きいと判定したときは、後部のキャスタ装置30のキャスタ31が伸長するようにリニアアクチュエータ32を制御したが、これに限らず、前部のキャスタ装置30のキャスタ31が短縮するようにリニアアクチュエータ32を制御することもできる。
また、上記第1の実施の形態においては、リニアアクチュエータ32を用いて構成したが、リニアアクチュエータとしては、電気式(電磁式、静電式、圧電式等)、流体圧式(油圧式、水圧式等)、空圧式その他任意の方式のアクチュエータを採用することができる。
In the first embodiment, when it is determined that the floor reaction force FB is larger than the floor reaction force FF, the
In the first embodiment, the
また、上記第1の実施の形態においては、感圧センサ33cとして予圧を必要とする感圧センサを用いたが、これに限らず、あらかじめ予圧が付与された感圧センサや、予圧を必要としない感圧センサを用いることもできる。
また、上記第1の実施の形態においては、リニアアクチュエータ32を往復直線運動を行うものとして構成したが、これに限らず、一方向にのみ直線運動を行うものとして構成することもできる。
In the first embodiment, a pressure sensor that requires preload is used as the
In the first embodiment, the
また、上記第1の実施の形態においては、本発明に係るキャスタ装置を、車輪型ロボット100の車輪として適用したが、これに限らず、本発明の主旨を逸脱しない範囲で他の場合にも適用可能である。例えば、台車、荷台、椅子、自転車、車椅子等の車輪として適用することができる。
Moreover, in the said 1st Embodiment, although the caster apparatus based on this invention was applied as a wheel of the wheel-
〔第2の実施の形態〕
次に、本発明の第2の実施の形態を図面を参照しながら説明する。図8ないし図11は、本発明に係るキャスタ装置および車輪型ロボットの第2の実施の形態を示す図である。
[Second Embodiment]
Next, a second embodiment of the present invention will be described with reference to the drawings. 8 to 11 are views showing a caster device and a wheel type robot according to a second embodiment of the present invention.
本実施の形態は、上記第1の実施の形態に対して、感圧センサを設置した点が異なる。なお、以下、上記第1の実施の形態と異なる部分についてのみ説明し、重複する部分については同一の符号を付して説明を省略する。
まず、キャスタ装置30の構成を説明する。
図8は、キャスタ装置30の正面図である。
This embodiment differs from the first embodiment in that a pressure sensitive sensor is installed. Hereinafter, only different parts from the first embodiment will be described, and overlapping parts will be denoted by the same reference numerals and description thereof will be omitted.
First, the configuration of the
FIG. 8 is a front view of the
図9は、キャスタ装置30の側面図である。
キャスタ装置30は、図8および図9に示すように、シャフト35aの下端が連結する上部リンク80と、従動輪31aに代えて駆動輪20aが連結する下部リンク85とを有して構成されている。なお、キャスタ装置30は、駆動輪20aの回転軸と直交する方向には回転しない。したがって、本願の「キャスタ」の概念には、駆動輪20aが旋回しないものも含まれる。
FIG. 9 is a side view of the
As shown in FIGS. 8 and 9, the
上部リンク80の底板84aの前両角部には、下方に向かうにつれて後方に傾斜するテーパ外面81aを有する突起部がそれぞれ設けられている。これに対応し、下部リンク85の天板84bの前両角部には、下方に向かうにつれて後方に傾斜しかつテーパ外面81aに係合するテーパ内面82aを有する突起部がそれぞれ設けられている。
底板84aの後両角部には、下方に向かうにつれて前方に傾斜するテーパ外面81bを有する突起部がそれぞれ設けられている。これに対応し、天板84bの後両角部には、下方に向かうにつれて前方に傾斜しかつテーパ外面81bに係合するテーパ内面82bを有する突起部がそれぞれ設けられている。
At both front corners of the
The rear corners of the
テーパ外面81aとテーパ内面82aの間には、感圧センサ83aが挟持されている。また、テーパ外面81bとテーパ内面82bの間には、感圧センサ83bが挟持されている。感圧センサ83a、83bは、印加される圧力に応じた電圧のセンサ信号を出力する。例えば、印加される圧力の変化に伴って電気抵抗値が変化する特性を有する感圧センサを採用することができる。
A pressure
一方、底板84aには、4つの貫通穴33dが車輪モータ50aを中心とする対角の位置にそれぞれ形成されている。これに対応し、天板84bには、各貫通穴33dに対向する位置に4つのボルト穴33eが形成されている。なお、図8では、このうち2つの貫通穴33dおよびボルト穴33eを示している。
貫通穴33dおよびボルト穴33eには、ストリッパボルト33gが挿通されている。ストリッパボルト33gの軸部であってその頭部と底板84aの間には、ワッシャ33iおよびウレタンゴム33jが外嵌されている。そして、ストリッパボルト33gの先端は、天板84bの下面からナット33kにより螺合されている。
On the other hand, four through
A
これにより、駆動輪20aが接地していない場合は、駆動輪20aおよび下部リンク85の自重により各ストリッパボルト33gが押し下げられ、ストリッパボルト33gの頭部と底板84aの間でウレタンゴム33jが付勢されて収縮する。そのため、ウレタンゴム33jの付勢力によりテーパ外面81a、81bとテーパ内面82a、81bの間に間隔が生じにくく、接地時に感圧センサ83a、83bに強い衝撃が加わるのを防止することができる。また、感圧センサ83a、83bが予圧を必要とするタイプである場合、ウレタンゴム33jの付勢力により感圧センサ83a、83bに予圧を付与することができる。
As a result, when the
一方、上部リンク80には、上部リンク80の伸長方向と軸方向を一致させて車輪モータ50aが取り付けられている。車輪モータ50aの回転軸50bは、底板84aから突出し、下部リンク85の内部に設けられた駆動傘歯車90aに連結している。
駆動傘歯車90aの下方には、回転軸89が、下部リンク85の側面に設けられた軸受88により回転可能に支持されている。回転軸89には、駆動傘歯車90aと噛み合う従動傘歯車90bおよび駆動プーリ91が連結している。
On the other hand, the
Below the
駆動プーリ91の下方には、アイドルプーリ92が回転可能に支持されている。
アイドルプーリ92の下方には、回転軸94が、下部リンク85の側面に設けられた軸受93により回転可能に支持されている。回転軸94には、従動プーリ95および駆動輪20aが連結している。
駆動プーリ91、アイドルプーリ92および従動プーリ95には、駆動ベルト96が巻き掛けられている。なお、図9の例では、アイドルプーリ92に対して、駆動ベルト96の内側からテンション調整をしているが、外側からテンション調整してもよい。
Below the
Below the
A driving
駆動輪20aは、車輪モータ50aにより駆動傘歯車90aを回転し、駆動傘歯車90aに噛み合った従動傘歯車90bを介して駆動プーリ91が回転し、駆動プーリ91に巻き掛けた駆動ベルト96により従動プーリ95が回転することにより、駆動される。
次に、本実施の形態の動作を説明する。
車輪型ロボット100は、車輪モータ50aが駆動されると、車輪モータ50aの動力が駆動輪20aに伝達され、駆動輪20aの駆動により走行することができる。このとき、接地した駆動輪20aが連結する下部リンク85と上部リンク80の間に感圧センサ83a、83bが介在しているので、感圧センサ83a、83bにより、駆動輪20aが受けた床反力が検出される。そして、ステップS100〜S106を経て、感圧センサ83a、83bからのセンサ信号に基づいて床反力FF、FBが算出される。
The
Next, the operation of the present embodiment will be described.
When the
床反力FFの算出方法を具体的に説明する。
図10は、傾斜前後の状態を示すキャスタ装置30の断面図である。
図11は、感圧センサ83a、83bで検出される力Fa、Fb、垂直方向の力FFa、FFbおよび床反力FFの関係を示す図である。
感圧センサ83aは、図10に示すように、下方に向かうにつれて後方に傾斜するテーパ外面81aとテーパ内面82aの間に挟持されている。これに対し、感圧センサ83bは、下方に向かうにつれて前方に傾斜するテーパ外面81bとテーパ内面82bの間に挟持されている。このとき、感圧センサ83a、83bの位相(感圧センサ83a、83bの面方向に延長した平面同士がなす角度)が90°であるとして、キャスタ装置30をθ傾斜させた場合を考える。
A method for calculating the floor reaction force FF will be specifically described.
FIG. 10 is a cross-sectional view of the
FIG. 11 is a diagram illustrating the relationship between the forces Fa and Fb detected by the pressure-
As shown in FIG. 10, the pressure-
感圧センサ83aで検出される力をFaとすると、感圧センサ83aに付与される垂直方向の力FFaは、図11に示すように、下式(1)により算出することができる。
FFa = Fa/cos(π/4+θ) …(1)
感圧センサ83bで検出される力をFbとすると、感圧センサ83bに付与される垂直方向の力FFbは、感圧センサ83aとの位相が90°であるので、下式(2)により算出することができる。
FFb = Fb/cos(π/4+θ) …(2)
したがって、床反力FFは、下式(3)により算出することができる。
FF = FFa +FFb …(3)
床反力FBについては、床反力FFと同様に算出することができる。
If the force detected by the
FFa = Fa / cos (π / 4 + θ) (1)
Assuming that the force detected by the
FFb = Fb / cos (π / 4 + θ) (2)
Therefore, the floor reaction force FF can be calculated by the following equation (3).
FF = FFa + FFb (3)
The floor reaction force FB can be calculated in the same manner as the floor reaction force FF.
床反力FF、FBが算出された後の動作は、上記第1の実施の形態と同様である。
ここで、ジャイロセンサ、加速度センサ等の姿勢検出センサをキャスタ装置30に設置し、姿勢検出センサのセンサ信号または車輪型ロボット100の内界情報に基づいてキャスタ装置30の傾斜角θを得ることができる。
このようにして、本実施の形態では、下方に向かうにつれて後方に傾斜するテーパ外面81aとテーパ内面82aの間に感圧センサ83aを挟持し、下方に向かうにつれて前方に傾斜するテーパ外面81bとテーパ内面82bの間に感圧センサ83bを挟持した。
The operation after the floor reaction forces FF and FB are calculated is the same as in the first embodiment.
Here, a posture detection sensor such as a gyro sensor or an acceleration sensor is installed in the
Thus, in the present embodiment, the pressure-
これにより、キャスタ装置30の傾斜角θが得られれば、キャスタ装置30が傾斜している場合の床反力FF、FBを比較的正確に算出することができる。
上記第2の実施の形態において、上部リンク80は、発明1または2のキャスタ支持軸に対応し、下部リンク85は、発明1の車輪支持部に対応し、底板84a、天板84bおよび感圧センサ83a、83bは、発明2、7または8の床反力検出手段に対応し、テーパ外面81aおよびテーパ内面82aは、発明8の第1平面に対応している。また、テーパ外面81bおよびテーパ内面82bは、発明8の第2平面に対応している。
Thereby, if the inclination angle θ of the
In the second embodiment, the
〔第3の実施の形態〕
次に、本発明の第3の実施の形態を図面を参照しながら説明する。図12ないし図14は、本発明に係るキャスタ装置および車輪型ロボットの第3の実施の形態を示す図である。
本実施の形態は、上記第2の実施の形態に対して、4つの感圧センサをそれぞれ異なる位相をもって配置した点が異なる。なお、以下、上記第2の実施の形態と異なる部分についてのみ説明し、重複する部分については同一の符号を付して説明を省略する。
[Third Embodiment]
Next, a third embodiment of the present invention will be described with reference to the drawings. 12 to 14 are views showing a caster device and a wheel type robot according to a third embodiment of the present invention.
The present embodiment is different from the second embodiment in that four pressure sensitive sensors are arranged with different phases. Hereinafter, only different parts from the second embodiment will be described, and overlapping parts will be denoted by the same reference numerals and description thereof will be omitted.
まず、キャスタ装置30の構成を説明する。
図12は、キャスタ装置30の正面図である。
図13は、キャスタ装置30の側面図である。
図14は、底板84aおよび天板84bの斜視図である。
底板84aの前右角部(図12では左側)には、図12ないし図14に示すように、下方に向かうにつれて底板84aの中心方向に傾斜するテーパ外面81cを有する突起部が設けられている。これに対応し、天板84bの前右角部には、下方に向かうにつれて天板84bの中心方向に傾斜しかつテーパ外面81cに係合するテーパ内面82cを有する突起部が設けられている。そして、テーパ外面81cとテーパ内面82cの間には、感圧センサ83a、83bと同様の感圧センサが挟持されている。
First, the configuration of the
FIG. 12 is a front view of the
FIG. 13 is a side view of the
FIG. 14 is a perspective view of the
As shown in FIGS. 12 to 14, a protrusion having a tapered
底板84aの前左角部(図12では右側)には、図12および図14に示すように、下方に向かうにつれて底板84aの中心方向に傾斜するテーパ外面81dを有する突起部が設けられている。これに対応し、天板84bの前左角部には、下方に向かうにつれて天板84bの中心方向に傾斜しかつテーパ外面81dに係合するテーパ内面82dを有する突起部が設けられている。そして、テーパ外面81dとテーパ内面82dの間には、感圧センサ83a、83bと同様の感圧センサが挟持されている。
As shown in FIGS. 12 and 14, a protrusion having a tapered
底板84aの後右角部には、図13および図14に示すように、下方に向かうにつれて底板84aの中心方向に傾斜するテーパ外面81eを有する突起部が設けられている。これに対応し、天板84bの後右角部には、下方に向かうにつれて天板84bの中心方向に傾斜しかつテーパ外面81eに係合するテーパ内面82eを有する突起部が設けられている。そして、テーパ外面81eとテーパ内面82eの間には、感圧センサ83a、83bと同様の感圧センサが挟持されている。
As shown in FIGS. 13 and 14, the rear right corner of the
底板84aの後左角部には、図14に示すように、下方に向かうにつれて底板84aの中心方向に傾斜するテーパ外面81fを有する突起部が設けられている。これに対応し、天板84bの後左角部には、下方に向かうにつれて天板84bの中心方向に傾斜しかつテーパ外面81fに係合するテーパ内面82fを有する突起部が設けられている。そして、テーパ外面81fとテーパ内面82fの間には、感圧センサ83a、83bと同様の感圧センサが挟持されている。
As shown in FIG. 14, the rear left corner of the
床反力FFは、上記第2の実施の形態と同じ要領で、4つの感圧センサからのセンサ信号および傾斜角θに基づいて算出することができる。床反力FBについても同様である。
このようにして、本実施の形態では、下方に向かうにつれて右前方からその中心方向に傾斜するテーパ外面81cとテーパ内面82cの間に感圧センサを挟持し、下方に向かうにつれて左前方からその中心方向に傾斜するテーパ外面81dとテーパ内面82dの間に感圧センサを挟持し、下方に向かうにつれて右後方からその中心方向に傾斜するテーパ外面81eとテーパ内面82eの間に感圧センサを挟持し、下方に向かうにつれて左後方からその中心方向に傾斜するテーパ外面81fとテーパ内面82fの間に感圧センサを挟持した。
The floor reaction force FF can be calculated based on the sensor signals from the four pressure sensitive sensors and the inclination angle θ in the same manner as in the second embodiment. The same applies to the floor reaction force FB.
Thus, in the present embodiment, the pressure-sensitive sensor is sandwiched between the tapered
これにより、上記第2の実施の形態に比して、キャスタ装置30が傾斜している場合の床反力FF、FBをさらに正確に算出することができる。
上記第3の実施の形態において、上部リンク80は、発明1または2のキャスタ支持軸に対応し、下部リンク85は、発明1の車輪支持部に対応し、底板84a、天板84bおよび感圧センサ83a、83bは、発明2、7または9の床反力検出手段に対応し、テーパ外面81cおよびテーパ内面82cは、発明9の第1平面に対応している。また、テーパ外面81dおよびテーパ内面82dは、発明9の第2平面に対応し、テーパ外面81eおよびテーパ内面82eは、発明9の第3平面に対応し、テーパ外面81fおよびテーパ内面82fは、発明9の第4平面に対応している。
Thereby, compared with the said 2nd Embodiment, the floor reaction forces FF and FB in case the
In the third embodiment, the
〔第2および第3の実施の形態の変形例〕
なお、上記第2および第3の実施の形態においては、本発明に係るキャスタ装置および車輪型ロボットを車輪型ロボット100に適用したが、これに限らず、脚車輪型ロボットに適用することもできる。
図15は、脚車輪型ロボット110の正面図である。
図16は、脚車輪型ロボット110の側面図である。
[Modifications of Second and Third Embodiments]
In the second and third embodiments, the caster device and the wheel type robot according to the present invention are applied to the
FIG. 15 is a front view of the leg
FIG. 16 is a side view of the leg
脚車輪型ロボット110は、図15および図16に示すように、基体10と、基体10に連結された4つの脚部12とを有して構成されている。
基体10の前部には、2本の脚部12が回転関節14を介して左右対称の位置に連結されている。また、基体10の後部には、2本の脚部12が回転関節14を介して左右対称の位置に連結されている。回転関節14は、脚車輪型ロボット110の底面と直交する方向を軸方向として回転する。すなわち、ヨー軸回りに回転する。
As shown in FIGS. 15 and 16, the leg-
Two
各脚部12には、2つの回転関節16、18が設けられている。回転関節14は、下方を軸方向として回転し、回転関節16、18は、回転関節14が図15の状態であるときは、脚車輪型ロボット110の側面と直交する方向を軸方向として回転する。すなわち、回転関節14が図15の状態であるときは、ピッチ軸回りに回転し、回転関節14が図15の状態から90度回転した状態であるときは、ロール軸回りに回転する。したがって、脚部12は、それぞれ3自由度を有する。
Each
各脚部12の先端には、回転関節16、18と軸方向を同一にして駆動輪20が回転可能に設けられている。
各脚部12の先端には、脚車輪型ロボット110の移動経路上に存在する物体までの距離を測定する前方脚先センサ22と、接地面までの距離を測定する下方脚先センサ24とが設けられている。
A
At the tip of each
各脚部12は、図8および図9に示す構造となっている。なお、図12および図13に示す構造とすることもできる。
一方、基体10の正面には、3次元距離測定装置200が取り付けられている。3次元距離測定装置200は、測距センサの測定方向に対して直交する2つの軸回りに測距センサを回転させ、これにより得られた測定結果に基づいて、測定範囲内に存在する物体上の連続面を認識する。
Each
On the other hand, a three-dimensional
また、上記第2および第3の実施の形態においては、ストリッパボルト33gの軸部であってその頭部と底板84aの間にウレタンゴム33jを外嵌して構成したが、これに代えて、コイルばねその他の弾性体を外嵌して構成することもできる。
また、上記第2および第3の実施の形態に対して上記第1の実施の形態の変形例を適用することもできる。
Further, in the second and third embodiments, the
The modification of the first embodiment can also be applied to the second and third embodiments.
100 車輪型ロボット
10 基体
20 駆動輪
30 キャスタ装置
31 キャスタ
31a 従動輪
31b 車輪支持枠
31c キャスタ支持軸
32 リニアアクチュエータ
32a 直動軸
32b 出力軸面
33 床反力検出部
33a 上板
33b 下板
33c 感圧センサ
10a、33d 貫通穴
33e ボルト穴
33f リニアブッシュ
33g ストリッパボルト
33h コイルばね
34 フレーム
34a フランジ
34b ボルト
35 高剛性ニードルガイド
35a シャフト
40 ハンドル
42、52 エンコーダ
44、54 ドライバ
50 車輪モータ
60 CPU
61〜65 I/F
74 無線通信部
80 上部リンク
85 下部リンク
81a〜81f テーパ外面
82a〜82f テーパ内面
83a、83b 感圧センサ
84a 底板
84b 天板
20a 駆動輪
50a 車輪モータ
33i ワッシャ
33j ウレタンゴム
33k ナット
50b、89、94 回転軸
88、93 軸受
90a 駆動傘歯車
90b 従動傘歯車
91 駆動プーリ
92 アイドルプーリ
95 従動プーリ
96 駆動ベルト
110 脚車輪型ロボット
12 脚部
14〜18 回転関節
22 前方脚先センサ
24 下方脚先センサ
200 3次元距離測定装置
DESCRIPTION OF
61-65 I / F
74
Claims (10)
直動軸を有するリニアアクチュエータを備え、
前記キャスタ支持軸および前記直動軸が軸方向に連結されていることを特徴とするキャスタ装置。 A caster device comprising a caster having a wheel, a wheel support portion that rotatably supports the wheel, and a caster support shaft attached to the wheel support portion with a direction orthogonal to a rotation axis of the wheel as an axial direction. And
A linear actuator having a linear motion shaft;
The caster device, wherein the caster support shaft and the linear motion shaft are connected in the axial direction.
さらに、前記キャスタが受けた床反力を検出する床反力検出手段を備え、
前記キャスタ支持軸および前記直動軸が前記床反力検出手段を介して軸方向に連結されていることを特徴とするキャスタ装置。 In claim 1,
Furthermore, a floor reaction force detecting means for detecting a floor reaction force received by the caster is provided,
The caster device, wherein the caster support shaft and the linear motion shaft are connected in the axial direction via the floor reaction force detecting means.
前記床反力検出手段は、
複数の貫通穴が形成され、その上面に前記直動軸が連結された上板と、
その下面に前記キャスタ支持軸が連結された下板と、
前記上板と前記下板の間に配置された感圧センサと、
前記貫通穴に挿通され、前記下板にその先端がそれぞれ固定された複数のボルトと、
前記ボルトの軸部を挿通し、前記ボルトの頭部と前記上板の間に介挿された複数のコイルばねとを有することを特徴とするキャスタ装置。 In claim 2,
The floor reaction force detecting means is
A plurality of through holes are formed, and an upper plate having the upper surface connected to the linear motion shaft;
A lower plate having the lower surface connected to the caster support shaft;
A pressure-sensitive sensor disposed between the upper plate and the lower plate;
A plurality of bolts inserted through the through holes and fixed to the lower plate, respectively,
A caster device comprising: a plurality of coil springs inserted between the bolt head portion and the upper plate through the shaft portion of the bolt.
前記キャスタ支持軸は、前記車輪支持部または前記下板に回転可能に取り付けられ、
前記床反力検出手段は、
前記貫通穴に嵌挿され、前記ボルトをそれぞれ嵌挿する複数のリニアブッシュを有することを特徴とするキャスタ装置。 In claim 3,
The caster support shaft is rotatably attached to the wheel support portion or the lower plate,
The floor reaction force detecting means is
A caster device comprising a plurality of linear bushes inserted into the through holes and into which the bolts are respectively inserted.
さらに、ニードルガイドを備え、
前記キャスタ支持軸および前記直動軸が前記ニードルガイドを介して連結されていることを特徴とするキャスタ装置。 In any one of Claims 1 thru | or 4,
Furthermore, a needle guide is provided,
The caster device, wherein the caster support shaft and the linear motion shaft are connected via the needle guide.
前記床反力検出手段は、所定の位相をもって配置された複数の感圧センサを有することを特徴とするキャスタ装置。 In claim 2,
The caster device, wherein the floor reaction force detection means includes a plurality of pressure sensitive sensors arranged with a predetermined phase.
前記床反力検出手段は、少なくとも2つの前記感圧センサを有し、
第1の前記感圧センサを第1平面に配置し、
第2の前記感圧センサを、前記第1平面に対して所定角度をなす第2平面に配置したことを特徴とするキャスタ装置。 In claim 7,
The floor reaction force detection means has at least two pressure sensors.
Arranging the first pressure-sensitive sensor in a first plane;
The caster device, wherein the second pressure-sensitive sensor is arranged on a second plane that forms a predetermined angle with respect to the first plane.
前記床反力検出手段は、少なくとも4つの前記感圧センサを有し、
第1の前記感圧センサを第1平面に配置し、
第2の前記感圧センサを、前記第1平面に対して所定角度をなす第2平面に配置し、
第3の前記感圧センサを、前記第1平面および前記第2平面に対して所定角度をなす第3平面に配置し、
第4の前記感圧センサを、前記第1平面ないし前記第3平面に対して所定角度をなす第4平面に配置したことを特徴とするキャスタ装置。 In claim 7,
The floor reaction force detection means has at least four pressure-sensitive sensors,
Arranging the first pressure-sensitive sensor in a first plane;
The second pressure-sensitive sensor is disposed on a second plane having a predetermined angle with respect to the first plane;
The third pressure-sensitive sensor is disposed on a third plane forming a predetermined angle with respect to the first plane and the second plane;
A caster device, wherein the fourth pressure-sensitive sensor is disposed on a fourth plane that forms a predetermined angle with respect to the first plane or the third plane.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008170029A JP2009269590A (en) | 2008-04-11 | 2008-06-30 | Caster device and wheel type robot |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008103495 | 2008-04-11 | ||
JP2008170029A JP2009269590A (en) | 2008-04-11 | 2008-06-30 | Caster device and wheel type robot |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2009269590A true JP2009269590A (en) | 2009-11-19 |
Family
ID=41436529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008170029A Pending JP2009269590A (en) | 2008-04-11 | 2008-06-30 | Caster device and wheel type robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2009269590A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019220794A1 (en) * | 2018-05-14 | 2019-11-21 | ソニー株式会社 | Vehicle wheel |
-
2008
- 2008-06-30 JP JP2008170029A patent/JP2009269590A/en active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019220794A1 (en) * | 2018-05-14 | 2019-11-21 | ソニー株式会社 | Vehicle wheel |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5955306B2 (en) | Moving vehicle | |
KR101156822B1 (en) | Mobile and control method of mobile | |
US10343740B2 (en) | Traveling apparatus | |
US20100152987A1 (en) | Traveling vehicle | |
JP2008126936A (en) | Moving device | |
JP6902728B2 (en) | Mobile | |
JP2007112168A (en) | Spherical moving device | |
JP2015070981A (en) | Obstacle avoidable leading robot | |
JP4794327B2 (en) | vehicle | |
CN211223720U (en) | Wheel and pedal part linkage mechanism of electric balance car and electric balance car | |
WO2017094069A1 (en) | Personal transporter | |
JP7229537B2 (en) | Omnidirectional mobile device and its attitude control method | |
JP2007223399A (en) | Vehicle | |
JPWO2018225233A1 (en) | Dynamometer loading device | |
JP2009297876A (en) | Wheel robot | |
JP2009269590A (en) | Caster device and wheel type robot | |
JP2010008204A (en) | Force sensing device and wheel type robot | |
JP2006068872A (en) | Leg type mobile robot | |
JP2010005730A (en) | Origin determination device and leg-wheeled robot, as well as method of determining origin | |
US20030188917A1 (en) | Electric power steering device capable of reducing vibration of steering wheel | |
JP2004295429A (en) | Method for setting target orbit data of robot | |
KR20140095340A (en) | Travelling device with function of adjusting center of mass | |
JP2010202052A (en) | Wheel position changing device of vehicle | |
JP3498044B2 (en) | Control device for omnidirectional mobile device | |
JP2007175709A (en) | Welding carriage |