JP2006053731A - Attitude holding/turnover prevention device for mobile body - Google Patents

Attitude holding/turnover prevention device for mobile body Download PDF

Info

Publication number
JP2006053731A
JP2006053731A JP2004234440A JP2004234440A JP2006053731A JP 2006053731 A JP2006053731 A JP 2006053731A JP 2004234440 A JP2004234440 A JP 2004234440A JP 2004234440 A JP2004234440 A JP 2004234440A JP 2006053731 A JP2006053731 A JP 2006053731A
Authority
JP
Japan
Prior art keywords
moving body
support member
posture
determination
inclination
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.)
Granted
Application number
JP2004234440A
Other languages
Japanese (ja)
Other versions
JP4285360B2 (en
Inventor
Yasuo Kishi
泰生 岸
Kenji Matsukuma
研司 松熊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2004234440A priority Critical patent/JP4285360B2/en
Publication of JP2006053731A publication Critical patent/JP2006053731A/en
Application granted granted Critical
Publication of JP4285360B2 publication Critical patent/JP4285360B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide an attitude holding/turnover prevention device capable of providing a turnover preventive effect for a mobile body moving in at least one direction regardless of irregularities of a road surface, and never disturbing the movement of the mobile body in a state where the mobile body has no danger of turnover. <P>SOLUTION: This device comprises an inclination sensor 105 detecting the inclination to a horizontal plane of the mobile body 101 moving in at least one direction and the direction of the inclination; a support member 107 protruding from the mobile body 101 to the road surface to support the mobile body 101; and a determination device comparing the inclination obtained by the sensor 105 with a reference value to determine the operation of a linearly moving actuator 106. When the mobile body 101 is inclined, the inclination is immediately detected, and the support member 107 is extended to prevent the turnover thereof. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は少なくとも1方向への移動能力を持つ移動体の姿勢保持・転倒防止装置に関する。   The present invention relates to a posture maintaining / falling prevention device for a moving body having a moving ability in at least one direction.

移動体の姿勢を保持し転倒を防止するための装置には、移動体辺縁部に従動輪を設けたものが知られている(例えば、特許文献1参照)。図10はその装置を示すもので、図において、12aが駆動輪、16が従動輪である。従動輪16は自由な首振り機構を備えた自在車輪であって、移動体の辺縁部で移動体を支持することで移動体の転倒を未然に防ぐものである。   As a device for maintaining the posture of the moving body and preventing the vehicle from falling, a device provided with a driven wheel at the edge of the moving body is known (for example, see Patent Document 1). FIG. 10 shows the apparatus, in which 12a is a drive wheel and 16 is a driven wheel. The driven wheel 16 is a free wheel provided with a free swing mechanism, and prevents the moving body from overturning by supporting the moving body at the edge of the moving body.

また、移動体の姿勢保持・転倒防止の目的で、アウトリガ装置を取り付けることがある(例えば、特許文献2参照)。図11はそのアウトリガ装置を示すものである。アウトリガ装置とは、特に建物の建築現場などで作業する走行式作業車において、作業時には支持部材を車体側方に張り出して車体を支えることにより転倒を防止し、走行時には車体側に支持部材を押し込んで車体占有面積を小さく抑えるものである。
図11において、移動体本体1の転倒を防止するために、第1アーム22と、第2アーム25と、第3アーム30と、キャスタ27と、第3アームと第1アームを直線状にロック・ロック解除する機構36とによってアウトリガ装置を構成している。
通常走行時は図11中の1点鎖線Aのようにアウトリガ装置を格納しておき、作業時にはBのようにアウトリガ装置を展開して前記第1アーム22と第3アーム30とをロック機構36で直線状にロックし、移動体50を支えるものである。
In addition, an outrigger device may be attached for the purpose of maintaining the posture of the moving body and preventing overturning (see, for example, Patent Document 2). FIG. 11 shows the outrigger device. The outrigger device is a traveling work vehicle that works especially at the construction site of a building, etc., and prevents the vehicle from falling by supporting the vehicle body by projecting the support member to the side of the vehicle body during work, and pushing the support member into the vehicle body side during traveling. This keeps the area occupied by the vehicle body small.
In FIG. 11, the first arm 22, the second arm 25, the third arm 30, the caster 27, and the third arm and the first arm are linearly locked to prevent the mobile body 1 from toppling over. The outrigger device is constituted by the mechanism 36 for unlocking.
During normal running, the outrigger device is stored as shown by the one-dot chain line A in FIG. 11, and during the operation, the outrigger device is deployed as shown by B to lock the first arm 22 and the third arm 30 to the lock mechanism 36. In this way, the movable body 50 is supported by being linearly locked.

図12はアウトリガ装置の他の例である(実用新案文献1参照)。
図12において、1は移動体本体、2は加速度センサ、5は油圧モータ、6はアウトリガである。急激なステアリング操作により加速度センサ2による横向き加速度検出値が基準値を上回ったとき、加速度が生じた向きにアウトリガ6を油圧モータ5により張り出してキャスタ5aを路面に接触させて移動体1を支えることで、横向きの転倒を防止するものである。
特開平5−69795号公報(図1(本願図面の図10)) 特開平4−342645号公報(図4(本願図面の図11)) 実開平5−75297号公報(図1(本願図面の図12))
FIG. 12 shows another example of the outrigger device (see Utility Model Document 1).
In FIG. 12, 1 is a mobile body, 2 is an acceleration sensor, 5 is a hydraulic motor, and 6 is an outrigger. When the lateral acceleration detected value by the acceleration sensor 2 exceeds the reference value due to an abrupt steering operation, the outrigger 6 is extended by the hydraulic motor 5 in the direction in which the acceleration is generated, and the caster 5a is brought into contact with the road surface to support the moving body 1. Thus, it is intended to prevent sideways falling.
Japanese Patent Laid-Open No. 5-69795 (FIG. 1 (FIG. 10 of the present application drawing)) JP-A-4-342645 (FIG. 4 (FIG. 11 of the present application drawing)) Japanese Utility Model Publication No. 5-75297 (FIG. 1 (FIG. 12 of the present application drawing))

図10のような、従来の従動輪を用いた姿勢保持・転倒防止装置では、転倒を効果的に防ぐために、従動輪の路面との接触点が移動体の重心位置からできるだけ遠くなるように、また各従動輪および駆動輪が路面と接触して構成する支持多角形をできるだけ大きくなるように、従動輪を設置する必要があった。これは、移動体の重心が支持多角形の外縁部に近いと転倒する危険性が高いからである。したがって、従動輪を設置するための移動体台車部分を移動体本体に対して大きくとらねばならず、特に狭い通路上の移動には不利であるという問題があった。更に、路面に凹凸があるような場合には従動輪が走行の障害となる。   In a conventional posture maintenance / falling prevention device using a driven wheel as shown in FIG. 10, in order to effectively prevent the fall, the contact point with the road surface of the driven wheel is as far as possible from the center of gravity position of the moving body. Further, it has been necessary to install the driven wheels so that each driven wheel and the driving wheel are in contact with the road surface so that the support polygon is as large as possible. This is because the risk of falling is high when the center of gravity of the moving body is close to the outer edge of the support polygon. Therefore, there is a problem that the moving body carriage portion for installing the driven wheel has to be taken larger than the moving body main body, which is disadvantageous particularly for movement on a narrow passage. Furthermore, when the road surface is uneven, the driven wheel becomes an obstacle to travel.

図11のような、従来のアウトリガ装置では、支持部材を張り出す時を建設作業時などに限定していた。そのため一般的な移動体において、走行中に路面の凹凸などによって転倒の危険が生じた場合には対応できないという問題があった。   In the conventional outrigger device as shown in FIG. 11, the time when the supporting member is extended is limited to the time of construction work or the like. For this reason, a general moving body has a problem that it cannot cope with a fall risk caused by road surface unevenness during traveling.

図12のような、実用新案文献1記載の発明では、加速度センサにより転倒の危険があるときにのみ支持部材を張り出す転倒防止装置が公開されているが、加速度センサは横方向の遠心荷重のみを計測するため任意の方向への転倒可能性を検出できないという問題があった。
また、支持部材の路面との接触状況を知る手段がないため、路面に大きな凹凸がある場合には移動体をうまく支持できないという問題もあった。例えば、図13に示したように路面にくぼみがあった場合、アウトリガ6の先端が接地しないために移動体の転倒を防止できない。
更に、装置が動作してアウトリガを張り出した後に転倒の危険がなくなった場合には、移動時の障害とならないようにアウトリガを格納することが望ましいが、アウトリガを格納するときの判定基準が定められていないために支持部材の格納作業の自動化ができないという問題もあった。
In the invention described in the utility model document 1 as shown in FIG. 12, a fall prevention device is disclosed that projects the support member only when there is a danger of fall by the acceleration sensor. There is a problem that the possibility of falling in any direction cannot be detected.
In addition, since there is no means for knowing the contact state of the support member with the road surface, there is also a problem that the moving body cannot be supported well when there are large irregularities on the road surface. For example, when there is a depression on the road surface as shown in FIG. 13, the tip of the outrigger 6 does not come into contact with the ground, so that the moving body cannot be prevented from falling.
Furthermore, when the risk of falling is eliminated after the device has been operated and the outrigger has been extended, it is desirable to store the outrigger so that it does not become an obstacle during movement. However, criteria for storing the outrigger are defined. There is also a problem that it is not possible to automate the storing operation of the support member.

本発明は上記の問題点を解決し、路面上で少なくとも1方向への移動能力を有する一般的な移動体に広く適用することができる姿勢保持・転倒防止装置を提供することを目的とする。   SUMMARY OF THE INVENTION An object of the present invention is to solve the above-described problems and to provide a posture holding / falling prevention device that can be widely applied to a general moving body having a moving ability in at least one direction on a road surface.

上記問題を解決するため、本発明は次のように構成した。
請求項1に記載の発明は、少なくとも1方向への移動能力を有する移動体に搭載されるものであって、前記1方向について前記移動体の水平面に対する傾きおよびこの傾きの方向を検出する傾き角検出装置と、前記移動体から路面に張り出して前記移動体を支持する支持部材と、前記支持部材を駆動する支持部材駆動装置と、得られた傾き角を基準値と比較して前記支持部材駆動装置の動作を決定する判定装置と、を備えていることを特徴とするものである。
In order to solve the above problems, the present invention is configured as follows.
The invention according to claim 1 is mounted on a moving body having a moving capability in at least one direction, and the inclination angle of the moving body with respect to a horizontal plane and the direction of the inclination with respect to the one direction. A detection device; a support member that projects from the moving body to a road surface and supports the moving body; a support member drive device that drives the support member; and the support member drive that compares the obtained inclination angle with a reference value And a determination device that determines the operation of the device.

請求項2に記載の発明は、前記判定装置において、前記傾き角検出装置の出力が基準値(a)を下回っているときは、前記支持部材を格納することを特徴とするものである。   The invention according to claim 2 is characterized in that, in the determination device, when the output of the tilt angle detection device is below a reference value (a), the support member is stored.

請求項3に記載の発明は、前記判定装置において、前記傾き角検出装置の出力が請求項2に記載の基準値(a)よりも大きな傾き角度に相当する別の基準値(b)を上回ったときに、前記傾き角検出装置の出力が前記基準値(b)を下回るまで、前記支持部材を下向きに駆動し続けることを特徴とするものである。   According to a third aspect of the present invention, in the determination apparatus, the output of the tilt angle detection device exceeds another reference value (b) corresponding to a larger tilt angle than the reference value (a) of the second aspect. The support member is continuously driven downward until the output of the tilt angle detecting device falls below the reference value (b).

請求項4に記載の発明は、前記判定装置において、前記傾き角検出装置の出力が前記基準値(a)以下であり、かつ前記基準値(b)以上である場合には、前記支持部材を固定することを特徴とするものである。   According to a fourth aspect of the present invention, in the determination device, when the output of the tilt angle detection device is not more than the reference value (a) and not less than the reference value (b), the support member is It is characterized by being fixed.

請求項5に記載の発明は、前記傾き角検出装置と、前記支持部材と、前記支持部材駆動装置と、前記判定装置と、をそれぞれ少なくとも1台ずつ以上まとめ、前記移動体に自由に取り付けることができる姿勢保持・転倒防止ユニットを構成することを特徴とするものである。   According to a fifth aspect of the present invention, at least one of the tilt angle detection device, the support member, the support member driving device, and the determination device is collected and attached to the movable body freely. It is characterized in that it constitutes a posture holding / falling prevention unit.

請求項6に記載の発明は、前記姿勢保持・転倒防止ユニットにおいて、前記傾き角検出装置の検出軸の向きが前記支持部材を張り出す方向に直行する向きとなるように前記傾き角検出装置を設置することを特徴とするものである。   According to a sixth aspect of the present invention, in the posture maintaining / falling prevention unit, the tilt angle detecting device is arranged such that the direction of the detection shaft of the tilt angle detecting device is a direction perpendicular to the direction in which the support member is projected. It is characterized by installation.

請求項7に記載の発明は、前記姿勢保持・転倒防止装置において、傾き角検出装置のみを移動体内部に設け、傾き角検出装置の出力を各判定装置で共有して利用できるようにしたことを特徴とするものである。   According to the seventh aspect of the present invention, in the posture holding / falling prevention device, only the inclination angle detection device is provided inside the moving body, and the output of the inclination angle detection device can be shared and used by each determination device. It is characterized by.

請求項8に記載の発明は、前記判定装置において、少なくとも1方向への傾き角を同時に複数の基準値と比較する判定回路を、複数備えることを特徴とするものである。   The invention according to claim 8 is characterized in that the determination apparatus includes a plurality of determination circuits that simultaneously compare an inclination angle in at least one direction with a plurality of reference values.

請求項9に記載の発明は、前記支持部材を、その動作の向きが移動体の支持多角形の法線方向に一致するように設置することを特徴とするものである。   The invention according to claim 9 is characterized in that the support member is installed such that the direction of movement thereof coincides with the normal direction of the support polygon of the moving body.

請求項10に記載の発明は、前記支持部材及び支持部材駆動装置を移動体の鉛直中心軸に関して対称な位置に設置することを特徴とするものである。   According to a tenth aspect of the present invention, the support member and the support member driving device are installed at positions symmetrical with respect to the vertical center axis of the moving body.

請求項11に記載の発明は、前記支持部材を並行リンクで構成し、前記支持部材駆動装置をモータとモータ駆動回路とによって構成することを特徴とするものである。   According to an eleventh aspect of the present invention, the support member is constituted by a parallel link, and the support member drive device is constituted by a motor and a motor drive circuit.

請求項12に記載の発明は、前記判定装置において、移動体の転倒危険性が高まるとあらかじめ予想される場合は、傾き角検出装置の出力にかかわらず支持部材を張り出すことを特徴とするものである。   The invention according to claim 12 is characterized in that, in the determination device, when it is predicted in advance that the risk of falling of the moving body is increased, the support member is projected regardless of the output of the tilt angle detection device. It is.

請求項13に記載の発明は、前記支持部材において、その設置位置を移動体の支持多角形の各辺の垂直二等分線上とすることを特徴とする移動体の姿勢保持・転倒防止装置とするものである。   According to a thirteenth aspect of the present invention, in the support member, the installation position of the support member is on a perpendicular bisector of each side of the support polygon of the mobile object. To do.

請求項14に記載の発明は、前記支持部材の路面に向かって張り出す角度を垂直に近づけたことを特徴としている。   The invention as set forth in claim 14 is characterized in that the angle of the support member projecting toward the road surface is made close to vertical.

請求項1に記載の発明により、傾き角検出装置によって移動体の現在の状態を知ることができ、また判定装置と駆動装置とによって移動体の状態に応じて適切に支持部材を張り出したり格納したりすることが可能となる。移動体の状態に応じて支持部材を格納すれば路面上における移動体の占有面積を小さくすることができ、支持部材が走行の障害となることを避けることができる。また、状態に応じて支持部材の張り出し量を変えることが可能であり、支持の状態を調整できる。   According to the first aspect of the present invention, the current state of the moving body can be known by the tilt angle detection device, and the support member is appropriately extended or stored according to the state of the moving body by the determination device and the driving device. It becomes possible to do. If the support member is stored according to the state of the moving body, the area occupied by the moving body on the road surface can be reduced, and the support member can be prevented from obstructing the traveling. Further, the amount of protrusion of the support member can be changed according to the state, and the support state can be adjusted.

請求項2に記載の発明によれば、装置動作後に転倒の危険がなくなった場合に支持部材を自動的に格納し、走行時の障害とならないようにすることができる。   According to the second aspect of the present invention, it is possible to automatically store the support member when there is no danger of falling after the operation of the apparatus, so that it does not become an obstacle during traveling.

請求項3に記載の発明によると、支持部材が路面に接地して移動体の姿勢を立て直すまで、確実に支持部材の張り出しを続けることができ、路面の凹凸にかかわらず姿勢保持・転倒防止ができる。   According to the third aspect of the present invention, the support member can be reliably extended until the support member comes into contact with the road surface and the posture of the moving body is reestablished, and the posture can be maintained and the fall prevention can be performed regardless of the unevenness of the road surface. it can.

請求項4に記載の発明により、転倒の危険がなくなるまで確実に移動体の姿勢を保持し、転倒を防止することができる。   According to the fourth aspect of the present invention, it is possible to reliably hold the posture of the moving body and prevent the fall until the danger of the fall is eliminated.

請求項5に記載の発明によれば、移動体にユニットを取り付けるだけで容易に姿勢保持・転倒防止機能を付加できる移動体の姿勢保持・転倒防止機構とすることができる。また、必要に応じてユニット数を増減することも容易となる。   According to the fifth aspect of the present invention, it is possible to provide a movable body posture holding / falling prevention mechanism that can easily add a posture holding / falling prevention function simply by attaching a unit to the moving body. It is also easy to increase or decrease the number of units as necessary.

請求項6に記載の発明によれば、傾き角検出装置が検出する移動体の傾き角度と、支持部材を駆動することによって移動体が動く向きと、が一致するため、確実に移動体の姿勢保持・転倒防止効果が得られる。   According to the sixth aspect of the invention, since the inclination angle of the moving body detected by the inclination angle detecting device matches the direction in which the moving body moves by driving the support member, the attitude of the moving body is surely achieved. Holding / falling prevention effect is obtained.

請求項7の発明によれば、移動体の傾き角度を知るために必要な最低限の数の傾き角検出装置だけで請求項1に記載の移動体の姿勢保持・転倒防止装置を構成でき、部品点数を削減できる。   According to the invention of claim 7, the mobile body posture holding / falling prevention device according to claim 1 can be configured with only a minimum number of inclination angle detection devices necessary to know the inclination angle of the mobile body, The number of parts can be reduced.

請求項8に記載の発明により、複雑な計算を行うことなく、単純な比較演算のみで複数の支持部材駆動装置を確実に駆動できる。また判定装置を複数台設置する必要がなくなり、部品点数を削減できる。   According to the eighth aspect of the present invention, it is possible to reliably drive a plurality of support member driving devices by simple comparison operations without performing complicated calculations. Moreover, it is not necessary to install a plurality of determination devices, and the number of parts can be reduced.

請求項9に記載の発明により、転倒の危険性が高い方向に支持部材を張り出させることができるようになり、姿勢保持・転倒防止効果を高めることができる。   According to the ninth aspect of the present invention, the support member can be projected in a direction in which the risk of falling is high, and the effect of maintaining the posture and preventing falling can be enhanced.

請求項10に記載の発明によって、あらゆる方向への転倒を効果的に防止する移動体の姿勢保持・転倒防止装置とすることができる。   According to the tenth aspect of the present invention, it is possible to provide a mobile body posture maintaining / falling prevention device that effectively prevents the fall in any direction.

請求項11に記載の発明によって、格納時の占有空間が極めて小さく、張り出し時には高い姿勢保持・転倒防止効果を発揮する移動体の姿勢保持・転倒防止装置とすることができる。   According to the eleventh aspect of the present invention, it is possible to provide a posture maintaining / falling prevention device for a moving body that has an extremely small occupied space at the time of storage and exhibits a high posture holding / falling preventing effect when projecting.

請求項12に記載の発明によれば、転倒の危険性が高い状況においても確実に移動体の姿勢保持・転倒防止をすることができる。   According to the twelfth aspect of the present invention, it is possible to reliably maintain the posture of the moving body and prevent the overturn even in a situation where the risk of the overturn is high.

請求項13に記載の発明により、支持部材の動作時に高い姿勢保持・転倒防止効果を発揮できるような支持部材の設置位置を容易に定めることができる。   According to the thirteenth aspect of the present invention, it is possible to easily determine the installation position of the support member that can exhibit a high posture maintaining / falling prevention effect during the operation of the support member.

請求項14に記載の発明により、前記支持部材の路面に向かって張り出す角度を、従来装置のそれが路面に対して30度〜60度であったのに対して、大幅に垂直に近づけたので、狭い通路の通過中でも転倒防止ができるようになる。   According to the invention described in claim 14, the angle of the support member protruding toward the road surface is made substantially perpendicular to that of the conventional device, which is 30 ° to 60 ° with respect to the road surface. As a result, it is possible to prevent falling even when passing through a narrow passage.

以下、本発明の実施の形態について図を参照して説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

図1に第1実施例である全方向移動ロボットの構成を示す。図2は図1の全方向移動ロボットを下から見た図である。また、図3は図1の点線内に該当する部分を拡大し、その動作を説明するための図である。図8は本実施例における判定装置の構成である。図9は判定装置における判定の流れと対応する支持部材の動作を示している。
図1において、101は全方向移動ロボット、102は全方向移動台車、103はオムニホイル、104はモータ、105は傾斜角センサ、106は直動アクチュエータ、107は支持部材、108はボールキャスタ、109は図3の該当部分、110はロボットアームである。
全方向移動ロボット101は、全方向移動台車102によって前後方向・左右方向・回転方向全ての方向に移動することができ、ロボットアーム110で荷物の搬送や人間の作業補助などを行うものである。全方向移動台車102においてオムニホイル103とモータ104は3対あり、図2のように正三角形の位置に配置されている。オムニホイルをモータで適切に駆動することによって、全方向移動が可能であることが知られている。
FIG. 1 shows the configuration of an omnidirectional mobile robot according to the first embodiment. FIG. 2 is a view of the omnidirectional mobile robot of FIG. 1 as viewed from below. FIG. 3 is a diagram for enlarging a portion corresponding to the dotted line in FIG. 1 and explaining its operation. FIG. 8 shows the configuration of the determination apparatus in this embodiment. FIG. 9 shows the operation of the support member corresponding to the determination flow in the determination apparatus.
In FIG. 1, 101 is an omnidirectional mobile robot, 102 is an omnidirectional cart, 103 is an omni wheel, 104 is a motor, 105 is a tilt angle sensor, 106 is a linear actuator, 107 is a support member, 108 is a ball caster, 109 is In FIG. 3, the corresponding part 110 is a robot arm.
The omnidirectional mobile robot 101 can be moved in all directions by the omnidirectional mobile carriage 102 in the front-rear direction, the left-right direction, and the rotational direction. In the omnidirectional mobile carriage 102, there are three pairs of omnifoils 103 and motors 104, which are arranged at regular triangle positions as shown in FIG. It is known that omnidirectional movement is possible by appropriately driving an omni foil with a motor.

直動アクチュエータ106および支持部材107は、図2に示したように配置する。図において、201はオムニホイルによって構成される支持多角形である。支持多角形201から移動体の重心が外れると転倒が起きるため、支持部材107を設置することによって新たに構成される支持多角形ができるだけ大きくなるように、なおかつ支持多角形の各辺から移動体の重心までの距離ができるだけ遠くなるように、支持部材107を設置する。すなわち、支持部材107の張り出し方向と支持多角形201の各辺の法線方向とが一致するように、なおかつ支持多角形201の各辺の垂直二等分線上に位置するように設置する。
第1実施例では支持多角形201が正三角形であるため、支持部材107は合計3つとする。この設置方法は容易に高い姿勢保持・転倒防止効果を得るための指針であるから、この設置方法に従って支持部材を取り付けることが構造上困難である場合には、できる限り支持部材の張り出し方向と支持多角形の各辺の法線方向とが近づくように、なおかつ支持多角形の各辺の垂直二等分線上に近づくように、設置すればよい。
また、支持部材107の強度や直動アクチュエータ106の力が全方向移動ロボット101を支えるのに不十分である場合は、支持部材107の数を増やしてもよい。逆に、転倒可能性が低いと判断できる方向には支持部材107を設置しなくともよい。
The linear actuator 106 and the support member 107 are arranged as shown in FIG. In the figure, 201 is a support polygon constituted by omni foil. When the center of gravity of the moving body deviates from the support polygon 201, the vehicle falls over, so that the newly formed support polygon can be as large as possible by installing the support member 107, and the moving body can be moved from each side of the support polygon. The support member 107 is installed so that the distance to the center of gravity is as far as possible. That is, the support member 107 is installed so that the projecting direction of the support member 107 and the normal direction of each side of the support polygon 201 coincide with each other and on the perpendicular bisector of each side of the support polygon 201.
In the first embodiment, since the support polygon 201 is an equilateral triangle, the number of support members 107 is three in total. Since this installation method is a guideline for easily obtaining a high posture retention / falling prevention effect, if it is structurally difficult to attach a support member according to this installation method, the extension direction and support of the support member as much as possible What is necessary is just to install so that the normal line direction of each side of a polygon may approach, and it may approach on the perpendicular bisector of each side of a support polygon.
Further, when the strength of the support member 107 and the force of the linear motion actuator 106 are insufficient to support the omnidirectional mobile robot 101, the number of the support members 107 may be increased. Conversely, the support member 107 does not have to be installed in a direction where it can be determined that the possibility of falling is low.

それぞれの支持部材107を張り出す方向への傾き角を計測するため、傾斜角センサ105を支持部材107の近隣に配置し、それぞれの支持部材107が張り出す向きへの傾きを検出できるように備える。すなわち、傾斜角センサ105の検出軸の向きが支持部材107の張り出す方向に直行するように傾斜角センサ105を設置する。例えば、図3において、ロボットが転倒方向321の方向に傾いたときに支持部材107はそれを支えるため、傾斜角センサ105が転倒方向321の向きの傾斜角を計測できるように、つまり紙面に垂直な軸周りの傾斜角を計測できるように設置する。   In order to measure the inclination angle in the direction in which each support member 107 protrudes, an inclination angle sensor 105 is arranged in the vicinity of the support member 107 so that the inclination in the direction in which each support member 107 protrudes can be detected. . That is, the tilt angle sensor 105 is installed so that the direction of the detection axis of the tilt angle sensor 105 is perpendicular to the direction in which the support member 107 projects. For example, in FIG. 3, since the support member 107 supports the robot when it tilts in the direction of the fall 321, the tilt angle sensor 105 can measure the tilt angle in the direction of the fall direction 321, that is, perpendicular to the paper surface. It is installed so that the inclination angle around the proper axis can be measured.

ロボット本体101の内部には判定装置417(図4)を組み込み、判定装置417の入力信号は傾斜角センサ105の出力信号とし、判定装置417の出力信号は直動アクチュエータ106(図1〜図3)の駆動信号とする。
判定装置417は図8のように構成する。
図において、傾斜角センサ901は角度情報に応じて増減するアナログ電圧を出力し、アナログ電圧をAD変換器902によってディジタルの角度情報に変換し、AD変換によって得られた角度情報とメモリ904から読み出した基準値とをマイクロコンピュータ903で比較し、その結果に基づいて支持部材駆動装置の動作指令を出力するものである。
A determination device 417 (FIG. 4) is incorporated in the robot body 101. An input signal of the determination device 417 is an output signal of the tilt angle sensor 105, and an output signal of the determination device 417 is a linear motion actuator 106 (FIGS. 1 to 3). ) Drive signal.
The determination device 417 is configured as shown in FIG.
In the figure, an inclination angle sensor 901 outputs an analog voltage that increases or decreases according to angle information, converts the analog voltage into digital angle information by an AD converter 902, and reads out from the angle information obtained by AD conversion and the memory 904. The reference value is compared by the microcomputer 903, and the operation command of the support member driving device is output based on the result.

