Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7489353B2 - Robot control device and mobile robot using the same - Google Patents
[go: Go Back, main page]

JP7489353B2 - Robot control device and mobile robot using the same - Google Patents

Robot control device and mobile robot using the same Download PDF

Info

Publication number
JP7489353B2
JP7489353B2 JP2021079454A JP2021079454A JP7489353B2 JP 7489353 B2 JP7489353 B2 JP 7489353B2 JP 2021079454 A JP2021079454 A JP 2021079454A JP 2021079454 A JP2021079454 A JP 2021079454A JP 7489353 B2 JP7489353 B2 JP 7489353B2
Authority
JP
Japan
Prior art keywords
steering
robot
control device
wheels
pair
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2021079454A
Other languages
Japanese (ja)
Other versions
JP2022173637A (en
Inventor
智明 照沼
亮介 中村
雅俊 芝崎
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.)
Hitachi Building Systems Co Ltd
Original Assignee
Hitachi Building Systems Co Ltd
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 Hitachi Building Systems Co Ltd filed Critical Hitachi Building Systems Co Ltd
Priority to JP2021079454A priority Critical patent/JP7489353B2/en
Publication of JP2022173637A publication Critical patent/JP2022173637A/en
Application granted granted Critical
Publication of JP7489353B2 publication Critical patent/JP7489353B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は自律的に移動するロボットを制御するロボット制御装置に係り、特に車輪を利用して移動するロボットのロボット制御装置、及びこれを使用した移動ロボットに関する。 The present invention relates to a robot control device that controls an autonomously moving robot, and in particular to a robot control device for a robot that moves using wheels, and a mobile robot that uses the same.

近年、荷物を搬送する搬送用ロボット、建物内の経路に沿って訪問者を案内する案内用ロボット、及び建物周辺や所定の敷地内の状況を監視する監視用ロボットなど、自律的に移動するロボットが利用されている。 In recent years, autonomously moving robots have come into use, such as transport robots that transport luggage, guide robots that guide visitors along routes within a building, and surveillance robots that monitor the conditions around a building or within a given site.

このような移動ロボットは、走行すべき領域の地図情報や移動経路情報等を予め記憶しており、外部のロボット管理サーバから通信を介して指示を受けたり、スイッチ、レバー、及びボタン等の操作手段を介して操作者から動作開始の指示を受けたりすると、その指示に応答してカメラ、障害物センサ、GPSセンサ等(以下単にセンサとして表記する)から取得した各種センサ情報を利用し、駆動輪を制御して障害物を避けながら、所定の経路を自律的に移動する。 Such mobile robots store in advance map information of the area they need to travel and travel route information, and when they receive instructions via communication from an external robot management server or instructions to start an operation from an operator via operating means such as switches, levers, and buttons, they respond to the instructions and use various sensor information obtained from cameras, obstacle sensors, GPS sensors, etc. (hereinafter simply referred to as sensors) to control the drive wheels and autonomously move along a predetermined route while avoiding obstacles.

ところで、このような車輪を利用して移動する移動ロボットにおいては、往々にして坂道等の傾斜した経路を走行することがある。このため、何らかの理由で移動ロボットを坂道登坂時等に停止させる場合、坂道の勾配が大きいと移動ロボットの停車状態を維持できず、坂道を後退する恐れがある。このような現象を対策するために、例えば特開2017-205002号公報(特許文献1)においては、電磁ブレーキ機構を備えるようにした移動ロボットが示されている。 However, mobile robots that use wheels to move often travel on inclined paths such as slopes. For this reason, if the mobile robot needs to be stopped for some reason, such as when climbing a slope, there is a risk that the mobile robot will not be able to maintain a stopped state and will roll back up the slope if the slope has a steep gradient. To address this issue, for example, JP 2017-205002 A (Patent Document 1) discloses a mobile robot equipped with an electromagnetic brake mechanism.

特開2017-205002号公報JP 2017-205002 A

特許文献1に示された移動ロボットの構成によれば、坂道で停止する場合には電磁ブレーキ機構を動作させて、移動ロボットが坂道を後退するという現象を防ぐことができる。 According to the configuration of the mobile robot shown in Patent Document 1, when stopping on a slope, an electromagnetic brake mechanism is activated, preventing the mobile robot from rolling backwards up the slope.

しかしながら、このような移動ロボットにおいては、新たに電磁ブレーキ機構が必要となり、移動ロボットの重量が増加する、製造コストが高くなる等の新たな課題が発生する。このため、電磁ブレーキ機構等の新たな機構類を必要としなく、移動ロボットが坂道で停止された場合でも、移動ロボットが後退することを防止できるロボット制御装置が要請されている。 However, such a mobile robot requires a new electromagnetic brake mechanism, which creates new problems such as an increase in the weight of the mobile robot and higher manufacturing costs. For this reason, there is a demand for a robot control device that does not require new mechanisms such as an electromagnetic brake mechanism and can prevent the mobile robot from moving backward even when the mobile robot is stopped on a slope.

本発明の目的は、電磁ブレーキ機構を装備しなくても、移動ロボットが坂道で停止して坂道を下るのを防止することができるロボット制御装置、及びこれを使用した移動ロボットを提供することにある。 The object of the present invention is to provide a robot control device that can prevent a mobile robot from stopping on a slope and going down the slope without being equipped with an electromagnetic brake mechanism, and a mobile robot using the same.

本発明の特徴は、駆動輪の他に移動ロボットの接地側面に独立して駆動される一対の操舵輪を設け、制動動作が必要な状態では移動ロボットの進行方向に対して、一対の操舵輪の夫々を、制動力を生じるように異なった方向に操舵する、ところにある。 The feature of this invention is that in addition to the drive wheels, a pair of independently driven steering wheels are provided on the ground-contacting side of the mobile robot, and when braking is required, each of the pair of steering wheels is steered in a different direction relative to the direction of travel of the mobile robot so as to generate a braking force.

これによれば、一対の操舵輪の夫々が異なった方向に操舵されるので、操舵輪によって制動力が発生する。したがって、電磁ブレーキ機構を装備せずに、移動ロボットが坂道で停止したとしても、移動ロボットが坂道を下ることを防止することができる。 With this, each of the pair of steering wheels is steered in a different direction, so a braking force is generated by the steering wheels. Therefore, even if the mobile robot stops on a slope without being equipped with an electromagnetic brake mechanism, the mobile robot can be prevented from going down the slope.

本発明が適用されるロボット制御システムの概略図である。1 is a schematic diagram of a robot control system to which the present invention is applied. 図1に示すロボットの制御装置の構成図である。FIG. 2 is a configuration diagram of a control device for the robot shown in FIG. 1 . 本発明が適用される案内用ロボットの前面側斜視図である。1 is a front perspective view of a guide robot to which the present invention is applied; 図3Aに示す案内用ロボットの後面側斜視図である。FIG. 3B is a rear perspective view of the guide robot shown in FIG. 3A. 案内用ロボットの駆動輪と操舵輪の構成を示す外観図である。FIG. 2 is an external view showing the configuration of drive wheels and steering wheels of the guide robot. 操舵輪の駆動機構の操舵動作を説明するための構成図である。FIG. 2 is a configuration diagram for explaining the steering operation of a drive mechanism for steering wheels. 案内用ロボットの「直進モード」での駆動輪と操舵輪の関係を説明する説明図である。FIG. 11 is an explanatory diagram illustrating the relationship between the drive wheels and the steered wheels of the guide robot in a "straight ahead mode." 案内用ロボットの「旋回モード」での駆動輪と操舵輪の関係を説明する説明図である。FIG. 11 is an explanatory diagram illustrating the relationship between the drive wheels and the steered wheels of the guide robot in a "turning mode." 案内用ロボットの「信地旋回モード」での駆動輪と操舵輪の関係を説明する説明図である。FIG. 11 is an explanatory diagram illustrating the relationship between the drive wheels and the steered wheels of the guide robot in a "pivot turn mode." 案内用ロボットの「制動モードA」での駆動輪と操舵輪の関係を説明する説明図である。FIG. 13 is an explanatory diagram illustrating the relationship between the drive wheels and the steered wheels of the guide robot in "braking mode A." 案内用ロボットの「制動モードB」での駆動輪と操舵輪の関係を説明する説明図である。FIG. 13 is an explanatory diagram illustrating the relationship between the drive wheels and the steered wheels of the guide robot in "braking mode B." 夫々の動作モードを実行するための制御フローを示すフローチャートである。4 is a flowchart showing a control flow for executing each operation mode. 停止スイッチが押されたときの制御フローを示すフローチャートである。11 is a flowchart showing a control flow when a stop switch is pressed. 案内用ロボットが持ち上げられたときの制御フローを示すフローチャートである。13 is a flowchart showing a control flow when the guide robot is lifted.