判定装置417に入力された傾斜角センサ105出力値に対する判定の流れと対応する支持部材の動作を図9に示している。ステップS1で傾き角が基準値(b)未満であれば支持部材を格納し、ステップS2で傾き角が(a)より大きければ支持部材を張り出し、それ以外の場合は支持部材を固定する。   FIG. 9 shows the flow of determination with respect to the output value of the tilt angle sensor 105 input to the determination device 417 and the operation of the support member corresponding thereto. If the tilt angle is less than the reference value (b) in step S1, the support member is stored. If the tilt angle is larger than (a) in step S2, the support member is extended, and otherwise the support member is fixed.

直動アクチュエータ106(図3)は判定装置417(図8)の出力に応じて支持部材107(図3)を上下に出し入れする。ここでは、直動アクチュエータ106にはボールねじ機構とサーボモータを組み合わせたものを用いているが、もちろんこれに限定されるものではなく、直動動作を行うことができるものであれば何でもよく、その構成は特に限定するものではない。例えば、直動アクチュエータ106には、リニアモータ、空気圧シリンダー、油圧シリンダーを用いても、ラック−ピニオン機構とサーボモータで構成してもよい。   The linear actuator 106 (FIG. 3) moves the support member 107 (FIG. 3) up and down in accordance with the output of the determination device 417 (FIG. 8). Here, the linear actuator 106 uses a combination of a ball screw mechanism and a servo motor, but of course it is not limited to this, and any actuator that can perform a linear motion may be used. The configuration is not particularly limited. For example, the linear actuator 106 may be a linear motor, a pneumatic cylinder, or a hydraulic cylinder, or may be configured with a rack-pinion mechanism and a servo motor.

支持部材107の先端にはボールキャスタ108を備える。これは接地したときの路面との摩擦を緩和するものであれば何でもよく、図10の従来装置で用いている一般的な首振り型のキャスタ16を用いてもよい。   A ball caster 108 is provided at the tip of the support member 107. This may be anything as long as it reduces the friction with the road surface when grounded, and a general swing-type caster 16 used in the conventional apparatus of FIG. 10 may be used.

以上のように、本発明が特許文献2と異なる部分は、傾斜角センサと判定装置とを備え、また判定装置によって駆動できる直動アクチュエータと支持部材とを備えた部分である。
また本発明が実用新案文献1と異なる部分は、傾斜角センサと判定装置を備えて支持部材の動作量を傾斜角の大きさによって調節できるようにしたことと、支持部材を様々な方向に設置できるものとしたことである。
As described above, the part where the present invention is different from Patent Document 2 is a part that includes a tilt angle sensor and a determination device, and includes a linear actuator and a support member that can be driven by the determination device.
Further, the present invention differs from Utility Model Reference 1 in that it includes an inclination angle sensor and a determination device so that the operation amount of the support member can be adjusted according to the size of the inclination angle, and the support member is installed in various directions. It was something that could be done.

次ぎに、第1実施例について図3を用いてその動作を説明する。
図において、全方向移動ロボット101が移動中に段差にぶつかるなどして図左の直立状態から図右のように傾くと、傾斜角センサ105の出力値が増大する。傾斜角センサ105の出力値と基準値(a)とを判定装置417(図4,図8)で比較し、傾斜角センサ105の出力値の方が大きい場合(図9のS2)に速やかに直動アクチュエータ106を323の向きに駆動させ、支持部材107を下方に張り出す。支持部材107を路面に押し付ける反力で移動体の転倒は防がれ、移動体の傾き角度は減少する方向322に動く。支持部材107の先にはボールキャスタ108があるため、支持部材107の先端と路面との摩擦で移動が妨げられることはない。
Next, the operation of the first embodiment will be described with reference to FIG.
In the figure, if the omnidirectional mobile robot 101 hits a step during the movement and tilts as shown in the right from the upright state in the left of the figure, the output value of the tilt angle sensor 105 increases. The output value of the inclination angle sensor 105 and the reference value (a) are compared by the determination device 417 (FIGS. 4 and 8), and when the output value of the inclination angle sensor 105 is larger (S2 in FIG. 9), it is promptly performed. The linear actuator 106 is driven in the direction of 323, and the support member 107 is projected downward. The reaction force that presses the support member 107 against the road surface prevents the moving body from overturning, and the inclination angle of the moving body moves in a direction 322 that decreases. Since there is a ball caster 108 at the tip of the support member 107, the movement of the tip of the support member 107 and the road surface is not hindered.