以下、本発明の実施形態について図面を用いて詳細に説明するが、本発明は以下の実施形態に限定されることなく、本発明の技術的な概念の中で種々の変形例や応用例をもその範囲に含むものである。 The following describes in detail an embodiment of the present invention with reference to the drawings. However, the present invention is not limited to the following embodiment, and the scope of the present invention includes various modifications and applications within the technical concept of the present invention.

図1は、ロボット制御システムの構成を示しており、ネットワーク10を介してロボット制御サーバ11に制御指令/応答指令等が送受信されている。ロボット制御サーバ11は、受信した制御指令等に基づいてロボット(ここでは案内用ロボット)12の操作指令を生成し、無線によってロボット制御装置12に操作指令を送信する。この操作指令を受けたロボット制御装置12は、操作指令に基づいて所定の動作(案内動作)をロボットに実行させる。このようなロボット制御システムは、よく知られているので、これ以上の説明は省略する。 Figure 1 shows the configuration of a robot control system, in which control commands, response commands, etc. are sent and received to a robot control server 11 via a network 10. The robot control server 11 generates an operation command for a robot (here, a guide robot) 12 based on the received control commands, etc., and transmits the operation command wirelessly to a robot control device 12. Upon receiving this operation command, the robot control device 12 causes the robot to perform a specified operation (guidance operation) based on the operation command. Such robot control systems are well known, so further explanation will be omitted.

図2は、ロボット制御装置12の構成を示している。ロボット制御装置12は、CPU(演算装置)13、記憶装置14、入出力装置15、通信インターフェース16から構成されている。記憶装置14は、各種の制御プログラムが格納されており、制御プログラムによってCPU13に所定の制御機能を実行させる。このため、制御プログラムは機能ブロックと捉えることができる。 Figure 2 shows the configuration of the robot control device 12. The robot control device 12 is composed of a CPU (computing device) 13, a storage device 14, an input/output device 15, and a communication interface 16. The storage device 14 stores various control programs, and the control programs cause the CPU 13 to execute specific control functions. For this reason, the control programs can be considered as functional blocks.

そして、記憶装置14は、ロボットの移動を制御する移動制御部141、入力情報/出力情報を制御する入出力部142、ロボットの持ち上げを検出する持ち上げ検知部143、ロボットの姿勢を制御する姿勢制御部144、ロボットの駆動輪を制御し、また操舵輪を制御する駆動/操舵制御部145等を備えている。 The storage device 14 also includes a movement control unit 141 that controls the movement of the robot, an input/output unit 142 that controls input information/output information, a lifting detection unit 143 that detects when the robot is lifted, a posture control unit 144 that controls the posture of the robot, and a drive/steering control unit 145 that controls the drive wheels and steering wheels of the robot.

また、入出装置15は、坂道の傾斜を検出する傾斜センサであるジャイロセンサ151、スピーカ152、緊急停止スイッチ153、移動制御機構154、姿勢制御機構155、駆動/操舵輪制御機構156等を備えている。尚、これ以外にも、操作者にロボットが持ち上げられたことを検出する対地接触センサ等の信号が入力される。 The entry/exit device 15 also includes a gyro sensor 151, which is an inclination sensor that detects the inclination of a slope, a speaker 152, an emergency stop switch 153, a movement control mechanism 154, an attitude control mechanism 155, a drive/steering wheel control mechanism 156, etc. In addition to these, signals from a ground contact sensor and the like are input to detect when the robot is lifted by the operator.

次にロボットの構成や駆動/操舵輪制御機構156の構成について簡単に説明する。図3A、図3Bは本発明が適用される案内用ロボットの外観を示し、おおまかに、頭部HP,胴部/腕部BP,脚部LPとから構成されている。 Next, we will briefly explain the configuration of the robot and the configuration of the drive/steering wheel control mechanism 156. Figures 3A and 3B show the external appearance of a guide robot to which the present invention is applied, and it is roughly composed of a head HP, a torso/arms BP, and legs LP.

図3Aにおいて、頭部HPの前側には、頭部カメラ17、状態応答表示部18が設けられている。胴部/腕部BPには、スピーカ19、前側マイク20F、後側マイク20B、前側胴部カメラ21、前側胴部状態検出センサ22F、脚部LPには、前側脚部状態検出センサ23F、駆動輪24、操舵輪25が設けられている。 In FIG. 3A, a head camera 17 and a status response display unit 18 are provided in front of the head HP. A speaker 19, a front microphone 20F, a rear microphone 20B, a front torso camera 21, and a front torso status detection sensor 22F are provided in the torso/arms BP, and a front leg status detection sensor 23F, drive wheels 24, and steering wheels 25 are provided in the legs LP.

同様に図3Bにおいて、胴部/腕部BPの背面には、背面リング26、後側胴部状態検出センサ22B、給電部27、後側脚部状態検出センサ23B、緊急停止スイッチ28が設けられている。背面リング26は、操作者等によって案内用ロボットを持ち上げて移動させるときの把持機構である。 Similarly, in FIG. 3B, the back surface of the torso/arm BP is provided with a back ring 26, a rear torso state detection sensor 22B, a power supply unit 27, a rear leg state detection sensor 23B, and an emergency stop switch 28. The back ring 26 is a gripping mechanism used by an operator or the like to lift and move the guide robot.

ここで、案内用ロボットの進行方向で前側に位置する一対の駆動輪24は、独立駆動に構成されており、夫々の専用の電動モータで駆動される。そして、直進する場合は一対の駆動輪は同じ回転数に制御され、旋回する場合は、夫々の駆動輪の回転数を個別に制御(旋回内側に比べて旋回外側の回転数を高くする)して旋回を容易にしている。 Here, a pair of drive wheels 24 located at the front in the direction of travel of the guide robot are configured for independent drive and are each driven by a dedicated electric motor. When moving straight, the pair of drive wheels are controlled to have the same rotation speed, and when turning, the rotation speed of each drive wheel is controlled individually (the rotation speed of the outer wheel is made higher than that of the inner wheel) to make turning easier.

また、案内用ロボットの進行方向で後側に位置する一対の操舵輪25も独立して構成されており、夫々の専用の電動モータで対応する操舵輪25の操舵角が制御、駆動される。そして、直進や旋回を行う場合は、夫々の操舵輪25の操舵方向を制御して、直進や旋回を容易にしている。 The pair of steering wheels 25 located at the rear of the guide robot in the direction of travel are also configured independently, and the steering angle of the corresponding steering wheels 25 is controlled and driven by a dedicated electric motor for each. When traveling straight or turning, the steering direction of each steering wheel 25 is controlled to make it easier to travel straight or turn.

図4は、脚部LPの下部に設けた駆動/操舵輪制御機構156の外観を示している。この図は、一対の駆動輪24と一対の操舵輪25の、片側の駆動輪24、及び操舵輪25を示している。駆動/操舵輪制御機構156の前側には駆動輪24が配置されており、この駆動輪24は、駆動用電動モータ(図示せず)によって駆動される。駆動用電動モータは、駆動用電動モータ収納箱29に収納されている。駆動用電動モータの回転はタイミングベルト(図示せず)によって駆動輪24に伝達されている。駆動輪24は安全のためにカバー30によってガードされている。もう一方の駆動輪も同様の構成である。 Figure 4 shows the appearance of the drive/steering wheel control mechanism 156 provided at the bottom of the leg LP. This figure shows one of the drive wheels 24 and the steering wheel 25 of a pair of drive wheels 24 and a pair of steering wheels 25. The drive wheel 24 is disposed in front of the drive/steering wheel control mechanism 156, and this drive wheel 24 is driven by an electric drive motor (not shown). The drive motor is stored in a drive electric motor storage box 29. The rotation of the drive electric motor is transmitted to the drive wheel 24 by a timing belt (not shown). The drive wheel 24 is guarded by a cover 30 for safety. The other drive wheel has a similar configuration.