直動アクチュエータ106を駆動し続ければ、全方向移動ロボット101の傾きは減少し、やがて傾斜角センサ105の出力値は基準値(a)以下となるため、それを判定装置417で検出し、直動アクチュエータ106を停止させる。結果として全方向移動ロボット101の傾き角度は基準値(a)に相当する傾き角度よりも小さくなり、姿勢保持・転倒防止が実現される。   If the linear actuator 106 continues to be driven, the tilt of the omnidirectional mobile robot 101 decreases, and eventually the output value of the tilt angle sensor 105 becomes equal to or less than the reference value (a). The moving actuator 106 is stopped. As a result, the tilt angle of the omnidirectional mobile robot 101 becomes smaller than the tilt angle corresponding to the reference value (a), and posture maintenance and fall prevention are realized.

その後、ロボットが段差から離れるなどして傾き角度が更に減少し、基準値(b)を下回ると、判定装置417の働きによって直動アクチュエータ106を駆動し、支持部材107を上に持ち上げ格納する。
結果としてロボットの傾き角度が(b)を下回っているとき(図9のS1)は常に支持部材107は格納されている状態となり、移動時に支持部材107が段差に引っかかるなどして移動を妨げない。
このように第1実施例のような構成とすれば、支持部材107が張り出しても全体の占有空間はほとんど変わらないため、狭い場所でも支持部材張り出し時に周囲の障害物と干渉しない。
Thereafter, when the robot further moves away from the step and the inclination angle further decreases and falls below the reference value (b), the linear motion actuator 106 is driven by the action of the determination device 417, and the support member 107 is lifted and stored.
As a result, when the tilt angle of the robot is less than (b) (S1 in FIG. 9), the support member 107 is always in the retracted state, and the support member 107 does not hinder the movement during movement, such as being caught by a step. .
In this way, if the configuration as in the first embodiment is adopted, the entire occupied space does not change even if the support member 107 protrudes, so that it does not interfere with surrounding obstacles when the support member extends even in a narrow place.

傾斜角センサ105、判定装置417、直動アクチュエータおよび支持部材107を一まとめにして姿勢保持・転倒防止ユニットとすれば、移動体の必要な部分に必要な数だけ取り付けることができ、便利である。   If the tilt angle sensor 105, the determination device 417, the linear motion actuator, and the support member 107 are combined into a posture holding / falling prevention unit, the necessary number of the movable body can be attached to the necessary portion, which is convenient. .

また、ロボットが重いものを持ち上げて操作するなど、事前に転倒可能性が高くなることが分かっている場合には、判定装置417(図8)の駆動信号を待たずに支持を張り出させるようにすれば、確実に姿勢保持・転倒防止効果を得ることができる。   In addition, when it is known that the possibility of falling is increased in advance, such as when a robot lifts and operates a heavy object, the support is extended without waiting for the drive signal of the determination device 417 (FIG. 8). By doing so, it is possible to reliably obtain the posture maintaining / falling prevention effect.

次ぎに、本発明の第2実施例の構成を図4に示す。
図において411は移動ロボット、412は移動台車、413は駆動輪、414はキャスタ、415はモータ、416は2軸傾斜角センサ105、417は判定装置417、418は通信線、点線419は図6に該当する部分を示しており、420はディスプレイ、421はスピーカである。
図5は図4の移動ロボットを下方から見た図である。図において、点線501は駆動輪とキャスタで構成される支持多角形を示している。
図6は図1中の点線419内の構成を詳細に説明するための図である。
図において、601はモータ、602は並行リンク、603は支持リンク、604は従動関節、605はキャスタである。図6において610の向きに移動ロボットが傾いたときの動作を、図7に示している。図において711はモータ動作方向、712は支持リンクの動作方向、713は移動ロボットが転倒から復帰する方向を表している。
Next, the configuration of the second embodiment of the present invention is shown in FIG.
In the figure, 411 is a mobile robot, 412 is a mobile carriage, 413 is a drive wheel, 414 is a caster, 415 is a motor, 416 is a biaxial tilt angle sensor 105, 417 is a determination device 417, 418 is a communication line, and a dotted line 419 is FIG. , 420 is a display, and 421 is a speaker.
FIG. 5 is a view of the mobile robot of FIG. 4 as viewed from below. In the figure, a dotted line 501 indicates a support polygon composed of drive wheels and casters.
FIG. 6 is a diagram for explaining in detail the configuration within the dotted line 419 in FIG.
In the figure, 601 is a motor, 602 is a parallel link, 603 is a support link, 604 is a driven joint, and 605 is a caster. FIG. 7 shows an operation when the mobile robot is tilted in the direction of 610 in FIG. In the figure, reference numeral 711 denotes a motor operation direction, 712 denotes a support link operation direction, and 713 denotes a direction in which the mobile robot returns from falling.