また、駆動/操舵輪制御機構156の後側には操舵輪25が配置されており、この操舵輪25は、操舵用電動モータ(図示せず)によって操舵される。尚、この操舵輪25は駆動力を発生しない従動輪であるが、駆動輪として用いることもできる。操舵用電動モータは、操舵用電動モータ収納箱31に収納されている。尚、駆動輪として用いる場合は、操舵輪の内部に電動モータを収納して構成することができる。 A steering wheel 25 is disposed behind the drive/steering wheel control mechanism 156, and this steering wheel 25 is steered by a steering electric motor (not shown). Although this steering wheel 25 is a driven wheel that does not generate driving force, it can also be used as a driving wheel. The steering electric motor is stored in a steering electric motor storage box 31. When used as a driving wheel, the electric motor can be stored inside the steering wheel.

操舵用電動モータの回転は、モータ側ギアプーリ32からタイミングベルト33によって操舵側ギアプーリ34、操舵輪25に伝達されている。同様に、もう一方の操舵輪25も同様である。操舵輪25は、両側から板状のフォーク35によって挟まれており、このフォーク35によって軸支されている。 The rotation of the steering electric motor is transmitted from the motor side gear pulley 32 to the steering side gear pulley 34 and the steering wheel 25 by a timing belt 33. The same is true for the other steering wheel 25. The steering wheel 25 is sandwiched on both sides by plate-shaped forks 35 and is supported by these forks 35.

図5は、操舵輪25の操舵動作を説明するもので、操舵用電動モータの出力軸36の端部にはモータ側ギアプーリ32が固定されている。また、操舵輪25を操舵するフォーク35(図4参照)には操舵軸37が固定されており、その先端に操舵側ギアプーリ34が固定されている。モータ側ギアプーリ32と操舵側ギアプーリ34の間には、タイミングベルト33が介在されており、モータ側ギアプーリ32の回転は、タイミングベルト33によって減速されて、操舵側ギアプーリ34に伝達される。操舵側ギアプーリ34が回転されると操舵軸37が回転され、更にフォーク35が回転して操舵を行うことができる。もう一方の操舵輪25も同様の構成である。 Figure 5 explains the steering operation of the steering wheel 25, with a motor-side gear pulley 32 fixed to the end of the output shaft 36 of the steering electric motor. A steering shaft 37 is fixed to a fork 35 (see Figure 4) that steers the steering wheel 25, and a steering-side gear pulley 34 is fixed to the end of the steering shaft 37. A timing belt 33 is interposed between the motor-side gear pulley 32 and the steering-side gear pulley 34, and the rotation of the motor-side gear pulley 32 is decelerated by the timing belt 33 and transmitted to the steering-side gear pulley 34. When the steering-side gear pulley 34 rotates, the steering shaft 37 rotates, which in turn rotates the fork 35, allowing steering. The other steering wheel 25 has a similar configuration.

したがって、案内用ロボットは、独立した一対の駆動輪24を回転することによって移動することができ、また一対の操舵輪25の操舵方向を変えることによって、所定の経路を移動することができる。 The guide robot can therefore move by rotating a pair of independent drive wheels 24, and can move along a predetermined path by changing the steering direction of a pair of steering wheels 25.

ここで、一対の駆動輪24の夫々は、その回転状態を独立して制御され、一対の操舵輪25の夫々は、その操舵方向を独立して制御される。尚、一対の駆動倫24は、進行方向軸線に沿った固定の操舵角に設定されており、操舵角が変わることはない。 Here, the rotation state of each of the pair of drive wheels 24 is controlled independently, and the steering direction of each of the pair of steering wheels 25 is controlled independently. The pair of drive wheels 24 are set to a fixed steering angle along the axis of travel, and the steering angle does not change.

尚、進行方向軸線とは、図6Aに示すように、一対の駆動輪24の回転中心を結んだ回転中心軸線の中点に直交する方向を意味している。 The traveling axis refers to a direction perpendicular to the midpoint of the rotational axis connecting the rotational centers of a pair of drive wheels 24, as shown in FIG. 6A.

次に、案内用ロボットの各種の動作モードにおける一対の駆動輪24と、一対の操舵輪25の動作について説明する。 Next, we will explain the operation of the pair of drive wheels 24 and the pair of steering wheels 25 in various operating modes of the guide robot.

図6Aは「直進モード」を示している。この直進モードにおいては、一対の駆動輪24は同じ回転数で正転方向に駆動される。尚、正転方向は案内用ロボットを進行方向に進める回転方向である。また、一対の操舵輪25も進行方向に沿って駆動輪24と同じ操舵角に制御されている。したがって、直進モードでは案内用ロボットは直進しながら移動することができる。 Figure 6A shows the "straight-line mode." In this straight-line mode, the pair of drive wheels 24 are driven in the forward direction at the same rotation speed. The forward direction is the rotation direction that moves the guide robot in the direction of travel. The pair of steering wheels 25 are also controlled to the same steering angle as the drive wheels 24 along the direction of travel. Therefore, in the straight-line mode, the guide robot can move while moving in a straight line.

図6Bは「旋回モード」(この場合は左旋回)を示している。この旋回モードにおいては、左側の駆動輪24の正転方向の回転数に比べて、右側の駆動輪24の正転方向の回転数が高く制御されている。また、一対の操舵輪25の操舵角は、進行方向軸線に対して右側に「θb」だけ傾けた操舵角に制御されている。したがって、旋回モードでは案内用ロボットは左旋回しながら移動することができる。尚、右旋回の場合は上述した動作の逆となる。 Figure 6B shows the "turning mode" (turning left in this case). In this turning mode, the rotation speed of the right drive wheel 24 in the forward direction is controlled to be higher than the rotation speed of the left drive wheel 24 in the forward direction. In addition, the steering angle of the pair of steering wheels 25 is controlled to be tilted to the right by "θb" with respect to the axis of travel. Therefore, in the turning mode, the guide robot can move while turning left. Note that when turning right, the operation is reversed to that described above.

図6Cは「信地旋回モード」(この場合は移動しないで、その場で左回転)を示している。この信地旋回モードにおいては、一対の駆動輪24の左側の駆動輪24の回転を停止、或いは逆転方向に回転させ、右側の駆動輪24を正転方向に回転させる。 Figure 6C shows the "pivot turn mode" (in this case, turning left on the spot without moving). In this pivot turn mode, the left drive wheel 24 of the pair of drive wheels 24 is stopped from rotating or rotated in the reverse direction, and the right drive wheel 24 is rotated in the forward direction.

また、左側の操舵輪25の操舵角は、進行側が進行方向軸線に対して開くように左側に「θc」だけ傾けた操舵角に制御され、右側の操舵輪25の操舵角は、進行側が進行方向軸線に対して開くように右側に「、θc」だけ傾けた操舵角に制御(いわゆる、逆「ハ」字状)されている。したがって、信地旋回モードでは案内用ロボットはその場で左回転することができる。尚、右回転の場合は、駆動輪24の回転が上述した動作の逆となる。 The steering angle of the left steering wheel 25 is controlled to a steering angle tilted to the left by "θc" so that the traveling side opens up relative to the axis of travel, and the steering angle of the right steering wheel 25 is controlled to a steering angle tilted to the right by ", θc" so that the traveling side opens up relative to the axis of travel (a so-called inverted V-shape). Therefore, in the pivot turn mode, the guide robot can rotate left on the spot. In addition, when rotating right, the rotation of the drive wheels 24 is the opposite of the above-mentioned operation.