移動ロボット411は環境地図と障害物検知センサを備えており、屋内を移動しながら人間に様々な情報をディスプレイ420およびスピーカ421を通して提供するものである。狭い環境で動作するために、移動ロボットは上下方向に細長く、結果として重心位置が高い不安定な構造となっている。ここで説明の都合上、紙面右を移動ロボットの前方向、紙面左を移動ロボットの後方向、紙面に垂直な向きを移動ロボットの左右方向と定義する。移動台車412は、キャスタ414を4隅に備え、それとは別に左右対称に設けられた1対の駆動輪413をモータ415で駆動し、環境中を移動する。2つの駆動輪の回転速度を調整することで、移動ロボットの移動方向を変えることができる。   The mobile robot 411 includes an environmental map and an obstacle detection sensor, and provides various information to a human through the display 420 and the speaker 421 while moving indoors. In order to operate in a narrow environment, the mobile robot is elongated in the vertical direction, resulting in an unstable structure with a high center of gravity. For convenience of explanation, the right side of the page is defined as the forward direction of the mobile robot, the left side of the page is defined as the backward direction of the mobile robot, and the direction perpendicular to the page is defined as the left-right direction of the mobile robot. The movable carriage 412 includes casters 414 at four corners, and a pair of drive wheels 413 provided symmetrically separately from the casters 414 is driven by a motor 415 to move in the environment. The moving direction of the mobile robot can be changed by adjusting the rotational speeds of the two drive wheels.

移動ロボット内部に2軸傾斜角センサ416を、移動ロボットの前後・左右の傾き角度を計測できるように固定する。また、移動ロボット内部に判定装置417を固定し、2軸傾斜角センサ416の出力をその入力とする。判定装置417の出力はモータ601に接続する。モータ601の出力軸には、1本の並行リンク602の端部を固定する。並行リンクと支持リンク603および移動ロボットの外壁によって閉リンク機構が構成されるように、各リンクおよび移動ロボットの外壁を従動関節604によって接続する。支持リンク603の先端には自由な首振り機構を備えたキャスタ605を取り付ける。モータ601と、並行リンク602と、支持リンク603は、支持リンクの張り出し方向が駆動輪413とキャスタ414で構成される支持多角形501の各辺に垂直な向きとなるように、なおかつ各辺の垂直二等分線上に位置するように設置する。
この第2実施例では、支持多角形はほぼ長方形であるから、各辺の垂直二等分線上に合計4つの支持部材を設置する。
A two-axis tilt angle sensor 416 is fixed inside the mobile robot so that the front / rear / left / right tilt angles of the mobile robot can be measured. Further, the determination device 417 is fixed inside the mobile robot, and the output of the biaxial tilt angle sensor 416 is used as the input. The output of the determination device 417 is connected to the motor 601. The end of one parallel link 602 is fixed to the output shaft of the motor 601. Each link and the outer wall of the mobile robot are connected by a driven joint 604 so that a closed link mechanism is configured by the parallel link, the support link 603, and the outer wall of the mobile robot. A caster 605 having a free swing mechanism is attached to the tip of the support link 603. The motor 601, the parallel link 602, and the support link 603 are arranged so that the extending direction of the support link is perpendicular to each side of the support polygon 501 composed of the drive wheels 413 and the casters 414. Install so that it is on the vertical bisector.
In this second embodiment, since the support polygon is substantially rectangular, a total of four support members are installed on the vertical bisector of each side.

続いて第2実施例の動作を、図6および図7を用いて説明する。
ロボットが移動中に何らかの力を受けて転倒方向610(図6)の向きに傾くと、2軸傾斜角センサ416(図4)の対応する軸周りの出力値が増大する。2軸傾斜角センサ416の対応する軸周りの出力値と基準値(a)とを判定装置417で比較し、2軸傾斜角センサ405の出力値が基準値を上回った場合にモータ601をモータ動作方向711に駆動し、並行リンク602を介して支持リンク603を支持リンク動作方向712に張り出す。支持リンク603を路面に押し付ける反力で移動ロボットの転倒は防がれ、移動ロボットは転倒方向610とは逆向きの復帰方向713に動く。モータ601を駆動し続ければやがて2軸傾斜角センサ105416の出力値は基準値を下回るため、それを判定装置417で検出し、モータ601を停止させる。結果として支持リンク603を張り出した向きへの移動体の傾き角度は基準値(a)に相当する傾き角度よりも小さくなり、移動体の姿勢保持・転倒防止が可能となる。
Next, the operation of the second embodiment will be described with reference to FIGS.
When the robot receives some force during movement and tilts in the direction of the fall 610 (FIG. 6), the output value around the corresponding axis of the biaxial tilt angle sensor 416 (FIG. 4) increases. The output value around the corresponding axis of the biaxial tilt angle sensor 416 and the reference value (a) are compared by the determination device 417. When the output value of the biaxial tilt angle sensor 405 exceeds the reference value, the motor 601 is moved to the motor 601. Driving in the operation direction 711, the support link 603 projects in the support link operation direction 712 through the parallel link 602. The reaction force pressing the support link 603 against the road surface prevents the mobile robot from falling, and the mobile robot moves in the return direction 713 opposite to the fall direction 610. If the motor 601 continues to be driven, the output value of the biaxial tilt angle sensor 105416 will eventually fall below the reference value, so that it is detected by the determination device 417 and the motor 601 is stopped. As a result, the inclination angle of the moving body in the direction in which the support link 603 projects is smaller than the inclination angle corresponding to the reference value (a), and the posture of the moving body can be maintained and the fall can be prevented.

その後ロボットの傾き角度が更に減少し、基準値(b)を下回ると、判定装置417の働きによってモータ601をモータ動作方向711とは逆の向きに駆動し、支持リンクを支持リンク動作方向712とは逆の向きに動かし格納する。結果としてロボットの傾き角度が(b)を下回っているときは常に支持部材は格納されている状態となり、移動時に支持部材が段差に引っかかるなどして移動を妨げることがない。
この実施例のような構成とすれば、通常は移動ロボット401の側面に支持リンク712が張り付くように格納されるため、空間を有効利用することができる。逆に、格納時の占有空間に比して支持部材の張り出し時の接地点をよりロボット本体から離れた位置にとることができるため、高い姿勢保持・転倒防止効果を得ることができる。
Thereafter, when the tilt angle of the robot further decreases and falls below the reference value (b), the motor 601 is driven in the direction opposite to the motor operation direction 711 by the function of the determination device 417, and the support link is moved to the support link operation direction 712. Move in the opposite direction and store. As a result, when the robot tilt angle is less than (b), the support member is always retracted, and the movement is not hindered by the support member being caught by a step during movement.
With the configuration as in this embodiment, since the support link 712 is usually stored so as to stick to the side surface of the mobile robot 401, the space can be used effectively. On the contrary, since the contact point when the support member is extended can be further away from the robot body as compared with the occupied space at the time of storage, a high posture retention / falling prevention effect can be obtained.

上記のような構成および手段により、移動体の傾きが増大して転倒するのを防止することができる。移動体の傾き角度が小さく転倒の危険がないときには支持部材は路面から大きく離れているため、移動の妨げとはならない。
傾き角度をもとに支持部材を駆動するため、路面の傾きや凹凸によらず移動体の転倒を効果的に予防でき、また無駄な駆動力を発生することもない。
With the configuration and means as described above, it is possible to prevent the mobile body from tilting due to an increase in tilt. When the inclination angle of the moving body is small and there is no danger of falling, the support member is far away from the road surface, so that the movement is not hindered.
Since the support member is driven based on the inclination angle, the moving body can be effectively prevented from falling over regardless of the road surface inclination or unevenness, and no unnecessary driving force is generated.

本発明による移動体の姿勢保持・転倒防止装置は、移動中に転倒する可能性がある一般的な移動体に広く適用できるものである。   The apparatus for maintaining the posture of a moving body and preventing overturning according to the present invention can be widely applied to general moving bodies that may fall over while moving.