図6Dは「ブレーキモードA」を示している。このブレーキモードAは、案内用ロボットが下り坂で停止された場合のモードである。ブレーキモードAにおいては、一対の駆動輪24は、その回転を停止される。 Figure 6D shows "Brake Mode A." This brake mode A is the mode when the guide robot is stopped on a downhill slope. In brake mode A, the pair of drive wheels 24 are stopped from rotating.

また、左側の操舵輪25の操舵角は、進行方向側が進行方向軸線に対して遠ざかり開くように左側に「θd」だけ傾けた操舵角に制御され、右側の操舵輪25の操舵角は、進行方向側が進行方向軸線に対して遠ざかり開くように右側に「θd」だけ傾けた操舵角に制御(いわゆる、逆「ハ」字状)されている。したがって、ブレーキモードAでは操舵輪25によって下り坂に対して制動力が発生することになる。 The steering angle of the left steering wheel 25 is controlled to a steering angle tilted to the left by "θd" so that the side in the direction of travel opens away from the axis of travel, and the steering angle of the right steering wheel 25 is controlled to a steering angle tilted to the right by "θd" so that the side in the direction of travel opens away from the axis of travel (a so-called inverted V-shape). Therefore, in brake mode A, the steering wheel 25 generates a braking force on the downhill slope.

図6Eは「ブレーキモードB」を示している。このブレーキモードBは、案内用ロボットが上り坂で停止された場合のモードである。ブレーキモードBにおいても、一対の駆動輪24は、その回転を停止される。 Figure 6E shows "Brake Mode B." This brake mode B is the mode when the guide robot is stopped on an uphill slope. In brake mode B, the pair of drive wheels 24 also stops rotating.

また、左側の操舵輪25の操舵角は、進行方向側が進行方向軸線に対して近づいて閉じるように右側に「θe」だけ傾けた操舵角に制御され、右側の操舵輪25の操舵角は、進行方向側が進行方向軸線に対して近づいて閉じるように左側に「θe」だけ傾けた操舵角に制御(いわゆる、「ハ」字状)されている。したがって、ブレーキモードでは操舵輪25によって上り坂に対して制動力が発生することになる。 The steering angle of the left steering wheel 25 is controlled to a steering angle tilted to the right by "θe" so that the side in the direction of travel approaches and closes against the axis of travel, and the steering angle of the right steering wheel 25 is controlled to a steering angle tilted to the left by "θe" so that the side in the direction of travel approaches and closes against the axis of travel (a so-called "V" shape). Therefore, in the brake mode, the steering wheel 25 generates a braking force on an uphill slope.

ブレーキモードA、ブレーキモードBにおいては、坂道の傾斜角に応じて操舵角「θd」、「θe」の角度を変えることもできる。例えば、傾斜角度と操舵角を対応付けたテーブルを記憶させておき、傾斜角度が大きくなるほど操舵角を大きくするようにすれば良い。 In brake mode A and brake mode B, the steering angles "θd" and "θe" can be changed according to the inclination angle of the slope. For example, a table that associates the inclination angle with the steering angle can be stored, and the steering angle can be increased as the inclination angle increases.

また、ブレーキモードA、ブレーキモードBは、案内用ロボットが下り坂、或いは上り坂で停止されたときに選択されるものである。案内用ロボットが下り坂で停止された場合は、ブーキモードAを使用し、案内用ロボットが上り坂で停止された場合は、ブレーキモードBを使用すると、制動力を有効に利用することができる。 Brake mode A and brake mode B are selected when the guide robot is stopped on a downhill or uphill slope. If the guide robot is stopped on a downhill slope, brake mode A is used, and if the guide robot is stopped on an uphill slope, brake mode B is used, allowing the braking force to be used effectively.

尚、ブレーキモードA、ブレーキモードBは、案内用ロボットが下り坂、或いは上り坂で停止されたときにおいても、十分な制動力が得られる場合は、どちらか一方を使用することもできる。 In addition, either brake mode A or brake mode B can be used when the guide robot is stopped on a downhill or uphill slope if sufficient braking force can be obtained.

また、上記した実施形態では、駆動輪24は一対の駆動輪を使用して、操舵輪25と併せて四輪としているが、駆駆動輪24を一個だけにして、三輪とすることもできる。この場合においても、操舵輪25の動作は上述の動作を実行するものである。 In addition, in the above embodiment, a pair of drive wheels 24 are used, and together with the steering wheels 25, a total of four wheels are formed, but it is also possible to use only one drive wheel 24, making a total of three wheels. Even in this case, the steering wheels 25 perform the operations described above.

次に、図7に基づいて上述した各種のモードを実行する制御フローについて説明する。この制御フローはCPU13で実行されるものである。 Next, the control flow for executing the various modes described above will be described with reference to FIG. 7. This control flow is executed by the CPU 13.

≪ステップS10≫
ステップS10においては、速度指令が「0」かどうかを判断している。つまり、案内用ロボットを前進させるための速度指令があるかどうかを判定している。そして、速度指令がある場合は、案内用ロボットを移動させる状態と判断し、速度指令がない場合は、案内用ロボットを停止させる状態と判断する。速度指令が「0」でないとステップS11に移行し、速度指令が「0」であるとステップS14に移行する。
<Step S10>
In step S10, it is determined whether the speed command is "0". In other words, it is determined whether there is a speed command to move the guide robot forward. If there is a speed command, it is determined that the guide robot is in a state to move, and if there is no speed command, it is determined that the guide robot is in a state to stop. If the speed command is not "0", the process proceeds to step S11, and if the speed command is "0", the process proceeds to step S14.

≪ステップS11≫
ステップS10で速度指令が「0」でないと判断されているので、ステップS11においては、旋回角度指令が「0」かどうかを判断している。これは、旋回動作を行うか、直進動作を行うかを判定している。そして、旋回角度指令がある場合は、案内用ロボットを旋回させる状態と判断し、旋回角度指令がない場合は、案内用ロボットを直進させる状態と判断する。旋回角度指令が「0」でないとステップS12に移行し、旋回角度指令が「0」であるとステップS13に移行する。
<Step S11>
Since it is determined in step S10 that the speed command is not "0", in step S11 it is determined whether the turning angle command is "0". This determines whether to perform a turning operation or a straight movement. If there is a turning angle command, it is determined that the guide robot is in a state to turn, and if there is no turning angle command, it is determined that the guide robot is in a state to move straight. If the turning angle command is not "0", the process proceeds to step S12, and if the turning angle command is "0", the process proceeds to step S13.

≪ステップS12≫
ステップS12においては、旋回モードを実行する。この旋回モードにおいては、図6Bにあるように、一方の駆動輪24の正転方向の回転数に比べて、他方の駆動輪24の正転方向の回転数を高く制御して旋回を実行する。同時に、旋回方向に向けて一対の操舵輪25が、旋回方向に対応した操舵角に制御される。これによって、旋回モードでは案内用ロボットは旋回しながら移動することができる。
<Step S12>
In step S12, a turning mode is executed. In this turning mode, as shown in Fig. 6B, the rotation speed of one driving wheel 24 in the forward direction is controlled to be higher than the rotation speed of the other driving wheel 24 in the forward direction to execute turning. At the same time, the pair of steering wheels 25 facing the turning direction are controlled to a steering angle corresponding to the turning direction. This allows the guide robot to move while turning in the turning mode.

≪ステップS13≫
ステップS13においては、直進モードを実行する。この直進モードにおいては、図6Aにあるように、一対の駆動輪24は同じ回転数で正転方向に駆動される。また、一対の操舵輪25も進行方向に沿って駆動輪24と同じ操舵角に制御されている。これによって、直進モードでは案内用ロボットは直進しながら移動することができる。
<Step S13>
In step S13, the straight-line mode is executed. In this straight-line mode, as shown in Fig. 6A, the pair of drive wheels 24 are driven in the forward direction at the same rotation speed. In addition, the pair of steering wheels 25 are also controlled to have the same steering angle as the drive wheels 24 along the traveling direction. This allows the guide robot to move in a straight line in the straight-line mode.