本発明の第1実施例を示す姿勢保持・転倒防止装置を備えた全方向移動ロボットの図である。It is a figure of the omnidirectional mobile robot provided with the attitude | position holding | maintenance / fall prevention apparatus which shows 1st Example of this invention. 第1実施例を示す姿勢保持・転倒防止装置を備えた全方向移動ロボットを下方から見た図である。It is the figure which looked at the omnidirectional mobile robot provided with the attitude | position holding | maintenance / fall prevention apparatus which shows 1st Example from the downward direction. 第1実施例の動作を示す、図1における該当部分の拡大図である。It is an enlarged view of the applicable part in FIG. 1 which shows operation | movement of 1st Example. 本発明の第2実施例を示す姿勢保持・転倒防止装置を備えた移動ロボットの図である。It is a figure of the mobile robot provided with the attitude | position holding | maintenance / fall prevention apparatus which shows 2nd Example of this invention. 第2実施例を示す姿勢保持・転倒防止装置を備えた移動ロボットを下方から見た図である。It is the figure which looked at the mobile robot provided with the attitude | position holding | maintenance / fall prevention apparatus which shows 2nd Example from the downward direction. 第2実施例の構成を示す、図4における該当部分の拡大図である。It is an enlarged view of the applicable part in FIG. 4 which shows the structure of 2nd Example. 第2実施例の動作を示す、図4における該当部分の拡大図である。It is an enlarged view of the applicable part in FIG. 4 which shows operation | movement of 2nd Example. 本発明における判定装置の構成例を示した図である。It is the figure which showed the structural example of the determination apparatus in this invention. 本発明における判定装置の判定の流れおよび対応する動作を示した図である。It is the figure which showed the flow of determination of the determination apparatus in this invention, and corresponding operation | movement. 従来技術1の従動輪による転倒防止策を示した図である。It is the figure which showed the fall prevention measure by the driven wheel of the prior art 1. FIG. 従来技術2のアウトリガによる転倒防止装置を示した図である。It is the figure which showed the fall prevention apparatus by the outrigger of the prior art 2. FIG. 従来技術3のアウトリガによる転倒防止装置を示した図である。It is the figure which showed the fall prevention apparatus by the outrigger of the prior art 3. FIG. 図12の装置の問題点を示した図である。It is the figure which showed the problem of the apparatus of FIG.

符号の説明Explanation of symbols

101 全方向移動ロボット
102 全方向移動台車
103 駆動輪(オムニホイル)
104 モータ
105 傾斜角センサ105
106 直動アクチュエータ
107 支持部材
108 ボールキャスタ
109 図3該当部分
110 ロボットアーム
201 支持多角形
321 転倒方向
322 転倒復帰方向
323 直動アクチュエータ動作方向
411 移動ロボット
412 移動台車
413 駆動輪
414 キャスタ
415 モータ
416 2軸傾斜角センサ105
417 判定装置417
418 通信線
419 図6該当部分
420 ディスプレイ
421 スピーカ
501 支持多角形
601 モータ
602 並行リンク
603 支持リンク
604 従動関節
605 キャスタ
610 転倒方向
711 モータ動作方向
712 支持リンク動作方向
713 復帰方向
101 Omni-directional mobile robot 102 Omni-directional mobile trolley 103 Driving wheel (omni foil)
104 Motor 105 Tilt angle sensor 105
106 linear motion actuator 107 support member 108 ball caster 109 FIG. 3 corresponding portion 110 robot arm 201 support polygon 321 fall direction 322 fall return direction 323 linear motion actuator operation direction 411 mobile robot 412 moving carriage 413 drive wheel 414 caster 415 motor 416 2 Shaft angle sensor 105
417 determination device 417
418 Communication line 419 FIG. 6 corresponding part 420 Display 421 Speaker 501 Support polygon 601 Motor 602 Parallel link 603 Support link 604 Driven joint 605 Castor 610 Overturn direction 711 Motor operation direction 712 Support link operation direction 713 Return direction

Claims (14)

少なくとも1方向への移動能力を有する移動体に搭載されるものであって、前記1方向について前記移動体の水平面に対する傾きおよびこの傾きの方向を検出する傾き角検出装置と、
前記移動体から路面に張り出して前記移動体を支持する支持部材と、
前記支持部材を駆動する支持部材駆動装置と、
得られた傾き角を基準値と比較して前記支持部材駆動装置の動作を決定する判定装置と、
を備えていることを特徴とする移動体の姿勢保持・転倒防止装置。
An inclination angle detection device for detecting an inclination of the moving body with respect to a horizontal plane and the direction of the inclination with respect to the one direction;
A support member that projects from the moving body to the road surface and supports the moving body;
A support member driving device for driving the support member;
A determination device that determines the operation of the support member driving device by comparing the obtained inclination angle with a reference value;
An apparatus for maintaining the posture of a moving body and preventing overturning.
前記判定装置において、前記傾き角検出装置の出力が前記基準値(a)よりも小さな角度に相当する基準値を下回っているときは、前記支持部材を格納することを特徴とする請求項1記載の移動体の姿勢保持・転倒防止装置。   The said determination member WHEREIN: When the output of the said inclination-angle detection apparatus is less than the reference value equivalent to the angle smaller than the said reference value (a), the said supporting member is stored. The posture maintenance and fall prevention device of the moving body. 前記判定装置において、前記傾き角検出装置の出力が前記基準値(a)よりも大きな傾き角度に対応する基準値(b)を上回ったときに、前記傾き角検出装置の出力が前記基準値(b)を下回るまで、前記支持部材を下向きに駆動し続けることを特徴とする請求項1又は2移動体の姿勢保持・転倒防止装置。   In the determination device, when the output of the tilt angle detection device exceeds a reference value (b) corresponding to a tilt angle larger than the reference value (a), the output of the tilt angle detection device is the reference value ( 3. The posture maintaining / falling prevention device for a moving body according to claim 1 or 2, wherein the supporting member is continuously driven downward until it falls below b). 前記判定装置において、前記傾き角検出装置の出力が前記基準値(a)以下であり、かつ前記基準値(b)以上である場合には、前記支持部材を固定することを特徴とする請求項3記載の移動体の姿勢保持・転倒防止装置。   The said determination apparatus WHEREIN: When the output of the said inclination-angle detection apparatus is below the said reference value (a) and more than the said reference value (b), the said supporting member is fixed, The said supporting member is fixed. 3. A posture maintaining / falling prevention device for a moving body according to 3. 前記傾き角検出装置と前記支持部材と前記支持部材駆動装置と前記判定装置とをそれぞれ少なくとも1台以上ずつまとめてユニット化し、前記移動体に自由に取り付けることができるようにした姿勢保持・転倒防止ユニットを構成することを特徴とする請求項1〜4のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   At least one of the tilt angle detection device, the support member, the support member driving device, and the determination device is integrated into a unit so that the posture can be freely attached to the movable body and the fall prevention is performed. The apparatus for maintaining a posture of a moving body and preventing overturning according to claim 1, comprising a unit. 前記姿勢保持・転倒防止ユニットにおいて、前記傾き角検出装置の検出軸の向きが前記支持部材を張り出す方向に直行する向きとなるように前記傾き角検出装置を設置することを特徴とする請求項5記載の移動体の姿勢保持・転倒防止装置。   The tilt angle detection device is installed in the posture holding / falling prevention unit so that a direction of a detection axis of the tilt angle detection device is a direction perpendicular to a direction in which the support member is projected. 5. A posture maintaining / falling prevention device for a moving body according to 5. 前記姿勢保持・転倒防止装置において、傾き角検出装置のみを移動体内部に設け、傾き角検出装置の出力を各判定装置で共有して利用できるようにしたことを特徴とする請求項5又は6記載の移動体の姿勢保持・転倒防止装置。   7. The posture holding / falling prevention device according to claim 5, wherein only the inclination angle detection device is provided inside the moving body so that the output of the inclination angle detection device can be shared and used by each determination device. The mobile body posture maintenance / falling prevention device described. 前記判定装置において、少なくとも1方向への傾き角を同時に複数の基準値と比較する判定回路を、複数備えることを特徴とする請求項5〜7のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   The posture determination / moving body according to any one of claims 5 to 7, wherein the determination device includes a plurality of determination circuits that simultaneously compare an inclination angle in at least one direction with a plurality of reference values. Fall prevention device. 前記支持部材を、その動作の向きが移動体の支持多角形の法線方向に一致するように設置することを特徴とする請求項5〜8のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   The posture of the moving body according to any one of claims 5 to 8, wherein the support member is installed so that the direction of movement thereof coincides with a normal direction of a support polygon of the moving body. Fall prevention device. 前記支持部材及び支持部材駆動装置を移動体の鉛直中心軸に関して対称な位置に設置することを特徴とする請求項5〜9のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   The apparatus for holding and preventing overturning of the moving body according to any one of claims 5 to 9, wherein the supporting member and the supporting member driving device are installed at positions symmetrical with respect to the vertical center axis of the moving body. 前記支持部材を並行リンクで構成し、前記支持部材駆動装置をモータとモータ駆動回路とによって構成することを特徴とする請求項5〜10のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   The posture support / falling prevention of the movable body according to any one of claims 5 to 10, wherein the support member is configured by a parallel link, and the support member drive device is configured by a motor and a motor drive circuit. apparatus. 前記判定装置において、傾き角検出装置の出力にかかわらず、移動体の転倒危険性が高まるとあらかじめ予想される場合は手動で支持部材を張り出すことができるようにしたことを特徴とする請求項5〜11のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   In the determination apparatus, the support member can be manually extended when it is predicted in advance that the risk of falling of the moving body is increased regardless of the output of the inclination angle detection apparatus. The mobile body posture maintaining / falling prevention device according to any one of 5 to 11. 前記支持部材において、その設置位置を移動体の支持多角形の各辺の垂直二等分線上とすることを特徴とする請求項5〜12のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   In the said supporting member, the installation position is made into the perpendicular bisector of each edge | side of the support polygon of a moving body, The attitude | position holding | maintenance of a moving body and fall of any one of Claims 5-12 characterized by the above-mentioned. Prevention device. 前記支持部材の路面に向かって張り出す角度を、従来装置が路面に対して45度近辺であったのに対して大幅に垂直に近づけたことを特徴とする請求項5〜13のいずれか1項記載の移動体の姿勢保持・転倒防止装置。   14. The angle of projecting toward the road surface of the support member is substantially perpendicular to the conventional apparatus, which is close to 45 degrees with respect to the road surface. 4. A device for maintaining the posture of the moving body and preventing overturning.
JP2004234440A 2004-08-11 2004-08-11 Positioning / falling prevention device for moving objects Expired - Fee Related JP4285360B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004234440A JP4285360B2 (en) 2004-08-11 2004-08-11 Positioning / falling prevention device for moving objects

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004234440A JP4285360B2 (en) 2004-08-11 2004-08-11 Positioning / falling prevention device for moving objects