≪ステップS14≫
ステップS10で速度指令がない状態と判断されているので、ステップS14においては、旋回角度指令が「0」かどうかを判断している。これは、信地旋回動作を行うかどうかを判定している。そして、旋回角度指令がある場合は、案内用ロボットが信地旋回を行う状態と判断し、旋回角度指令がない場合は、信地旋回を行わない状態と判断する。旋回角度指令が「0」でないとステップS15に移行し、旋回角度指令が「0」であるとステップS16に移行する。
<Step S14>
Since it is determined in step S10 that there is no speed command, in step S14 it is determined whether the turning angle command is "0". This is to determine whether or not to perform a pivot turn. If there is a turning angle command, it is determined that the guide robot is in a state to perform a pivot turn, and if there is no turning angle command, it is determined that the guide robot is not in a state to perform a pivot turn. If the turning angle command is not "0", the process proceeds to step S15, and if the turning angle command is "0", the process proceeds to step S16.

≪ステップS15≫
ステップS15においては、信地旋回モードを実行する。この信地旋回モードにおいては、図6Cにあるように、一方の駆動輪24の回転を停止(或いは逆転方向に回転)させ、他方の駆動輪24を正転方向に回転させる。また、一方の操舵輪25と他方の駆動輪24は、進行方向軸線を境にして、案内用ロボットが回転できる操舵角に制御される。これによって、信地旋回モードでは案内用ロボットはその場で回転することができる。
≪ステップS16≫
ステップS14で旋回角度指令がない状態と判断されているので、ステップS16においては、案内用ロボットの実際の速度が「0」かどうかを判断している。これは、案内用ロボットが操作者等によって人為的に押されて移動されているかどうかを判断している。尚、実際の速度は、駆動輪24、或いは操舵輪25の回転をエンコーダで測定することで求められる。そして、実際の速度が「0」でない、すなわち人為的に案内用ロボットが移動されている場合は、ステップS17に移行し、実際の速度が「0」(停止状態)であると、ステップS18に移行する。
<Step S15>
In step S15, the pivot turn mode is executed. In this pivot turn mode, as shown in Fig. 6C, one of the driving wheels 24 is stopped from rotating (or rotated in the reverse direction), and the other driving wheel 24 is rotated in the forward direction. In addition, the steering wheel 25 and the other driving wheel 24 are controlled to a steering angle that allows the guide robot to rotate around the axis of travel. This allows the guide robot to rotate on the spot in the pivot turn mode.
<Step S16>
Since it is determined in step S14 that there is no turning angle command, in step S16 it is determined whether the actual speed of the guide robot is "0". This is to determine whether the guide robot is being moved by being pushed artificially by an operator or the like. The actual speed is obtained by measuring the rotation of the drive wheels 24 or steering wheels 25 with an encoder. If the actual speed is not "0", that is, if the guide robot is being moved artificially, the process proceeds to step S17, and if the actual speed is "0" (stopped state), the process proceeds to step S18.

≪ステップS17≫
ステップS17においては、案内用ロボットの移動を円滑にするため、直進モードを実行する。ただ、この場合の直進モードにおいては、一対の駆動輪24の回転は制御されず、自由に回転できる状態である。また、一対の操舵輪25は進行方向に沿って駆動輪24と同じ操舵角に制御されている。これによって、この直進モードでは案内用ロボットは人為的に押されて直進しながら移動させることができる。
<Step S17>
In step S17, the straight-line mode is executed to allow the guide robot to move smoothly. However, in this straight-line mode, the rotation of the pair of drive wheels 24 is not controlled and they can rotate freely. Also, the pair of steering wheels 25 are controlled to have the same steering angle as the drive wheels 24 along the traveling direction. As a result, in this straight-line mode, the guide robot can be moved in a straight line by being pushed artificially.

≪ステップS18≫
ステップS16で実際の速度が「0」(停止状態)と判断されているので、ステップS17においては、案内用ロボットが坂道で停止しているかどうかを判断している。この場合は、ジャイロセンサ151で検出されたピッチ角度(実傾斜角度)が、所定の閾値(傾斜角度)より大きいかどうかを判断している。そして、所定の閾値(傾斜角度)よりピッチ角度が小さいとステップS17に移行し、所定の閾値(傾斜角度)よりピッチ角度が大きいと、坂道で停止していると判定してステップS19に移行する。尚、ステップS17は既に説明した通りである。
<Step S18>
Since the actual speed is determined to be "0" (stopped state) in step S16, it is determined in step S17 whether the guide robot is stopped on a slope. In this case, it is determined whether the pitch angle (actual tilt angle) detected by the gyro sensor 151 is larger than a predetermined threshold (tilt angle). If the pitch angle is smaller than the predetermined threshold (tilt angle), the process proceeds to step S17, whereas if the pitch angle is larger than the predetermined threshold (tilt angle), it is determined that the guide robot is stopped on a slope and the process proceeds to step S19. Note that step S17 has already been described.

≪ステップS19≫
ステップS19においては、下り坂、或いは上り坂に対応して、ブレーキモードA、或いはブレーキモードBを実行する。本実施形態ではブレーキモードBを実行している。このブレーキモードBにおいては、図6Eにあるように、一対の駆動輪24は、その回転を停止されている。また、操舵輪25の操舵角は、進行側が進行方向軸線に向けて閉じるように傾けた操舵角(θe)に制御される。これによって、ブレーキモードBでは、操舵輪25によって制動力が発生することになる。尚、ブレーキモードAを実行する場合は、操舵輪25の操舵角は、図6Dにあるように、進行側が進行方向軸線に向けて開くように傾けた操舵角(θd)に制御される。
<Step S19>
In step S19, brake mode A or brake mode B is executed depending on whether the road is a downhill or an uphill road. In this embodiment, brake mode B is executed. In brake mode B, as shown in FIG. 6E, the pair of drive wheels 24 are stopped from rotating. The steering angle of the steering wheels 25 is controlled to a steering angle (θe) in which the traveling side is inclined toward the axis of the traveling direction to close. As a result, in brake mode B, a braking force is generated by the steering wheels 25. When brake mode A is executed, the steering angle of the steering wheels 25 is controlled to a steering angle (θd) in which the traveling side is inclined toward the axis of the traveling direction to open, as shown in FIG. 6D.

このように、本実施形態では、駆動輪24の他に案内用ロボットの接地側面に独立して駆動される一対の操舵輪24を設け、制動動作が必要な状態では案内用ロボットの進行方向に対して、一対の操舵輪25の夫々を制動力が発生する異なった方向に操舵している。 In this way, in this embodiment, in addition to the drive wheels 24, a pair of independently driven steering wheels 24 are provided on the ground-contacting side of the guide robot, and when braking is required, each of the pair of steering wheels 25 is steered in a different direction relative to the direction of travel of the guide robot to generate a braking force.

これによれば、一対の操舵輪25の夫々が異なった方向に操舵されるので、操舵輪25によって制動力が発生する。したがって、電磁ブレーキ機構を装備せずに、案内用ロボットが坂道で停止したとしても、案内用ロボットが坂道を下ることを防止することができる。 With this, the pair of steering wheels 25 are steered in different directions, so a braking force is generated by the steering wheels 25. Therefore, even if the guide robot stops on a slope without being equipped with an electromagnetic brake mechanism, the guide robot can be prevented from descending the slope.

以上の説明は、案内用ロボットが坂道に停止したときに、一対の操舵輪25の操舵角を制御して制動力を得ることを説明したが、これ以外の動作環境で制動力を得る場合の動作について説明する。 The above explanation has been about controlling the steering angle of the pair of steering wheels 25 to obtain a braking force when the guide robot stops on a slope, but we will now explain the operation when obtaining a braking force in other operating environments.

図8は、図7のステップS12の旋回モード、或いはステップS13の直進モードを実行している状態で、緊急停止スイッチ28が押されたときの制御フローを示している。この制御フローは、緊急停止スイッチ28の投入によって起動される割込み処理である。 Figure 8 shows the control flow when the emergency stop switch 28 is pressed while the turning mode of step S12 or the straight-line mode of step S13 of Figure 7 is being executed. This control flow is an interrupt process that is started by turning on the emergency stop switch 28.

≪ステップS20≫
案内用ロボットの移動を停止しなければならないような状態が発生すると、安全を確保するため、操作者によって緊急停止スイッチ28が押される。そして、ステップS20においては、この緊急停止スイッチ28がオンかどうかを判断している。緊急停止スイッチ28がオンされていなければ、現在の動作状態を継続する。一方、緊急停止スイッチ28がオンされていれば、ステップS21に移行する。尚この場合は、緊急停止スイッチ28が押されているので、案内用ロボットの移動(駆動輪24の作動)は強制的に停止される。
<Step S20>
When a situation arises in which the movement of the guide robot must be stopped, the operator presses the emergency stop switch 28 to ensure safety. In step S20, it is determined whether the emergency stop switch 28 is on. If the emergency stop switch 28 is not on, the current operating state is continued. On the other hand, if the emergency stop switch 28 is on, the process proceeds to step S21. In this case, since the emergency stop switch 28 has been pressed, the movement of the guide robot (operation of the drive wheels 24) is forcibly stopped.

≪ステップS21≫
ステップS21においては、緊急停止スイッチ28が押された場所が坂道であるかどうかを判断している。この場合は、ジャイロセンサ151で検出されたピッチ角度(実傾斜角度)が、所定の閾値(傾斜角度)より大きいかどうかを判断している。そして、所定の閾値(傾斜角度)よりピッチ角度が小さいとステップS22に移行し、所定の閾値(傾斜角度)よりピッチ角度が大きいと、坂道で停止していると判定してステップS23に移行する。
<Step S21>
In step S21, it is determined whether the place where the emergency stop switch 28 was pressed is a slope. In this case, it is determined whether the pitch angle (actual tilt angle) detected by the gyro sensor 151 is larger than a predetermined threshold (tilt angle). If the pitch angle is smaller than the predetermined threshold (tilt angle), the process proceeds to step S22. If the pitch angle is larger than the predetermined threshold (tilt angle), it is determined that the vehicle is stopped on a slope and the process proceeds to step S23.

≪ステップS22≫
ステップS22においては、操作者によって人為的に案内用ロボットを円滑に移動するため、直進モードを実行する。ただ、この場合の直進モードにおいては、一対の駆動輪24の回転は、制御されず自由に回転ができる状態である。また、一対の操舵輪25は進行方向に沿って駆動輪24と同じ操舵角に制御されている。これによって、この直進モードでは案内用ロボットは人為的に押されて直進しながら移動させることができる。
<Step S22>
In step S22, the straight-line mode is executed so that the operator can move the guide robot smoothly and artificially. However, in this straight-line mode, the rotation of the pair of drive wheels 24 is not controlled and the pair of steering wheels 25 is controlled to the same steering angle as the drive wheels 24 along the traveling direction. As a result, in this straight-line mode, the guide robot can be pushed artificially to move in a straight line.

≪ステップS23≫
ステップS23においては、ブレーキモードA、或いはブレーキモードBを実行する。本実施形態ではブレーキモードBを実行している。このブレーキモードBにおいては、図6Eにあるように、一対の駆動輪24は、その回転を停止される。また、操舵輪25の操舵角は、進行側が進行方向軸線に向けて閉じるように傾けた操舵角(θe)に制御される。これによって、ブレーキモードBでは、操舵輪25によって制動力が発生することになる。尚、ブレーキモードAを実行する場合は、図6Dにあるように、操舵輪25の操舵角は、進行側が進行方向軸線に向けて開くように傾けた操舵角(θd)に制御される。
<Step S23>
In step S23, the brake mode A or the brake mode B is executed. In this embodiment, the brake mode B is executed. In the brake mode B, as shown in FIG. 6E, the pair of drive wheels 24 are stopped from rotating. The steering angle of the steering wheels 25 is controlled to a steering angle (θe) in which the traveling side is inclined toward the axis of the traveling direction to close. As a result, in the brake mode B, a braking force is generated by the steering wheels 25. When the brake mode A is executed, as shown in FIG. 6D, the steering angle of the steering wheels 25 is controlled to a steering angle (θd) in which the traveling side is inclined toward the axis of the traveling direction to open.

このように、本実施形態では、緊急停止スイッチ28が押された場所が坂道であった場合、駆動輪24の作動が停止され、且つ制動動作が必要な状態となるので、案内用ロボットの進行方向に対して一対の操舵輪25の夫々を制動力が発生するように異なった方向に操舵している。 In this way, in this embodiment, if the emergency stop switch 28 is pressed on a slope, the operation of the drive wheels 24 is stopped and braking is required, so that the pair of steering wheels 25 are steered in different directions relative to the direction of travel of the guide robot so that a braking force is generated.

これによれば、一対の操舵輪25の夫々が異なった方向に操舵されるので、操舵輪25によって制動力が発生する。したがって、電磁ブレーキ機構を装備せずに、案内用ロボットが坂道で停止したとしても、案内用ロボットが坂道を後退することを防止することができる。 With this, the pair of steering wheels 25 are steered in different directions, so that braking force is generated by the steering wheels 25. Therefore, even if the guide robot stops on a slope without being equipped with an electromagnetic brake mechanism, the guide robot can be prevented from moving backwards up the slope.

図9は、図7のステップS13の直進モードを実行している状態で、操作者が案内用ロボットを持ち上げて、他の場所(経路)に移動させるときの制御フローを示している。この制御フローは、持ち上げ検知スイッチの投入によって起動される割込み処理である。持ち上げ検知スイッチは、対地接触センサ、背面リング26に設けた持ち上げ検知レバーに連動したスイッチ等を使用することができる。 Figure 9 shows the control flow when the operator lifts the guide robot and moves it to another location (route) while the straight-line mode of step S13 in Figure 7 is being executed. This control flow is an interrupt process that is started by turning on the lifting detection switch. The lifting detection switch can be a ground contact sensor, a switch linked to a lifting detection lever provided on the rear ring 26, or the like.

≪ステップS30≫
ステップS30においては、持ち上げ検知スイッチがオンかどうかを判断している。持ち上げ検知スイッチがオンされていなければ、ステップS31に移行する。一方、持ち上げスイッチがオンされていれば、ステップS32に移行する。
<Step S30>
In step S30, it is determined whether the lifting detection switch is on. If the lifting detection switch is not on, the process proceeds to step S31. On the other hand, if the lifting detection switch is on, the process proceeds to step S32.

≪ステップS31≫
ステップS31においては、現時点で実行している直進モードを継続する。
<Step S31>
In step S31, the currently executed straight ahead mode is continued.

≪ステップS32≫
ステップS32においては、ブレーキモードA、或いはブレーキモードBを実行する。本実施形態ではブレーキモードBが選択されている。このブレーキモードBにおいては、一対の駆動輪24は、その回転を停止される。ブレーキモードBでは、持ち上げた状態では操舵輪25の操舵角は、図6Eに示す進行方向軸線に対して制動力を発生する操舵角に制御されている。この状態でステップS33に移行する。
<Step S32>
In step S32, brake mode A or brake mode B is executed. In this embodiment, brake mode B is selected. In brake mode B, the pair of drive wheels 24 are stopped from rotating. In brake mode B, the steering angle of the steering wheels 25 in the lifted state is controlled to a steering angle that generates a braking force with respect to the traveling axis line shown in FIG. 6E. In this state, the process proceeds to step S33.

≪ステップS33≫
ステップS33においては、持ち上げ検知スイッチがオフに変化したかどうかを判断している。持ち上げ検知スイッチがオンのままだとステップS32に戻り、ステップS32のブレーキモードを継続する。一方、持ち上げスイッチがオフされていれば、ステップS34に移行する。
<Step S33>
In step S33, it is determined whether the lifting detection switch has been turned off. If the lifting detection switch remains on, the process returns to step S32, and the brake mode of step S32 is continued. On the other hand, if the lifting switch has been turned off, the process proceeds to step S34.