Publications (2)

Publication Number Publication Date
JP2006053731A true JP2006053731A (en) 2006-02-23
JP4285360B2 JP4285360B2 (en) 2009-06-24

Family

ID=36031181

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004234440A Expired - Fee Related JP4285360B2 (en) 2004-08-11 2004-08-11 Positioning / falling prevention device for moving objects

Country Status (1)

Country Link
JP (1) JP4285360B2 (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011062094A1 (en) * 2009-11-20 2011-05-26 村田機械株式会社 Autonomous mobile body and control method of same
JP2011108130A (en) * 2009-11-20 2011-06-02 Murata Machinery Ltd Autonomous mobile body and control method therefor
KR101151273B1 (en) * 2012-03-08 2012-06-14 오세진 Robot with balancing function Robot with balancing function
US20120283872A1 (en) * 2011-05-02 2012-11-08 Hstar Technologies System for Stabilization Control of Mobile Robotics
JP2014046890A (en) * 2012-09-03 2014-03-17 Araki Seisakusho:Kk Omnidirectional moving truck having power assist function
CN108216153A (en) * 2016-12-22 2018-06-29 通用电气公司 For the system and method for leveling trailer
CN111714210A (en) * 2020-06-30 2020-09-29 深圳市精锋医疗科技有限公司 Surgical robot, and control device and control method thereof
WO2022050010A1 (en) * 2020-09-03 2022-03-10 Thk株式会社 Travel unit and article display robot

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8948956B2 (en) 2009-11-20 2015-02-03 Murata Machinery, Ltd. Autonomous mobile body and control method of same
JP2011108129A (en) * 2009-11-20 2011-06-02 Murata Machinery Ltd Autonomous mobile body and control method therefor
JP2011108130A (en) * 2009-11-20 2011-06-02 Murata Machinery Ltd Autonomous mobile body and control method therefor
WO2011062094A1 (en) * 2009-11-20 2011-05-26 村田機械株式会社 Autonomous mobile body and control method of same
US8886385B2 (en) 2009-11-20 2014-11-11 Murata Machinery, Ltd. Autonomous mobile body and control method of same
US20120283872A1 (en) * 2011-05-02 2012-11-08 Hstar Technologies System for Stabilization Control of Mobile Robotics
US9440357B2 (en) * 2011-05-02 2016-09-13 John Hu System for stabilization control of mobile robotics
KR101151273B1 (en) * 2012-03-08 2012-06-14 오세진 Robot with balancing function Robot with balancing function
JP2014046890A (en) * 2012-09-03 2014-03-17 Araki Seisakusho:Kk Omnidirectional moving truck having power assist function
CN108216153A (en) * 2016-12-22 2018-06-29 通用电气公司 For the system and method for leveling trailer
CN111714210A (en) * 2020-06-30 2020-09-29 深圳市精锋医疗科技有限公司 Surgical robot, and control device and control method thereof
CN111714210B (en) * 2020-06-30 2024-02-13 深圳市精锋医疗科技股份有限公司 Surgical robot, control device and control method thereof
WO2022050010A1 (en) * 2020-09-03 2022-03-10 Thk株式会社 Travel unit and article display robot

Also Published As

Publication number Publication date
JP4285360B2 (en) 2009-06-24

Similar Documents

Publication Publication Date Title
JP4824492B2 (en) Mobile robot
JP6177400B1 (en) Crane truck
US10343740B2 (en) Traveling apparatus
JP4285360B2 (en) Positioning / falling prevention device for moving objects
JP2013052948A (en) Safety device for vehicle for high lift work
WO2018074117A1 (en) Moving device and moving device management system
JP7435819B2 (en) crane
JPH11301994A (en) Work range regulating device for track traveling work wagon
JP4068042B2 (en) Work vehicle control device
JP4658463B2 (en) Control equipment for aerial work platforms
JP4986108B2 (en) Seismic derailment prevention system using a spreader
JP4744664B2 (en) Control device for working machine with boom
JP4021529B2 (en) Control device for work equipment
JP4538309B2 (en) Railroad work vehicle
JP2009297876A (en) Wheel robot
JP2003165700A (en) Boom automatic housing device
JP2000327296A (en) Track traveling type high lift work vehicle
JP2002234699A (en) Working vehicle
JP3712568B2 (en) Work vehicle operation restriction device
JP3808682B2 (en) Control equipment for aerial work platforms
JP3869285B2 (en) Overturn prevention device for aerial work platforms
JP4766753B2 (en) Second telescopic boom operating range regulating device for aerial work platforms
JP2001206692A (en) Controller for high-lift working vehicle
JP4731895B2 (en) Control equipment for aerial work platforms
JP2001206690A (en) Control device for high-lift work vehicle

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20060327

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20070710

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20071127

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20080715

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20080723

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20080922

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: 20090303

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20090316

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120403

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120403

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130403

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140403

Year of fee payment: 5

LAPS Cancellation because of no payment of annual fees