≪ステップS34≫
ステップS34においては、案内用ロボットが経路に戻された場所が坂道であるかどうかを判断している。この場合は、ジャイロセンサ151で検出されたピッチ角度(実傾斜角度)が、所定の閾値(傾斜角度)より大きいかどうかを判断している。
<Step S34>
In step S34, it is determined whether the location where the guide robot has been returned to the route is a slope. In this case, it is determined whether the pitch angle (actual tilt angle) detected by the gyro sensor 151 is greater than a predetermined threshold value (tilt angle).

そして、所定の閾値(傾斜角度)よりピッチ角度が小さいとステップS31に移行して、操作者によって戻された経路を移動するため、ブレーキモードBから直進モードに変更されて直進モードを実行する。一方、所定の閾値(傾斜角度)よりピッチ角度が大きいと、坂道(上り坂)で戻されたと判定してステップS35に移行する。 If the pitch angle is smaller than a predetermined threshold (inclination angle), the process proceeds to step S31, where the mode is changed from brake mode B to straight ahead mode and the straight ahead mode is executed in order to travel along the route returned by the operator. On the other hand, if the pitch angle is larger than the predetermined threshold (inclination angle), it is determined that the return was made on a slope (uphill), and the process proceeds to step S35.

≪ステップS35≫
ステップS35においては、ブレーキモードBを継続して実行する。このブレーキモードBにおいては、図6Eにあるように、一対の駆動輪24は、その回転を停止される。また、操舵輪25の操舵角は、進行側が進行方向軸線に向けて閉じるように傾けた操舵角(θe)に制御される。これによって、ブレーキモードBでは、操舵輪25によって制動力が発生することになる。尚、下り坂に戻された判定された場合は、ブレーキモードBからブレーキモードAに変更されて、ブレーキモードAを実行する。
<Step S35>
In step S35, the brake mode B is continued. In this brake mode B, as shown in Fig. 6E, the pair of drive wheels 24 are stopped from rotating. Also, the steering angle of the steering wheels 25 is controlled to a steering angle (θe) in which the forward side is inclined toward the axis of travel. As a result, in the brake mode B, a braking force is generated by the steering wheels 25. If it is determined that the vehicle has returned to a downhill slope, the brake mode B is changed to the brake mode A, and the brake mode A is executed.

このように、本実施形態では、案内用ロボットが戻された場所が坂道であった場合、駆動輪24の作動が停止され、且つ制動動作が必要な状態となるので、案内用ロボットの進行方向に対して一対の操舵輪25の夫々を制動力が発生する異なった方向に操舵している。 In this embodiment, if the location to which the guide robot is returned is a slope, the operation of the drive wheels 24 is stopped and a braking operation is required, so the pair of steering wheels 25 are steered in different directions relative to the direction of travel of the guide robot to generate a braking force.

これによれば、一対の操舵輪25の夫々が異なった方向に操舵されるので、操舵輪25によって制動力が発生する。したがって、電磁ブレーキ機構を装備せずに、案内用ロボットが坂道で停止したとしても、案内用ロボットが坂道を後退することを防止することができる。 With this, the pair of steering wheels 25 are steered in different directions, so that braking force is generated by the steering wheels 25. Therefore, even if the guide robot stops on a slope without being equipped with an electromagnetic brake mechanism, the guide robot can be prevented from moving backwards up the slope.

以上述べたように、本発明によれば、駆動輪の他に移動ロボットの接地側面に独立して駆動される一対の操舵輪を設け、制動動作が必要な状態では移動ロボットの進行方向に対して、一対の操舵輪の夫々を、制動力を生じるように異なった方向に操舵する構成としている。 As described above, according to the present invention, in addition to the drive wheels, a pair of independently driven steering wheels are provided on the ground-contacting side of the mobile robot, and when braking is required, each of the pair of steering wheels is steered in a different direction relative to the direction of travel of the mobile robot so as to generate a braking force.

これによれば、一対の操舵輪の夫々が異なった方向に操舵されるので、操舵輪によって制動力が発生する。したがって、電磁ブレーキ機構を装備せずに、移動ロボットが坂道で停止したとしても、移動ロボットが坂道を下ることを防止することができる。 With this, each of the pair of steering wheels is steered in a different direction, so a braking force is generated by the steering wheels. Therefore, even if the mobile robot stops on a slope without being equipped with an electromagnetic brake mechanism, the mobile robot can be prevented from going down the slope.

尚、本発明は上記したいくつかの実施例に限定されるものではなく、様々な変形例が含まれる。上記の実施例は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施例の構成の一部を他の実施例の構成に置き換えることが可能であり、ある実施例の構成に他の実施例の構成を加えることも可能である。各実施例の構成について、他の構成の追加、削除、置換をすることも可能である。 The present invention is not limited to the above-mentioned embodiments, but includes various modified examples. The above-mentioned embodiments have been described in detail to clearly explain the present invention, and are not necessarily limited to those having all of the configurations described. In addition, it is possible to replace part of the configuration of one embodiment with the configuration of another embodiment, and it is also possible to add the configuration of another embodiment to the configuration of one embodiment. It is also possible to add, delete, or replace other configurations with respect to the configuration of each embodiment.

10…ネットワーク、11…ロボット制御サーバ、12…ロボット制御装置、13…CPU、14…記憶装置、15…入出力装置、16…通信インターフェース、24…駆動輪、25…操舵輪、32…モータ側ギアプーリ、33…タイミングベルト、34…操舵側ギアプーリ、35…フォーク、153…駆動/操舵制御機構。 10...Network, 11...Robot control server, 12...Robot control device, 13...CPU, 14...Storage device, 15...Input/output device, 16...Communication interface, 24...Drive wheel, 25...Steering wheel, 32...Motor side gear pulley, 33...Timing belt, 34...Steering side gear pulley, 35...Fork, 153...Drive/steering control mechanism.

Claims (10)

自律的に移動可能で、少なくとも1個の駆動輪と、一対の独立に操舵角が制御可能な操舵輪を備えた移動ロボットに使用され、前記駆動輪の回転数を制御する回転数制御部と、一対の前記操舵輪の操舵角を制御する操舵角制御部を備えたロボット制御装置において、
前記操舵角制御部は、制動動作が必要な状態では前記移動ロボットの進行方向に対して、一対の前記操舵輪の夫々を、制動力を生じるように異なった方向に操舵すると共に、
前記移動ロボットを人為的に持ち上げる場合では、
前記操舵角制御部は、一対の前記操舵輪の操舵角を、前記移動ロボットの進行方向に対して、制動力を生じる操舵角に予め設定する
ことを特徴とするロボット制御装置。
A robot control device is used for a mobile robot capable of moving autonomously and having at least one drive wheel and a pair of steering wheels whose steering angles can be controlled independently, the robot control device comprising a rotation speed control unit that controls the rotation speed of the drive wheel and a steering angle control unit that controls the steering angle of the pair of steering wheels,
The steering angle control unit steers each of the pair of steering wheels in different directions relative to a traveling direction of the mobile robot when a braking operation is required so as to generate a braking force, and
In the case where the mobile robot is lifted artificially,
The steering angle control unit presets the steering angle of the pair of steering wheels to a steering angle that generates a braking force with respect to the traveling direction of the mobile robot.
A robot control device comprising:
請求項1に記載のロボット制御装置において、
前記制動動作が必要な状態とは、前記移動ロボットが坂道で停止され、前記坂道の傾斜を測定する傾斜センサによって、所定の閾値を超えて前記坂道が傾斜していると判断されたときである
ことを特徴とするロボット制御装置。
2. The robot control device according to claim 1,
A robot control device characterized in that the state in which the braking operation is necessary is when the mobile robot is stopped on a slope and an inclination sensor measuring the inclination of the slope determines that the slope is inclined beyond a predetermined threshold.
請求項2に記載のロボット制御装置において、
前記駆動輪は一対の前記駆動輪からなり、前記駆動輪は、前記移動ロボットの進行方向に沿った固定の操舵角に設定されている
ことを特徴とするロボット制御装置。
The robot control device according to claim 2,
A robot control device according to claim 1, wherein the drive wheels are a pair of drive wheels, and the drive wheels are set at a fixed steering angle along a direction of travel of the mobile robot.
請求項3に記載のロボット制御装置において、
一対の前記駆動輪は、前記移動ロボットの進行方向で前側に配置され、一対の前記操舵輪は、前記移動ロボットの進行方向で後側に配置されている
ことを特徴とするロボット制御装置。
The robot control device according to claim 3,
A robot control device, characterized in that the pair of drive wheels are arranged at the front in the direction of travel of the mobile robot, and the pair of steering wheels are arranged at the rear in the direction of travel of the mobile robot.
請求項4に記載のロボット制御装置において、
一対の前記駆動輪の回転中心を結ぶ回転中心軸線の中点に直交する進行方向軸線を仮定したとき、
前記操舵角制御部は、夫々の前記操舵輪を前記進行方向軸線に対して異なった方向の斜め方向に操舵する
ことを特徴とするロボット制御装置。
The robot control device according to claim 4,
Assuming that the axis of travel is perpendicular to the midpoint of the central axis of rotation connecting the centers of rotation of the pair of drive wheels,
A robot control device characterized in that the steering angle control unit steers each of the steering wheels in a different oblique direction relative to the axis of travel.
請求項5に記載のロボット制御装置において、
前記移動ロボットが下り坂の前記坂道で停止された場合では、
前記操舵角制御部は、夫々の前記操舵輪の進行方向側が前記進行方向軸線に対して遠ざかる方向の斜め方向に操舵角を設定する
ことを特徴とするロボット制御装置。
The robot control device according to claim 5,
When the mobile robot is stopped on a downward slope,
A robot control device, characterized in that the steering angle control unit sets a steering angle in an oblique direction such that the traveling direction side of each of the steered wheels moves away from the traveling direction axis.
請求項5に記載のロボット制御装置において、
前記移動ロボットが上り坂の前記坂道で停止された場合では、
前記操舵角制御部は、夫々の前記操舵輪の進行方向側が前記進行方向軸線に対して近づく方向の斜め方向に操舵角を設定する
ことを特徴とするロボット制御装置。
The robot control device according to claim 5,
When the mobile robot is stopped on an uphill slope,
A robot control device, characterized in that the steering angle control unit sets a steering angle in an oblique direction such that the traveling direction side of each of the steering wheels approaches the traveling direction axis.
請求項4に記載のロボット制御装置において、
前記移動ロボットを人為的に移動させる場合では、
前記操舵角制御部は、一対の前記操舵輪の操舵角を前記駆動輪の操舵角に設定する
ことを特徴とするロボット制御装置。
The robot control device according to claim 4,
In the case where the mobile robot is moved artificially,
The robot control device is characterized in that the steering angle control unit sets the steering angle of the pair of steering wheels to the steering angle of the drive wheels.
請求項1に記載のロボット制御装置において、2. The robot control device according to claim 1,
前記移動ロボットが人為的に持ち上げられた後の接地された状態で、In a grounded state after the mobile robot is artificially lifted,
前記操舵角制御部は、The steering angle control unit is
前記移動ロボットが坂道にいると判断されると、一対の前記操舵輪の操舵角を、前記移動ロボットの進行方向に対して、制動力を生じる操舵角に設定し、when it is determined that the mobile robot is on a slope, the steering angles of the pair of steering wheels are set to steering angles that generate a braking force with respect to a traveling direction of the mobile robot;
前記移動ロボットが前記坂道にいないと判断されると、一対の前記操舵輪の操舵角を前記駆動輪の操舵角に設定するWhen it is determined that the mobile robot is not on the slope, the steering angle of the pair of steering wheels is set to the steering angle of the driving wheels.
ことを特徴とするロボット制御装置。A robot control device comprising:
自律的に移動可能で、一対の独立して回転数が制御可能な駆動輪と、一対の独立して操舵角が制御可能な操舵輪と、一対の前記駆動輪の回転数を制御する回転数制御部、及び一対の前記操舵輪の操舵角を制御する操舵角制御部を備えたロボット制御装置とを備えた移動ロボットであって、A mobile robot capable of moving autonomously, comprising a pair of drive wheels whose rotation speeds can be controlled independently, a pair of steering wheels whose steering angles can be controlled independently, and a robot control device including a rotation speed control unit that controls the rotation speeds of the pair of drive wheels, and a steering angle control unit that controls the steering angle of the pair of steering wheels,
前記ロボット制御装置は、請求項3乃至請求項9のいずれか1つに記載の前記ロボット制御装置であるThe robot control device is the robot control device according to any one of claims 3 to 9.
ことを特徴とする移動ロボット。A mobile robot characterized by:
JP2021079454A 2021-05-10 2021-05-10 Robot control device and mobile robot using the same Active JP7489353B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2021079454A JP7489353B2 (en) 2021-05-10 2021-05-10 Robot control device and mobile robot using the same

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021079454A JP7489353B2 (en) 2021-05-10 2021-05-10 Robot control device and mobile robot using the same

Publications (2)

Publication Number Publication Date
JP2022173637A JP2022173637A (en) 2022-11-22
JP7489353B2 true JP7489353B2 (en) 2024-05-23

Family

ID=84144449

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021079454A Active JP7489353B2 (en) 2021-05-10 2021-05-10 Robot control device and mobile robot using the same

Country Status (1)

Country Link
JP (1) JP7489353B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118419025A (en) * 2024-05-30 2024-08-02 深圳库犸科技有限公司 Mobile device, control method and related device

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004166968A (en) 2002-11-20 2004-06-17 Zojirushi Corp Self-propelled cleaning robot
JP2006247802A (en) 2005-03-14 2006-09-21 Hitachi Ltd Mobile robot
JP2006327566A (en) 2005-04-28 2006-12-07 Equos Research Co Ltd Control device
JP2015217747A (en) 2014-05-15 2015-12-07 株式会社ジェイテクト Control device of vehicle

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3281188B2 (en) * 1994-08-09 2002-05-13 ヤマハ発動機株式会社 Unmanned car
JP2975552B2 (en) * 1995-07-05 1999-11-10 株式会社クラベ Temperature detector

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004166968A (en) 2002-11-20 2004-06-17 Zojirushi Corp Self-propelled cleaning robot
JP2006247802A (en) 2005-03-14 2006-09-21 Hitachi Ltd Mobile robot
JP2006327566A (en) 2005-04-28 2006-12-07 Equos Research Co Ltd Control device
JP2015217747A (en) 2014-05-15 2015-12-07 株式会社ジェイテクト Control device of vehicle

Also Published As

Publication number Publication date
JP2022173637A (en) 2022-11-22

Similar Documents

Publication Publication Date Title
EP2535247B1 (en) Coaxial two-wheel vehicle and method for controlling same
US11498205B2 (en) All wheel drive robotic vehicle with steering brake
CN107589741B (en) Autonomous moving body and motion control method for autonomous moving body
US20060231302A1 (en) Power assisted steering for motorized pallet truck
US10906601B2 (en) Passenger vehicle
JP2010526726A (en) Toberless aircraft tag
WO2016199312A1 (en) Autonomous movement system
EP3900509A1 (en) Field operation vehicle
JP2002225741A (en) Motor vehicle
US6971470B2 (en) Control system for material handling vehicle with dual control handles
CN109835326A (en) For assisting executing the method and mechanism of the reversing turn control of vehicle
JP7489353B2 (en) Robot control device and mobile robot using the same
US20230047500A1 (en) Inclination control system for tracked vehicle
WO2020183988A1 (en) Work vehicle
JP7452127B2 (en) Autonomous mobile device and autonomous mobile device control method
JP7652122B2 (en) Travel control device for omnidirectional mobile body
JP3032407B2 (en) Self-driving vehicles
JP7700608B2 (en) Steering control device for electric vehicle
JP4888451B2 (en) Coaxial motorcycle and control method thereof
JPH11116200A (en) Reach type forklift
JP2004058730A (en) Steering system
JP4283200B2 (en) Vehicle steering control device
JPH10226497A (en) Traveling device for traveling trolley
JP2007087145A (en) Movement device
HK1195289B (en) Towbarless airplane tug

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230608

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240109

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20240110

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240125

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240513

R150 Certificate of patent or registration of utility model

Ref document number: 7489353

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150