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
JP7162452B2 - moving body - Google Patents
[go: Go Back, main page]

JP7162452B2 - moving body - Google Patents

moving body Download PDF

Info

Publication number
JP7162452B2
JP7162452B2 JP2018116399A JP2018116399A JP7162452B2 JP 7162452 B2 JP7162452 B2 JP 7162452B2 JP 2018116399 A JP2018116399 A JP 2018116399A JP 2018116399 A JP2018116399 A JP 2018116399A JP 7162452 B2 JP7162452 B2 JP 7162452B2
Authority
JP
Japan
Prior art keywords
area
obstacle
crawler
zone
travel
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
JP2018116399A
Other languages
Japanese (ja)
Other versions
JP2019219877A (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.)
Topy Industries Ltd
Original Assignee
Topy Industries 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 Topy Industries Ltd filed Critical Topy Industries Ltd
Priority to JP2018116399A priority Critical patent/JP7162452B2/en
Publication of JP2019219877A publication Critical patent/JP2019219877A/en
Application granted granted Critical
Publication of JP7162452B2 publication Critical patent/JP7162452B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Description

本発明は、互いに直交する二方向に走行可能な移動体における、障害物を回避する走行制御に関する。 BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to travel control for avoiding obstacles in a mobile body capable of traveling in two mutually orthogonal directions.

後記の特許文献1は、移動体を自動的に走行制御する方法を開示している。この方法では、初期位置から目的位置までの地図を多数の区域に細分化し、これら区域の障害物の情報を得て、障害物が無い最適経路を予め演算し、この経路に沿って移動体を走行制御するようになっている。 Patent Literature 1 described later discloses a method for automatically controlling travel of a moving body. In this method, a map from an initial position to a target position is subdivided into a large number of areas, information on obstacles in these areas is obtained, an optimal obstacle-free route is preliminarily calculated, and a moving body is moved along this route. It is designed to control running.

後記の特許文献2、3は、互いに直交する二方向に走行可能なロボット(移動体)を開示している。このロボットは、二方向のうちの一方の方向に延びるとともに当該一方の方向と直交する他の方向に離間した一対のクローラ装置を備えている。各クローラ装置は、上記一方の方向に延びる回転軸線を中心に回転可能なクローラユニットを有している。このクローラユニットは、上記一方の方向に延びるサポートと、このサポートに設けられ上記回転軸線を挟んで対峙する一対のクローラ部とを備えている。 Patent Documents 2 and 3, which will be described later, disclose robots (moving bodies) that can travel in two mutually orthogonal directions. This robot includes a pair of crawler devices extending in one of two directions and spaced apart in the other direction perpendicular to the one direction. Each crawler device has a crawler unit rotatable around a rotation axis extending in the one direction. The crawler unit includes a support extending in one direction, and a pair of crawler portions provided on the support and opposed to each other across the rotation axis.

特許文献2、3のロボットは、上記一対のクローラ装置のクローラ部の駆動により上記一方の方向に走行することができる。以下、この走行モードを「クローラ走行」と言う。
さらに、上記一対のクローラ装置のクローラユニットが上記回転軸線を中心に回転し、上記他の方向に転がる(ローリングする)ことにより、ロボットは上記他の方向に走行することができる。以下、この走行モードを「ローリング走行」と言う。
特許文献2、3のロボットは、クローラ走行とローリング走行を選択することにより、進行方向を直角に転換することができる。
The robots of Patent Documents 2 and 3 can travel in one direction by driving the crawler portions of the pair of crawler devices. Hereinafter, this running mode will be referred to as "crawler running".
Further, the crawler units of the pair of crawler devices rotate about the rotation axis and roll in the other direction, thereby allowing the robot to travel in the other direction. This running mode is hereinafter referred to as "rolling running".
The robots of Patent Literatures 2 and 3 can change their direction of travel to a right angle by selecting crawler travel or rolling travel.

特開2003-29833号公報JP-A-2003-29833 WO2017/006909号公報WO2017/006909 WO2018/008060号公報WO2018/008060

特許文献1に記載の制御方式では、処理すべき情報量が膨大となり、迅速な走行制御を行なえない。また、演算された曲がりくねった経路に沿って移動体を旋回させるため、制御が煩雑であるとともに滑り等が生じ易く、走行に時間がかかる。
本発明者は、特許文献2、3の二方向に走行可能な移動体を用い、その特性を利用して障害物を回避する走行制御の開発を目指してきた。
With the control method described in Patent Document 1, the amount of information to be processed is enormous, and speedy travel control cannot be performed. In addition, since the moving body is turned along the calculated winding route, the control is complicated and slippage and the like are likely to occur, and it takes a long time to travel.
The inventor of the present invention has aimed to develop travel control for avoiding obstacles by using the bidirectional travelable mobile body disclosed in Patent Documents 2 and 3 and utilizing its characteristics.

本発明は上記課題を解決するためになされたもので、ボデイと、このボデイに設けられ互いに直交する二方向に走行可能な走行装置と、障害物を検出するための障害物検出手段と、上記障害物検出手段からの情報に基づき上記走行装置を制御するコントローラと、を備えた移動体において、
上記コントローラは、上記走行装置を制御して上記移動体を上記二方向のうちの第1方向に沿って走行させている状況において、少なくとも、上記移動体が収まる基準区域に隣接する上記第1方向前方の「前」区域と、上記基準区域における上記二方向のうちの第2方向両側に隣接する「左」区域および「右」区域とを設定し、上記障害物検出手段で検出される「前」区域、「左」区域および「右」区域の障害物の情報に基づき、障害物が有る区域を上記移動体が回避するように、上記第1方向と上記第2方向を選択しながら上記走行装置を制御することを特徴とする。
The present invention has been made to solve the above problems, and comprises a body, a traveling device provided on the body and capable of traveling in two directions perpendicular to each other, obstacle detection means for detecting an obstacle, and the above-mentioned object. a controller for controlling the traveling device based on information from the obstacle detection means,
The controller controls the traveling device to cause the moving object to travel along the first direction of the two directions, at least in the first direction adjacent to a reference area in which the moving object is accommodated. A "front" area ahead and a "left" area and a "right" area adjacent to both sides of the second direction of the two directions in the reference area are set, and the "front" area detected by the obstacle detection means is set. zone, 'left' zone, and 'right' zone, the traveling while selecting the first direction and the second direction so that the moving body avoids the zone with the obstacle It is characterized by controlling a device.

上記構成によれば、移動体は、障害物回避の際に、互いに直交する二方向のいずれかを選択して直線的に移動し、実質的に旋回を伴わないので、時間をかけずに確実に障害物を回避しながら自動走行することができる。
また、障害物を検出する区域は、移動体近傍でかつ上記二方向に対応して設定されているので、比較的少ない情報で演算処理を迅速に行なえ、この点からも、時間をかけずに確実に障害物を回避しながら自動走行することができる。
According to the above configuration, when avoiding an obstacle, the moving body selects one of the two directions perpendicular to each other and moves linearly without substantially turning. It can automatically run while avoiding obstacles.
In addition, since the area for detecting obstacles is set in the vicinity of the moving object and corresponding to the above two directions, arithmetic processing can be performed quickly with relatively little information. It can drive automatically while avoiding obstacles.

好ましくは、上記コントローラは、上記移動体を上記第1方向に沿って走行させている状況において、さらに、上記「前」区域と上記「左」区域に隣接する「左前」区域と、上記「前」区域と上記「右」区域に隣接する「右前」区域とを設定し、これら「左前」区域と「右前」区域での障害物の情報も加えて、上記走行装置を制御する。
上記構成によれば、「左前」、「右前」の区域の障害物の情報を用いることにより、前進の可能性を正確に予測することができ、より一層障害物の回避を円滑に行なうことができる。
Preferably, the controller further controls the "front left" zone adjacent to the "front" zone and the "left" zone and the "front ' area and a 'right front' area adjacent to the 'right' area are set, and information on obstacles in these 'left front' and 'right front' areas is also added to control the traveling device.
According to the above configuration, by using the information on the obstacles in the "front left" and "front right" areas, it is possible to accurately predict the possibility of moving forward, and the obstacles can be avoided more smoothly. can.

好ましくは、上記コントローラは、上記移動体を上記第1方向に沿って走行させている状況において、上記「前」区域に障害物があり、上記「左」区域および上記「左前」区域での障害物の有無の状況と、上記「右」区域および上記「右前」区域での障害物の有無の状況とが同等である場合には、左右いずれかの方向を優先して上記移動体を移動させる。
上記構成によれば、予め左右のいずれかを選択しておくことにより、前方に障害物がある時に、迅速に移動方向を選択することができる。
Preferably, in a situation in which the moving body is caused to travel along the first direction, the controller detects that there is an obstacle in the "front" zone, and that there is an obstacle in the "left" zone and the "left front" zone. If the presence/absence of objects and the presence/absence of obstacles in the "right" area and the "right front" area are the same, the moving body is moved with priority given to left or right. .
According to the above configuration, by selecting either left or right in advance, it is possible to quickly select the moving direction when there is an obstacle ahead.

好ましくは、上記「前」区域は、上記第2方向の寸法が上記基準区域と等しく、上記第1方向の寸法が上記基準区域より大きく、上記「左」区域と上記「右」区域は、上記第1方向の寸法が上記基準区域と等しく、上記第2方向の寸法が上記基準区域より大きく、上記「左前」区域と上記「右前」区域は、上記第1方向の寸法が上記「前」区域の第1方向の寸法と等しく、上記第2方向の寸法が上記「左」区域および上記「右」区域の第2方向の寸法と等しい。
上記構成によれば、障害物を検出する区域を基準区域より広げることにより、移動体が進むべき方向で遭遇する障害物を早期に予測でき、障害物の回避を円滑に行なうことができる。
Preferably, said 'front' zone is equal in dimension in said second direction to said reference zone and greater in dimension in said first direction than said reference zone, and said 'left' zone and said 'right' zone are equal in dimension to said reference zone. The dimension in the first direction is equal to the reference area and the dimension in the second direction is greater than the reference area, and the "front left" area and the "front right" area are the same as the "front" area in the first direction. and said second dimension equals the second dimension of said "left" section and said "right" section.
According to the above configuration, by widening the area in which obstacles are detected from the reference area, it is possible to quickly predict obstacles that the moving body will encounter in the direction in which it should move, and smoothly avoid obstacles.

好ましくは、上記コントローラは、上記移動体を上記第1方向に沿って走行させている状況において、さらに、上記基準区域に隣接する上記第1方向後方の「後」区域を設定し、この「後」区域での障害物の情報も加えて、上記走行装置を制御する。 Preferably, the controller further sets a "rear" area behind the first direction adjacent to the reference area in a situation in which the mobile body is traveling along the first direction, and ” also adds information of obstacles in the area to control the running device.

好ましくは、上記基準区域における上記二方向両側に隣接する区域と、上記基準区域の斜め方向に位置する区域の合計8つの区域が予め設定されており、上記コントローラは、上記移動体の進行すべき方向に応じて、上記8つの区域から、上記「前」区域、「左」区域、「右」区域、「左前」区域、「右前」区域を設定する。 Preferably, a total of eight areas are set in advance, including areas adjacent to both sides of the reference area in two directions and areas located in an oblique direction of the reference area, and the controller controls the movement of the moving object. According to the direction, the "front" area, "left" area, "right" area, "left front" area, and "right front" area are set from the above eight areas.

本発明の具体的態様では、上記走行装置は、上記二方向のうちの一方の方向に延びるとともに、他方の方向に離間した一対のクローラ装置を備え、上記クローラ装置の各々は、上記一方の方向に延びる回転軸線を中心に回転可能にして上記ボデイに支持された円筒形状のクローラユニットを備え、上記クローラユニットは、上記回転軸線方向に延びるサポートと、上記回転軸線方向に延びて上記サポートに支持されるとともに上記回転軸線を挟んで対向配置された一対のクローラ部と、を有し、上記コントローラは、上記クローラ部を回転させることにより、上記一方の方向のクローラ走行を実行し、上記クローラユニットを上記回転軸線を中心に回転させることにより、上記他の方向のローリング走行を実行する。 In a specific aspect of the present invention, the traveling device includes a pair of crawler devices extending in one of the two directions and spaced apart in the other direction, each of the crawler devices extending in the one direction. a cylindrical crawler unit supported by the body so as to be rotatable about a rotation axis extending in the direction of the rotation axis; and a pair of crawler sections arranged opposite to each other across the rotation axis, the controller rotating the crawler sections to execute crawler travel in the one direction, and the crawler unit is rotated about the rotation axis to perform rolling travel in the other direction.

本発明によれば、移動体は、時間をかけずに確実に障害物を回避しながら自動走行することができる。 ADVANTAGE OF THE INVENTION According to this invention, a moving body can drive automatically, avoiding an obstacle reliably without taking time.

本発明の第1実施形態に係るロボットと、その周囲に設定された8つの区域を示す概略平面図である。1 is a schematic plan view showing a robot according to a first embodiment of the present invention and eight zones set around it; FIG. 図1においてII方向から見た上記ロボットの概略正面図である。FIG. 2 is a schematic front view of the robot viewed from direction II in FIG. 1; 上記ロボットに用いられるクローラ装置の平断面図である。It is a plane sectional view of the crawler apparatus used for the said robot. ロボットが前進している時の障害物回避制御を示すフローチャートである。4 is a flowchart showing obstacle avoidance control when the robot is moving forward; ロボットが左移動、右移動、後退している時の障害物回避制御を示すフローチャートである。4 is a flow chart showing obstacle avoidance control when the robot is moving left, moving right, and retreating; (A)~(F)は、ロボットが前進している時の障害物回避制御を場合分けして模式的に示す図である。3A to 3F are diagrams schematically showing obstacle avoidance control when the robot is moving forward, divided into different cases; FIG. (A)~(C)は、ロボットが左移動している時の障害物回避制御を場合分けして模式的に示す図である。(A) to (C) are diagrams schematically showing obstacle avoidance control when the robot is moving to the left by different cases. (A)~(C)は、ロボットが右移動している時の障害物回避制御を場合分けして模式的に示す図である。(A) to (C) are diagrams schematically showing obstacle avoidance control for different cases when the robot is moving to the right. (A)、(B)は、ロボットが後退している時の障害物回避制御を場合分けして模式的に示す図である。4(A) and 4(B) are diagrams schematically showing obstacle avoidance control when the robot is moving backward, divided into different cases. FIG.

以下、本発明の一実施形態について図面を参照しながら説明する。図1、図2において互いに直交するX方向とY方向を定める。
図1、図2に示すロボットR(移動体)は、荷物搬送や探査等に用いられるものであり、平面矩形をなすボデイ1と、このボデイ1に内蔵された設けられたコントローラ2(図2にのみ示す)と、ボデイ1のX方向両端部に設けられたレーザー距離センサ3,4(障害物検出手段;図1にのみ示す)と、ボデイ1の下面に設けられた走行装置5と、を備えている。さらにボデイ1には、送受信器、バッテリ等(いずれも図示せず)が内蔵されるとともに、必要に応じてロボットRの向きを検出するための角速度センサやビデオカメラ等が搭載されている。
An embodiment of the present invention will be described below with reference to the drawings. In FIGS. 1 and 2, an X direction and a Y direction which are orthogonal to each other are defined.
A robot R (moving body) shown in FIGS. 1 and 2 is used for cargo transportation, exploration, and the like. ), laser distance sensors 3 and 4 (obstacle detection means; shown only in FIG. 1) provided at both ends of the body 1 in the X direction, a travel device 5 provided on the lower surface of the body 1, It has Further, the body 1 incorporates a transmitter/receiver, a battery, and the like (none of which are shown), and is also equipped with an angular velocity sensor, a video camera, and the like for detecting the orientation of the robot R as required.

レーザー距離センサ3,4は、それぞれ略水平に例えば260°の角度範囲にわたって走査することにより、障害物までの距離情報を得る。コントローラ2は、マイクロコンピュータやインターフェイス等を含み(図2にのみ示す)、後述するようにレーザー距離センサ3,4からの距離情報に基づき、障害物の有無を判断し、走行装置5を制御する。 The laser distance sensors 3 and 4 obtain distance information to obstacles by scanning substantially horizontally over an angular range of, for example, 260°. The controller 2 includes a microcomputer, an interface, etc. (shown only in FIG. 2), determines the presence or absence of obstacles based on distance information from the laser distance sensors 3 and 4, and controls the travel device 5, as will be described later. .

図1、図2に示すように、走行装置5は、互いにY方向に離間した一対のクローラ装置6を有している。
各クローラ装置6はクローラユニット7を有している。このクローラユニット7は、X方向に延びる細長い円筒形状をなしており、後述するようにX方向に延びる第1回転軸線L1を中心として回転可能にボデイ1に支持されている。
As shown in FIGS. 1 and 2, the travel device 5 has a pair of crawler devices 6 spaced apart from each other in the Y direction.
Each crawler device 6 has a crawler unit 7 . The crawler unit 7 has an elongated cylindrical shape extending in the X direction, and is rotatably supported by the body 1 about a first rotation axis L1 extending in the X direction, as will be described later.

図3に示すように、クローラユニット7は、サポ―ト10と、サポ―ト10に設けられた一対のクローラ部20A,20Bと、サポ―ト10に設けられた一対の接地構造30A,30Bと、を有している。 As shown in FIG. 3, the crawler unit 7 includes a support 10, a pair of crawler sections 20A and 20B provided on the support 10, and a pair of grounding structures 30A and 30B provided on the support 10. and have

上記サポ―ト10は、互いに平行をなしX方向(第1回転軸線L1方向)に延びるとともに第1回転軸線L1を挟んで離間対向する一対の細長い側板11,11と、これら側板11,11の一端部に回転可能に連結された第1シャフト12と、側板11,11の他端部に連結された第2シャフト13と、側板11、11の中間部に固定された支持板14とを有している。 The support 10 includes a pair of elongated side plates 11, 11 parallel to each other, extending in the X direction (first rotation axis L1 direction) and opposed to each other with the first rotation axis L1 interposed therebetween. It has a first shaft 12 rotatably connected to one end, a second shaft 13 connected to the other end of the side plates 11 and 11, and a support plate 14 fixed to the intermediate portion of the side plates 11 and 11. is doing.

第1シャフト12と第2シャフト13の中心軸線L2,L2’は、上記第1回転軸線L1と直交し互いに平行をなして延びており、それぞれ後述するスプロケットホイール21,22の回転軸線(第2回転軸線)として提供される。 The central axes L2 and L2' of the first shaft 12 and the second shaft 13 are orthogonal to the first rotation axis L1 and extend parallel to each other, and are the rotation axes (second axes) of the sprocket wheels 21 and 22, respectively, which will be described later. axis of rotation).

上記一対のクローラ部20A,20Bは、一対の側板11間において第1回転軸線L1を挟んで離間対向して配置されている。これらクローラ部20A,20Bの各々は、第1回転軸線L1方向に離れたスプロケットホイール21,22(ホイール)と、これらスプロケットホイール21,22に掛け渡されたチェーン23(無端条体)と、このチェーン23に等間隔をなして固定された例えばゴムからなる多数の接地部材24と、を有している。 The pair of crawler portions 20A and 20B are arranged to face each other with a gap between the pair of side plates 11 with the first rotation axis L1 interposed therebetween. Each of these crawler portions 20A and 20B includes sprocket wheels 21 and 22 (wheels) separated in the direction of the first rotation axis L1, chains 23 (endless strips) stretched over these sprocket wheels 21 and 22, and these A large number of grounding members 24 made of rubber, for example, are fixed to the chain 23 at regular intervals.

一方のクローラ部20Aのスプロケットホイール21は第1シャフト12に直接固定されており、他方のクローラ部20Bのスプロケットホイール21は、後述の傘歯車42bを介して第1シャフト12に固定されている。
一対のクローラ部20A,20Bのスプロケットホイール22,22は、第2シャフト13に回転可能に支持されている。
The sprocket wheel 21 of one crawler section 20A is directly fixed to the first shaft 12, and the sprocket wheel 21 of the other crawler section 20B is fixed to the first shaft 12 via a bevel gear 42b described later.
The sprocket wheels 22, 22 of the pair of crawler portions 20A, 20B are rotatably supported by the second shaft 13. As shown in FIG.

上記一対の接地構造30A,30Bの各々は、第1回転軸線L1方向に間隔をおいて配置された複数(本実施形態では5個)の接地板31を有している。これら接地板31は、例えばゴムからなり、側板11の外面に固定され、側板11と直角をなして第2回転軸線L2,L2’方向に突出している。 Each of the pair of grounding structures 30A and 30B has a plurality of (five in this embodiment) grounding plates 31 spaced apart in the direction of the first rotation axis L1. These ground plates 31 are made of rubber, for example, fixed to the outer surface of the side plate 11, and protrude in the direction of the second rotation axis L2, L2' at right angles to the side plate 11. As shown in FIG.

図2に示すように、上記一対のクローラ部20A,20Bの接地部材24の円弧状をなす外面および上記一対の接地構造30A,30Bの接地板31の円弧状をなす外面が協働して、クローラユニット7の外周に上記第1回転軸線L1を中心とする円筒形状を付与している。 As shown in FIG. 2, the arcuate outer surfaces of the grounding members 24 of the pair of crawler sections 20A and 20B and the arcuate outer surfaces of the grounding plates 31 of the pair of grounding structures 30A and 30B cooperate to achieve The outer periphery of the crawler unit 7 is given a cylindrical shape centered on the first rotation axis L1.

図3において、クローラユニット7の右端部は、ボデイ1に固定されたブラケット40と、このブラケット40に第1回転軸線L1を中心に回転可能に支持されたクローラ駆動シャフト41により、第1回転軸線L1を中心に回転可能に支持されている。このクローラ駆動シャフト41は、第1回転軸線L1に沿って延び、その内端近傍で支持板14に回転可能に支持され、中間部でベアリングを介して第2シャフト13を貫通している。なお、この貫通状態において、クローラ駆動シャフト41の第1回転軸線L1を中心とする回転は許容されている。 In FIG. 3, the right end of the crawler unit 7 is connected to the first rotation axis L1 by a bracket 40 fixed to the body 1 and a crawler drive shaft 41 rotatably supported by the bracket 40 about the first rotation axis L1. It is rotatably supported around L1. The crawler drive shaft 41 extends along the first rotation axis L1, is rotatably supported by the support plate 14 near its inner end, and passes through the second shaft 13 via a bearing at its intermediate portion. Note that, in this penetrating state, rotation of the crawler drive shaft 41 around the first rotation axis L1 is permitted.

クローラ駆動シャフト41の内端部は、第1シャフト12と第2シャフト13との間に配置されており、クローラユニット7内に配置された内部トルク伝達機構42を介して第1シャフト12と接続されている。このトルク伝達機構42は、クローラ駆動シャフト41の内端部に固定された傘歯車42aと、この傘歯車42aと噛み合い第1シャフト12に固定された傘歯車42bとを有している。 The inner end of the crawler drive shaft 41 is arranged between the first shaft 12 and the second shaft 13 and is connected with the first shaft 12 via an internal torque transmission mechanism 42 arranged inside the crawler unit 7 . It is The torque transmission mechanism 42 has a bevel gear 42 a fixed to the inner end of the crawler drive shaft 41 and a bevel gear 42 b fixed to the first shaft 12 and meshing with the bevel gear 42 a.

上記クローラ駆動シャフト41の外端部は、クローラユニット7から突出しており、外部トルク伝達機構55を介してクローラモータ50に接続されている。このクローラモータ50は、ブラケット40に固定されており、正逆回転可能である。クローラモータ50には、このクローラモータ50の回転を検出するロータリーエンコーダ51が取り付けられている。 An outer end portion of the crawler drive shaft 41 protrudes from the crawler unit 7 and is connected to the crawler motor 50 via an external torque transmission mechanism 55 . The crawler motor 50 is fixed to the bracket 40 and can rotate forward and backward. A rotary encoder 51 that detects the rotation of the crawler motor 50 is attached to the crawler motor 50 .

外部トルク伝達機構55は、クローラモータ50の出力軸に固定されたタイミングプーリ55aと、クローラ駆動シャフト41に固定されたタイミングプーリ55bと、これらタイミングプーリ55a,55bに架け渡されたタイミングベルト55cを有している。 The external torque transmission mechanism 55 includes a timing pulley 55a fixed to the output shaft of the crawler motor 50, a timing pulley 55b fixed to the crawler drive shaft 41, and a timing belt 55c stretched between the timing pulleys 55a and 55b. have.

クローラモータ50の回転トルクは、外部トルク伝達機構55を経てクローラ駆動シャフト41に伝達され、さらに傘歯車42a,42bを経てクローラ部20Bのスプロケットホイール21に伝達され、さらに第1シャフト12を介してクローラ部20Aのスプロケットホイール21にも伝達される。これにより、一対のクローラ部20A,20Bが同時に同方向に同速度で回転駆動される。
上記クローラ駆動シャフト41、内部トルク伝達機構42、クローラモータ50および
外部トルク伝達機構55により、クローラ駆動手段が構成されている。
The rotational torque of the crawler motor 50 is transmitted to the crawler drive shaft 41 via the external torque transmission mechanism 55, further transmitted to the sprocket wheel 21 of the crawler section 20B via the bevel gears 42a and 42b, and further via the first shaft 12. It is also transmitted to the sprocket wheel 21 of the crawler portion 20A. As a result, the pair of crawler portions 20A and 20B are rotationally driven simultaneously in the same direction at the same speed.
The crawler drive shaft 41, the internal torque transmission mechanism 42, the crawler motor 50 and the external torque transmission mechanism 55 constitute crawler drive means.

図3において、クローラユニット7の左端部は、ボデイ1に固定されたブラケット45と、このブラケット45に第1回転軸線L1を中心に回転可能に支持されたローリング駆動シャフト46(ローリング駆動部材)により、第1回転軸線L1を中心に回転可能に支持されている。ローリング駆動シャフト46は、第1回転軸線L1に沿って延び、その内端部はベアリングを介して第1シャフト12に連結されている。なお、この連結状態において、第1シャフト12とローリング駆動シャフト46の第1回転軸線L1を中心とする相対回転はできないが、第1シャフト12の第2回転軸線L2を中心とする回転は許容されている。 3, the left end of the crawler unit 7 is supported by a bracket 45 fixed to the body 1 and a rolling drive shaft 46 (rolling drive member) rotatably supported by the bracket 45 about the first rotation axis L1. , are rotatably supported about the first rotation axis L1. The rolling drive shaft 46 extends along the first rotation axis L1, and its inner end is connected to the first shaft 12 via bearings. In this connected state, the first shaft 12 and the rolling drive shaft 46 cannot rotate relative to each other about the first rotation axis L1, but the rotation of the first shaft 12 about the second rotation axis L2 is permitted. ing.

上記ローリング駆動シャフト46の外端部は、クローラユニット7から突出しており、トルク伝達機構65を介してローリングモータ60に接続されている。このローリングモータ60は、ブラケット45に固定されており、正逆回転可能である。ローリングモータ60には、その回転を検出するロータリーエンコーダ61が取り付けられている。 The outer end of the rolling drive shaft 46 protrudes from the crawler unit 7 and is connected to the rolling motor 60 via a torque transmission mechanism 65 . This rolling motor 60 is fixed to the bracket 45 and is rotatable forward and backward. A rotary encoder 61 is attached to the rolling motor 60 to detect its rotation.

トルク伝達機構65は、ローリングモータ60の出力軸に固定されたタイミングプーリ65aと、ローリング駆動シャフト46に固定されたタイミングプーリ65bと、これらタイミングプーリ65a,65bに架け渡されたタイミングベルト65cを有している。 The torque transmission mechanism 65 has a timing pulley 65a fixed to the output shaft of the rolling motor 60, a timing pulley 65b fixed to the rolling drive shaft 46, and a timing belt 65c stretched between the timing pulleys 65a and 65b. is doing.

ローリングモータ60が回転駆動すると、その回転トルクは、トルク伝達機構65を経てローリング駆動シャフト46に伝達され、さらにサポート10の第1シャフト12に伝達されるため、クローラユニット7全体が第1回転軸線L1を中心にして回転する(ローリングする)。
上記ローリング駆動シャフト46、ローリングモータ60およびトルク伝達機構65により,ローリング駆動手段が構成されている。
When the rolling motor 60 is rotationally driven, its rotational torque is transmitted to the rolling drive shaft 46 via the torque transmission mechanism 65 and further transmitted to the first shaft 12 of the support 10, so that the entire crawler unit 7 moves along the first rotation axis. Rotate (roll) around L1.
The rolling drive shaft 46, the rolling motor 60 and the torque transmission mechanism 65 constitute rolling drive means.

上記一対のクローラ装置6によるロボットRの走行について説明する。コントローラ2は、図示しないリモートコントローラからの操作信号を受けてクローラ装置6を制御する。クローラ装置6において、一対のクローラ部20A,20Bが接地された状態で、クローラモータ50を駆動させると、前述したようにクローラ部20A,20Bが同方向に同時に回転駆動し、これにより、ロボットRはX方向に走行することができる(クローラ走行)。 The traveling of the robot R by the pair of crawler devices 6 will be described. The controller 2 controls the crawler device 6 upon receiving an operation signal from a remote controller (not shown). In the crawler device 6, when the crawler motor 50 is driven while the pair of crawler sections 20A and 20B are grounded, the crawler sections 20A and 20B are simultaneously driven to rotate in the same direction as described above. can travel in the X direction (crawler travel).

一対のクローラ装置6のクローラモータ50を同一方向に同一速度で回転することにより、ロボットRはX方向に直進することができる。これらクローラモータ50の回転速度を違えることにより、ロボットRはカーブを描いて走行する(旋回する)こともできる。また、これらクローラモータ50を逆方向に同一速度で回転させることにより、ロボットRはその場旋回(超信地旋回)することもできる。 By rotating the crawler motors 50 of the pair of crawler devices 6 in the same direction at the same speed, the robot R can move straight in the X direction. By varying the rotational speeds of these crawler motors 50, the robot R can travel (rotate) in a curve. Further, by rotating these crawler motors 50 in opposite directions at the same speed, the robot R can also turn on the spot (super pivot turn).

クローラ装置6のローリングモータ60を駆動させると、前述したようにクローラユニット7が第1回転軸線L1を中心に回転(ローリング)する。一対のクローラユニット7が同時に同方向に同速度でローリングすることにより、ロボットRはY方向に移動することができる(ローリング走行)。
ロボットRは、クローラ走行モードおよびローリング走行モードの一方から他方への切り替えにより、超信地旋回することなく、進行方向を直角に転換することができる。
When the rolling motor 60 of the crawler device 6 is driven, the crawler unit 7 rotates (rolls) about the first rotation axis L1 as described above. The pair of crawler units 7 roll simultaneously in the same direction at the same speed, so that the robot R can move in the Y direction (rolling travel).
By switching from one of the crawler travel mode and the rolling travel mode to the other, the robot R can change its traveling direction to a right angle without making a super-pivot turn.

本実施形態のようにクローラモータ50がクローラユニット7の外に配置されている場合には、上記ローリングモータ60のみを駆動させると、クローラ部20A,20Bが回転してしまう。その理由を図3を参照しながら説明する。ローリングモータ60のみを駆動させた場合、クローラユニット7が第1回転軸線L1を中心に回転する。この時、クローラ駆動シャフト41は回転せず静止しているため、傘歯車42bが第1回転軸線L1を中心に公転する。その結果、傘歯車42bは停止状態の傘歯車42aとの噛み合いにより回転軸線L2を中心に自転し、これにより第1シャフト12が回転し、一対のクローラ部20A,20Bが回転駆動される。
したがって、ロボットRをY方向に直進させるためには、クローラ駆動シャフト41をクローラユニット7(またはローリング駆動シャフト46)の回転に合わせて同調回転させる。
When the crawler motor 50 is arranged outside the crawler unit 7 as in the present embodiment, driving the rolling motor 60 alone causes the crawler sections 20A and 20B to rotate. The reason will be described with reference to FIG. When only the rolling motor 60 is driven, the crawler unit 7 rotates around the first rotation axis L1. At this time, since the crawler drive shaft 41 is stationary without rotating, the bevel gear 42b revolves around the first rotation axis L1. As a result, the bevel gear 42b rotates about the rotation axis L2 by meshing with the stopped bevel gear 42a, thereby rotating the first shaft 12 and rotating the pair of crawler portions 20A and 20B.
Therefore, in order to move the robot R straight in the Y direction, the crawler drive shaft 41 is synchronously rotated with the rotation of the crawler unit 7 (or the rolling drive shaft 46).

次に、本発明の特徴部である障害物回避制御について説明する。コントローラ2のメモリには、図1に示すように、ロボットRが位置する基準区域A0が設定されるとともに、基準区域A0の周囲の合計8つの区域A1~A8が設定されている。
基準区域A0は矩形をなしており、ロボットRが余裕をもって収まるサイズを有している。具体的には、基準区域A0のX方向寸法はロボットRのX方向寸法より若干大きく、そのY方向寸法はロボットRのY方向寸法より若干大きい。
Next, obstacle avoidance control, which is a feature of the present invention, will be described. In the memory of the controller 2, as shown in FIG. 1, a reference area A0 in which the robot R is positioned is set, and a total of eight areas A1 to A8 around the reference area A0 are set.
The reference area A0 has a rectangular shape and has a size in which the robot R can be accommodated with sufficient margin. Specifically, the dimension in the X direction of the reference area A0 is slightly larger than the dimension in the X direction of the robot R, and the dimension in the Y direction is slightly larger than the dimension in the Y direction of the robot R.

基準区域A0のX方向両側に隣接する区域A2,A7のY方向寸法は基準区域A0と等しく、X方向寸法は基準区域A0のX方向寸法より大きく、例えば2倍以上の設定倍率(本実施形態では2倍)を乗じた寸法である。
基準区域A0のY方向両側に隣接する区域A4、A5のX方向寸法は基準区域A0と等しく、Y方向寸法は基準区域A0のY方向寸法より大きく、例えば2倍以上の設定倍率(本実施形態では2倍)を乗じた寸法である。
基準区域A0の斜めに位置する4つの区域A1、A3,A6,A8のX方向寸法、Y方向寸法は、基準区域A0のX方向寸法、Y方向寸法にそれぞれ設定倍率を乗じた寸法である。
The Y-direction dimensions of the areas A2 and A7 adjacent to both sides of the reference area A0 in the X direction are equal to that of the reference area A0, and the X-direction dimensions are larger than the X-direction dimension of the reference area A0. is a dimension multiplied by 2 times).
The X-direction dimensions of the areas A4 and A5 adjacent to both sides of the reference area A0 in the Y-direction are equal to the reference area A0, and the Y-direction dimensions are larger than the Y-direction dimension of the reference area A0. is a dimension multiplied by 2 times).
The X-direction dimension and Y-direction dimension of the four areas A1, A3, A6, and A8 located obliquely to the reference area A0 are the dimensions obtained by multiplying the X-direction dimension and Y-direction dimension of the reference area A0 by a set magnification, respectively.

コントローラ2は、レーザー距離センサ3,4からの距離情報を短時間間隔で読み込み、この情報に基づき上記区域での障害物の有無を判断し、ロボットRを二方向(X方向、Y方向)に走行させることにより、障害物を回避しながら自動走行することができる。
なお、レーザー距離センサ3は、区域A1~A5にわたる角度範囲で障害物を検出し、レーザー距離センサ4は、区域A4~A8にわたる角度範囲で障害物を検出する。
The controller 2 reads the distance information from the laser distance sensors 3 and 4 at short intervals, determines the presence or absence of obstacles in the area based on this information, and moves the robot R in two directions (X direction and Y direction). By making it run, it can automatically run while avoiding obstacles.
The laser distance sensor 3 detects obstacles in an angular range covering areas A1 to A5, and the laser distance sensor 4 detects obstacles in an angular range covering areas A4 to A8.

以下、レーザー距離センサ3を前にしてクローラ走行によりX方向に沿って目的地に向かって前進する場合を例にとって、自動走行制御を説明する。この場合、X方向が特許請求の範囲の第1方向に相当し、Y方向が第2方向に相当する。コントローラ2は、図1に示すように、区域A2を「前」区域とし、区域A7を「後」区域とし、区域A4、A5をそれぞれ「左」区域、「右」区域とし、区域A1,A3をそれぞれ「左前」区域、「右前」区域と定める。以下の説明で明らかなように、コントローラ2は、区域A6,A8、すなわち「左後」区域、「右後」区域での障害物の有無は、判断しない。 In the following, automatic travel control will be described by taking as an example a case in which the laser distance sensor 3 is in front of the vehicle and the vehicle advances toward the destination along the X direction by crawler travel. In this case, the X direction corresponds to the first direction, and the Y direction corresponds to the second direction. As shown in FIG. 1, the controller 2 designates the area A2 as the "front" area, the area A7 as the "rear" area, the areas A4 and A5 as the "left" area and the "right" area, respectively, and the areas A1 and A3. are respectively defined as the "left front" area and the "right front" area. As will be apparent from the following description, the controller 2 does not determine the presence or absence of obstacles in the areas A6 and A8, that is, the "rear left" area and the "rear right" area.

図4A,図4Bのフローチャートと図5~図8の模式図を参照しながら説明する走行制御は、原理を容易に理解できるようにするために簡略化されており、前進して最初に遭遇した障害物をその前進方向において越えるまでの制御である。図5~図8の模式図は、図1の9つの区域を示しており、×印は障害物が有ることを示し、〇印は障害物が無いことを示し、無印は障害物の有無を判断対象としないことを示す。
コントローラ2は、「左」区域および「左前」区域の障害物の状況と、「右」区域と「右前」区域の障害物の状況が同等である場合には、左移動を優先的に選択する。
The cruise control described with reference to the flow charts of FIGS. 4A and 4B and the schematic diagrams of FIGS. This is the control until the obstacle is crossed in its advance direction. The schematic diagrams of Figures 5 to 8 show the nine areas in Figure 1, where X indicates that there is an obstacle, O indicates that there is no obstacle, and no indicates the presence or absence of an obstacle. Indicates that it is not subject to judgment.
The controller 2 preferentially selects left movement when the conditions of obstacles in the “left” area and “front left” area and the conditions of obstacles in the “right” area and “front right” area are equivalent. .

コントローラ2は、リモートコントローラからの開始指令信号を受けて、以下のステップを実行する。
ステップ100でロボットRが前進中か否かを判断する。最初は前進している状況にあるので、ステップ100で肯定判断してステップ101に進み、ここで「前」区域に障害物が有るか否かを判断する。ステップ101で障害物無しと判断した時にはステップ102に進み、ここで最初に遭遇した障害物(初期障害物)を前進方向において越えたか否かを判断する。障害物に遭遇するまではステップ102で否定判断されてステップ103に進み、ここでクローラ走行によりロボットRの前進を開始または継続し、ステップ100に戻る。その結果、ロボットRは障害物に遭遇するまで直線的に前進する。
The controller 2 receives the start command signal from the remote controller and executes the following steps.
At step 100, it is determined whether the robot R is moving forward. At first, the vehicle is moving forward, so an affirmative determination is made at step 100 and the process proceeds to step 101, where it is determined whether or not there is an obstacle in the "front" zone. When it is determined in step 101 that there is no obstacle, the process proceeds to step 102, in which it is determined whether or not the first encountered obstacle (initial obstacle) is crossed in the forward direction. A negative determination is made in step 102 until an obstacle is encountered, and the process proceeds to step 103, where the robot R starts or continues to move forward by crawler travel, and returns to step 100. FIG. As a result, the robot R moves forward in a straight line until it encounters an obstacle.

ステップ101で「前」区域に障害物有りと判断した時にはステップ104に進み、ここで「左」区域に障害物が有るか否かを判断する。ステップ104で障害物無しと判断した時にはステップ105に進み、ここで下記のいずれかの条件を満足するか否かを判断し、満足すると判断した時にはステップ106に進み、ここでローリング走行によりロボットRを左方向に移動させる。
(1)「左前」区域に障害物が無い。・・図5(A)参照
「左」区域と「左前」区域に障害物が無い場合には、左方向に移動した後、前進できるからである。仮に、「右」区域と「右前」区域の障害物が無くて左側の区域と同等の状況であっても、左優先の原則から左方向移動を選択するのである。
(2)「右」区域に障害物が有る。・・図5(B)参照。
「右」区域に障害物がある場合には、左方向への移動しか選択の余地がないからである。
(3)「右前」区域に障害物が有る。・・図5(C)参照。
「右前」区域に障害がある場合、左方向移動を選択する。仮に、「右」区域に障害物が無く「左前」区域に障害物が有っても、左右が同等の条件となるので、左優先の原則から左方向移動を選択するのである。
When it is determined in step 101 that there is an obstacle in the "front" area, the process proceeds to step 104, where it is determined whether or not there is an obstacle in the "left" area. If it is determined in step 104 that there is no obstacle, the process proceeds to step 105. Here, it is determined whether or not any of the following conditions are satisfied. to the left.
(1) There are no obstacles in the "left front" zone. . . . See FIG. 5A This is because when there are no obstacles in the "left" area and the "left front" area, the robot can move forward after moving leftward. Even if there are no obstacles in the 'right' and 'right front' areas and the situation is the same as in the left area, leftward movement is selected based on the principle of left priority.
(2) There is an obstacle in the "right" zone. . . . See FIG.
This is because if there is an obstacle in the "right" zone, the only option is to move to the left.
(3) There is an obstacle in the "right front" zone. . . . See FIG. 5(C).
If there is an obstruction in the "right front" zone, select leftward movement. Even if there is no obstacle in the "right" area and there is an obstacle in the "front left" area, left and right movement is selected based on the principle of left priority, because the left and right are equivalent conditions.

ステップ105で、上記条件(1)~(3)のいずれも満足しないと判断した時、すなわち、「左前」区域に障害物が有り、「右」区域および「右前」区域に障害物が無いと判断した時には、ステップ107に進み、ここでローリング走行によりロボットRを右方向に移動させる。図5(D)参照。右方向に移動すれば前進することができるからである。 When it is determined in step 105 that none of the above conditions (1) to (3) are satisfied, that is, if there is an obstacle in the "left front" area and there are no obstacles in the "right" area and the "right front" area, If so, the process proceeds to step 107, where the robot R is moved rightward by rolling. See FIG. 5(D). This is because it is possible to move forward by moving to the right.

ステップ104で「左」区域に障害物が有ると判断した時には、ステップ108に進み、ここで「右」区域に障害物が有るか否かを判断する。ステップ108で障害物無しと判断した時には、ステップ107に進み、ここでローリング走行によりロボットRを右方向に移動させる。図5(E)参照。 When it is determined in step 104 that there is an obstacle in the "left" zone, step 108 is reached where it is determined whether there is an obstacle in the "right" zone. When it is determined in step 108 that there is no obstacle, the process proceeds to step 107, where the robot R is moved rightward by rolling. See FIG.

ステップ108で障害物有りと判断した時、すなわち「前」、「左」、「右」のいずれの区域にも障害物有りと判断した時には、ステップ109で「後」区域に障害物が有るか否かを判断する。この「後」区域は現在の位置まで前進する前に通過した区域であるから障害物は無いはずであるので、通常であれば否定判断してステップ110に進み、ここでクローラ走行によりロボットRを後退させる(後戻りさせる)。図5(F)参照。
ステップ109で肯定判断した時には、ステップ111で「異常停止」の信号を出力して制御を終了する。
ステップ106,107,110を実行した場合には、ステップ100に戻る。
When it is determined in step 108 that there is an obstacle, that is, when it is determined that there is an obstacle in any of the "front", "left" and "right" areas, step 109 determines whether there is an obstacle in the "rear" area. determine whether or not Since this "rear" area is the area that the robot R passed through before moving forward to the current position, there should be no obstacles. retreat (retreat) See FIG.
When an affirmative determination is made in step 109, an "abnormal stop" signal is output in step 111, and the control ends.
If steps 106, 107 and 110 have been executed, return to step 100;

ステップ100で否定判断した時には、ステップ120に進み、ここでローリング走行により左方向に移動中か否かを判断する。ステップ120で肯定判断した時には、ステップ121に進み、ここで「前」区域に障害物が有るか否かを判断する。ステップ121で障害物有りと判断した時には、ステップ122に進み、ここで「左」区域に障害物が有るか否かを判断する。ステップ122で障害物無しと判断した時には、ステップ123に進み、ここでローリング走行によりロボットRを左方向に移動させる。このように、「前」区域を監視しながら「前」区域に前進できる機会を伺いつつ、左方向の移動を続ける。 When a negative determination is made in step 100, the process proceeds to step 120, where it is determined whether or not the vehicle is moving leftward by rolling. If the determination at step 120 is affirmative, the process proceeds to step 121 where it is determined whether or not there is an obstacle in the "front" zone. When step 121 determines that there is an obstacle, the process proceeds to step 122, where it is determined whether or not there is an obstacle in the "left" zone. When it is determined in step 122 that there is no obstacle, the process proceeds to step 123, where the robot R is moved leftward by rolling. In this way, it continues to move leftward while monitoring the 'front' zone for an opportunity to move forward in the 'front' zone.

ステップ121で「前」区域に障害物が無いと判断した時には、ステップ124に進み、ここでクローラ走行によりロボットRを前進させる。図6(A)参照。
ステップ122で「左」区域に障害物があると判断した時には、ステップ125に進み、ここで「後」区域に障害物があるか否かを判断する。障害物が有ると判断した時には、ステップ126に進み、ここでローリング走行によりロボットRを右方向へ移動させる。図6(B)参照。
ステップ125で障害物が無いと判断した時には、ステップ127に進み、ここでクローラ走行によりロボットRを後退させる。図6(C)参照。
ステップ124,126,127を実行した後、ステップ100に戻る。
When it is determined in step 121 that there are no obstacles in the "front" area, the process proceeds to step 124, where the robot R is advanced by crawler travel. See FIG. 6(A).
When step 122 determines that there is an obstruction in the "left" zone, step 125 is reached where it is determined whether there is an obstruction in the "rear" zone. When it is determined that there is an obstacle, the process proceeds to step 126, where the robot R is moved rightward by rolling. See FIG. 6(B).
When it is determined in step 125 that there is no obstacle, the process proceeds to step 127, where the robot R is moved backward by crawler travel. See FIG. 6(C).
After performing steps 124, 126 and 127, return to step 100. FIG.

ステップ100,120で否定判断した時には、ステップ130に進み、ここでローリング走行により右方向に移動中か否かを判断する。ステップ130で肯定判断した時にはステップ131に進み、ここで「前」区域に障害物が有るか否かを判断する。ステップ131で障害物有りと判断した場合には、ステップ132に進み、ここで「右」区域に障害物が有るか否かを判断する。ステップ132で障害物無しと判断した時にはステップ133に進み、ここでローリング走行によりロボットRを右方向に移動させる。このように、「前」区域を監視しながら「前」区域に前進できる機会を伺いつつ、右方向の移動を続ける。 When negative determinations are made in steps 100 and 120, the process proceeds to step 130, where it is determined whether or not the vehicle is moving rightward by rolling. If the determination in step 130 is affirmative, the process proceeds to step 131, where it is determined whether or not there is an obstacle in the "front" zone. If it is determined in step 131 that there is an obstacle, the process proceeds to step 132, where it is determined whether or not there is an obstacle in the "right" zone. When it is determined in step 132 that there is no obstacle, the process proceeds to step 133, where the robot R is moved rightward by rolling. In this way, it continues to move rightward while monitoring the 'front' zone for an opportunity to move forward in the 'front' zone.

ステップ131で「前」区域に障害物が無いと判断した時には、ステップ134に進み、ここでクローラ走行によりロボットRを前進させる。図7(A)参照。
ステップ132で「右」区域に障害物があると判断した時には、ステップ135に進み、ここで「後」区域に障害物があるか否かを判断する。障害物が有ると判断した時には、ステップ136に進み、ここでローリング走行によりロボットRを左方向へ移動させる。図7(B)参照。
ステップ135で障害物が無いと判断した時には、ステップ137に進み、ここでクローラ走行によりロボットRを後退させる。図7(C)参照。
ステップ134,136,137を実行した後、ステップ100に戻る。
When it is determined in step 131 that there are no obstacles in the "front" area, the process proceeds to step 134, where the robot R is advanced by crawler travel. See FIG. 7(A).
When step 132 determines that there is an obstruction in the "right" zone, step 135 is reached where it is determined whether there is an obstruction in the "rear" zone. When it is determined that there is an obstacle, the process proceeds to step 136, where the robot R is moved leftward by rolling. See FIG. 7(B).
When it is determined in step 135 that there is no obstacle, the process proceeds to step 137, where the robot R is moved backward by crawler travel. See FIG. 7(C).
After executing steps 134 , 136 , 137 , return to step 100 .

ステップ100,120,130で否定判断した時、すなわち現在ロボットRが後退中であると判断した時には、ステップ140に進み、ここで「左」区域に障害物があるか否かを判断する。ステップ140で障害物有りと判断した時には、ステップ141に進み、ここで「右」区域に障害物が有るか否かを判断する。ステップ141で障害物有りと判断した時には、ステップ142に進み、ここで「後」区域に障害物が有るか否かを判断する。ステップ142で障害物無しと判断した時には、クローラ走行によりロボットRを後退させる。このように、「左」、「右」の区域を監視しながら左右への移動の機会を伺いつつ後退を続ける。 If the determination at steps 100, 120, or 130 is negative, i.e., if it is determined that the robot R is currently in reverse, the process proceeds to step 140, where it is determined whether there is an obstacle in the "left" zone. When step 140 determines that there is an obstacle, the process proceeds to step 141 where it is determined whether or not there is an obstacle in the "right" zone. When step 141 determines that there is an obstacle, the process proceeds to step 142 where it is determined whether or not there is an obstacle in the "rear" area. When it is determined in step 142 that there is no obstacle, the robot R is moved backward by crawler travel. In this way, while monitoring the ``left'' and ``right'' zones, it continues to retreat while looking for opportunities to move left and right.

ステップ142で障害物有と判断した時、すなわち「左」、「右」の区域のみならず進行方向の「後」区域にも障害物があると判断した時には、ステップ144で「異常停止」の信号を出力して制御を終了する。 When it is determined at step 142 that there is an obstacle, that is, when it is determined that there is an obstacle not only in the "left" and "right" areas but also in the "rear" area in the direction of travel, an "abnormal stop" is determined at step 144. Output a signal to end control.

後退中にステップ140で「左」区域に障害物無しと判断した時には、ステップ145に進み、ここでローリング走行によりロボットRを左方向に移動させる。図8(A)参照。この後、ステップ100での否定判断を経て、ステップ120~127を実行して前進の機会を伺う。
また、ステップ141で「右」区域に障害物無しと判断した時には、ステップ146に進み、ここでローリング走行によりロボットRを右方向に移動させる。図8(B)参照。この後、ステップ100,120での否定判断を経て、ステップ130~137を実行して前進の機会を伺う。
When it is determined in step 140 that there is no obstacle in the "left" area during backward movement, the process proceeds to step 145, where the robot R is moved leftward by rolling. See FIG. 8(A). After that, through a negative judgment in step 100, steps 120 to 127 are executed to look for an opportunity to move forward.
Also, when it is determined in step 141 that there is no obstacle in the "right" area, the process proceeds to step 146, where the robot R is moved rightward by rolling. See FIG. 8(B). After that, through negative judgments in steps 100 and 120, steps 130 to 137 are executed to look for an opportunity to move forward.

上記のように、障害物を回避しながら前進してステップ102で肯定判断した時には、ステップ150に進み、ここで障害物を回避する走行制御が完了したことを示す信号を出力して制御を終了する。 As described above, when the vehicle travels forward while avoiding obstacles and an affirmative determination is made in step 102, the process proceeds to step 150, where a signal indicating that travel control for avoiding obstacles has been completed is output, and the control ends. do.

なお、上記のように障害物回避制御が終了した後、リモートコントローラによる手動操作により目的地まで走行させてもよいし、予め設定された走行ルートに戻って目的地まで自動走行制御してもよい。 After the obstacle avoidance control is completed as described above, the vehicle may be manually operated by a remote controller to travel to the destination, or may be returned to a preset travel route and automatically traveled to the destination. .

上記実施形態において、レーザー距離センサ4を前にしてクローラ走行により前進させる場合には、コントローラ2は、区域A7を「前」区域とし、区域A2を「後」区域とし、区域A5を「左」区域とし、区域A4を「右」区域とし、区域A8,A6をそれぞれ「左前」区域、「右前」区域と定めて、上記障害物回避制御を実行する。この場合、コントローラ2は、区域A1,A3での障害物の有無は、判断しない。 In the above embodiment, when the laser distance sensor 4 is in front and the crawler travels forward, the controller 2 sets the area A7 as the "front" area, the area A2 as the "rear" area, and the area A5 as the "left" area. With the area A4 defined as the "right" area, and the areas A8 and A6 defined as the "left front" area and the "right front" area respectively, the above obstacle avoidance control is executed. In this case, the controller 2 does not determine the presence or absence of obstacles in the areas A1 and A3.

上記実施形態において、ローリング走行により目的地に向かって前進する場合には、Y方向が特許請求の範囲の第1方向に相当し、X方向が第2方向に相当する。この場合、コントローラ2は、区域A4、A5のいずれか一方を「前」区域、他方を「後」区域と定める。区域A2、A7のいずれか一方を「左」区域、他方を「右」区域と定める。区域A6,A1または区域A3,A8を、「左前」区域および「右前」区域と定める。 In the above embodiment, when moving forward toward the destination by rolling, the Y direction corresponds to the first direction, and the X direction corresponds to the second direction. In this case, the controller 2 defines one of the zones A4, A5 as the "front" zone and the other as the "back" zone. One of the areas A2 and A7 is defined as the "left" area and the other as the "right" area. Areas A6, A1 or areas A3, A8 are defined as "front left" and "front right" areas.

本発明は上記実施形態に制約されず、種々の形態を採用可能である。
本実施形態では、「前」区域と「左」区域と「右」区域での障害物の情報だけで、障害物回避制御を行ってもよい。
また、上記実施形態の障害物回避制御から、「後」区域での障害物の情報を省いてもよい。
障害物検出手段は、設定された区域の映像を撮影するビデオカメラであってもよい。
The present invention is not limited to the above embodiments, and various forms can be adopted.
In the present embodiment, obstacle avoidance control may be performed based only on obstacle information in the "front" zone, "left" zone, and "right" zone.
Also, the obstacle avoidance control in the above embodiment may omit information on obstacles in the "rear" zone.
The obstacle detection means may be a video camera that takes an image of the set area.

走行装置のクローラ装置において、クローラユニットは片持ちで支持してもよい。また、クローラモータはクローラユニットに内蔵されていてもよい。
走行装置は、クローラ装置を装備しない他の二方向に直線的に移動可能な走行装置を用いてもよい。
In the crawler device of the traveling device, the crawler unit may be cantilevered. Also, the crawler motor may be built in the crawler unit.
A traveling device that is not equipped with a crawler device and that can move linearly in other two directions may be used as the traveling device.

本発明は、二方向に走行可能なロボット等に適用することができる。 INDUSTRIAL APPLICABILITY The present invention can be applied to a robot or the like that can travel in two directions.

R ロボット(移動体)
1 ボデイ
2 コントローラ
3,4 レーザー距離センサ(障害物検出手段)
5 走行装置
6 クローラ装置
7 クローラユニット
10 サポート
20A,20B クローラ部
R robot (mobile)
1 body 2 controller 3, 4 laser distance sensor (obstacle detection means)
5 traveling device 6 crawler device 7 crawler unit 10 support 20A, 20B crawler part

Claims (7)

ボデイと、このボデイに設けられ互いに直交する二方向に走行可能な走行装置と、障害物を検出するための障害物検出手段と、上記障害物検出手段からの情報に基づき上記走行装置を制御するコントローラと、を備えた移動体において、
上記コントローラは、上記走行装置を制御して上記移動体を上記二方向のうちの第1方向に沿って走行させている状況において、少なくとも、上記移動体が収まる矩形の基準区域に隣接する上記第1方向前方の矩形をなす「前」区域と、上記基準区域における上記二方向のうちの第2方向両側に隣接する矩形の「左」区域および「右」区域と、上記「前」区域と上記「左」区域に隣接する矩形の「左前」区域と、上記「前」区域と上記「右」区域に隣接する矩形の「右前」区域とを設定し、
さらに上記コントローラは、上記移動体を上記第1方向に沿って走行させている状況において、上記障害物検出手段からの情報に基づき上記「前」区域に障害物があると判断したとき、
ア)上記「左」区域と上記「右」区域のうち一方の区域に障害物がなく他方の区域に障害物がある状況では、上記移動体を当該一方の区域に向けて上記第2方向に走行させ、
イ)上記「左」区域と上記「右」区域の両方の区域に障害物がなく、上記「左前」区域と上記「右前」区域のうち一方の区域に障害物がなく他方の区域に障害物がある状況では、上記移動体を上記「左」区域と上記「右」区域のうち当該一方の区域に隣接する区域に向けて上記第2方向に走行させ、さらに当該一方の区域に向けて上記第1方向に走行させることを特徴とする移動体。
a body, a traveling device provided on the body and capable of traveling in two mutually orthogonal directions, obstacle detecting means for detecting an obstacle, and controlling the traveling device based on information from the obstacle detecting means. A mobile body comprising a controller,
In a situation in which the controller controls the traveling device to cause the mobile body to travel along the first direction of the two directions, the controller controls at least the first area adjacent to a rectangular reference area in which the mobile body is accommodated. A "front" area forming a rectangle forward in one direction, a rectangular "left" area and a "right" area adjacent to both sides of the second of the two directions in the reference area , the "front" area and the above setting a rectangular "left front" area adjacent to the "left" area and a rectangular "right front" area adjacent to the "front" area and the "right"area;
Furthermore, when the controller determines that there is an obstacle in the "front" area based on the information from the obstacle detection means in a situation in which the mobile body is traveling along the first direction,
a) In a situation where there is no obstacle in one of the above "left" and above "right" areas and there is an obstacle in the other area, the moving object is directed toward the above one area in the second direction. let it run,
b) Both the “left” and “right” areas above are free of obstacles, one of the above “left front” area and above “right front” area is free of obstacles, and the other area is free of obstacles. In a certain situation, the moving object is caused to travel in the second direction toward an area adjacent to one of the "left" area and the "right" area, and further toward the one area. A moving body characterized by traveling in a first direction .
上記コントローラは、左右いずれかの方向を優先方向として定め、
上記移動体を上記第1方向に沿って走行させている状況において、上記「前」区域に障害物があると判断したとき、
ア)上記「左」区域と上記「右」区域のうち、優先方向に位置する優先区域と、上記「左前」区域と上記「右前」区域のうち上記優先区域の前方に位置する斜め前方区域において、障害物がない状況では、上記優先方向と反対側の区域での障害物の有無に拘わらず、上記移動体を上記優先区域に向けて上記第2方向に走行させ、さらに上記斜め前方区域に向けて上記第1方向に走行させ、
イ)上記「左」区域と上記「右」区域に障害物がなく、上記「左前」区域と上記「右前」区域に障害物がある状況では、上記移動体を上記優先区域に向けて上記第2方向に走行させることを特徴とする請求項1に記載の移動体
The controller defines one of the left and right directions as a priority direction,
When it is determined that there is an obstacle in the "front" area in the situation where the moving object is traveling along the first direction,
a) Among the above-mentioned "left" area and above-mentioned "right" area, in the priority area located in the priority direction, and among the above-mentioned "left front" area and above "right front" area, in the oblique front area located in front of the above-mentioned priority area , in a situation where there is no obstacle, regardless of the presence or absence of an obstacle in the area on the opposite side of the priority direction, the moving body is caused to travel in the second direction toward the priority area, and further to the oblique front area. to run in the first direction,
b) In the situation where there are no obstacles in the "left" zone and the "right" zone, and there are obstacles in the "left front" zone and the "right front" zone, direct the moving object to the priority zone and 2. The moving body according to claim 1, characterized in that it travels in two directions.
上記コントローラは、上記第2方向への走行中に、上記「前」区域に障害物がないと判断したときには、上記移動体を上記「前」区域に向けて上記第1方向に走行させることを特徴とする請求項1または2に記載の移動体。When the controller determines that there is no obstacle in the "front" area while traveling in the second direction, the controller causes the moving body to travel in the first direction toward the "front" area. 3. The moving body according to claim 1 or 2. 上記コントローラは、上記「前」区域と上記「左区域」と上記「右区域」で障害物があると判断したときには、上記移動体を上記第1方向に沿って後退させ、上記後退の走行中に、上記「左」区域または上記「右」区域に障害物がないと判断したときには、上記移動体を当該障害物がない区域に向けて上記第2方向に走行させることを特徴とする請求項1~3のいずれかに記載の移動体。When the controller determines that there are obstacles in the "front" area, the "left area", and the "right area", the controller causes the moving body to move backward along the first direction, Further, when it is determined that there is no obstacle in the "left" area or the "right" area, the moving body is caused to travel in the second direction toward an area free of the obstacle. 4. The moving body according to any one of 1 to 3. 上記「前」区域は、上記第2方向の寸法が上記基準区域と等しく、上記第1方向の寸法が上記基準区域より大きく、
上記「左」区域と上記「右」区域は、上記第1方向の寸法が上記基準区域と等しく、上記第2方向の寸法が上記基準区域より大きく、
上記「左前」区域と上記「右前」区域は、上記第1方向の寸法が上記「前」区域の上記第1方向の寸法と等しく、上記第2方向の寸法が上記「左」区域および上記「右」区域の上記第2方向の寸法と等しいことを特徴とする請求項1~4のいずれかに記載の移動体。
the "front" zone has a dimension in the second direction equal to the reference zone and a dimension in the first direction greater than the reference zone;
The "left" area and the "right" area have dimensions in the first direction equal to the reference area and dimensions in the second direction greater than the reference area,
The "left front" section and the "right front" section have dimensions in the first direction equal to the first direction dimensions of the "front" section, and dimensions in the second direction are equal to the "left" section and the "right front" section. Mobile body according to any one of the preceding claims, characterized in that it is equal to the dimension of the "right" section in said second direction.
上記基準区域における上記二方向両側に隣接する区域と、上記基準区域の斜め方向に位置する区域の合計8つの区域が予め設定されており、上記コントローラは、上記移動体の進行すべき方向に応じて、上記8つの区域から、上記「前」区域、「左」区域、「右」区域、「左前」区域、「右前」区域を設定することを特徴とする請求項1~5のいずれかに記載の移動体。 A total of eight areas are set in advance, that is, areas adjacent to the reference area on both sides of the reference area and areas located diagonally to the reference area. The "front" area, the "left" area, the "right" area, the "left front" area, and the "right front" area are set from the eight areas. Mobile as described. 上記走行装置は、上記二方向のうちの一方の方向に延びるとともに、他方の方向に離間した一対のクローラ装置を備え、
上記クローラ装置の各々は、上記一方の方向に延びる回転軸線を中心に回転可能にして上記ボデイに支持された円筒形状のクローラユニットを備え、
上記クローラユニットは、上記回転軸線方向に延びるサポートと、上記回転軸線方向に延びて上記サポートに支持されるとともに上記回転軸線を挟んで対向配置された一対のクローラ部と、を有し、
上記コントローラは、上記クローラ部を回転させることにより、上記一方の方向のクローラ走行を実行し、上記クローラユニットを上記回転軸線を中心に回転させることにより、上記他方の方向のローリング走行を実行することを特徴とする請求項1~6のいずれかに記載の移動体。
The traveling device includes a pair of crawler devices extending in one of the two directions and spaced apart in the other direction,
Each of the crawler devices includes a cylindrical crawler unit rotatably supported by the body about a rotation axis extending in one direction,
The crawler unit has a support extending in the direction of the rotation axis, and a pair of crawler parts extending in the direction of the rotation axis, supported by the support, and arranged to face each other across the rotation axis,
The controller rotates the crawler section to perform crawler travel in one direction, and rotates the crawler unit about the rotation axis to perform rolling travel in the other direction. The moving object according to any one of claims 1 to 6, characterized by:
JP2018116399A 2018-06-19 2018-06-19 moving body Active JP7162452B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018116399A JP7162452B2 (en) 2018-06-19 2018-06-19 moving body

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018116399A JP7162452B2 (en) 2018-06-19 2018-06-19 moving body

Publications (2)

Publication Number Publication Date
JP2019219877A JP2019219877A (en) 2019-12-26
JP7162452B2 true JP7162452B2 (en) 2022-10-28

Family

ID=69096566

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018116399A Active JP7162452B2 (en) 2018-06-19 2018-06-19 moving body

Country Status (1)

Country Link
JP (1) JP7162452B2 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003039349A (en) 2001-07-25 2003-02-13 Komatsu Ltd Travel control device for traveling robot
JP2010108434A (en) 2008-10-31 2010-05-13 Toshiba Tec Corp Obstacle detection system and control method thereof
WO2018008060A1 (en) 2016-07-04 2018-01-11 トピー工業株式会社 Traveling body

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003039349A (en) 2001-07-25 2003-02-13 Komatsu Ltd Travel control device for traveling robot
JP2010108434A (en) 2008-10-31 2010-05-13 Toshiba Tec Corp Obstacle detection system and control method thereof
WO2018008060A1 (en) 2016-07-04 2018-01-11 トピー工業株式会社 Traveling body

Also Published As

Publication number Publication date
JP2019219877A (en) 2019-12-26

Similar Documents

Publication Publication Date Title
US10450014B2 (en) Traveling apparatus and control method therefor
JP7162452B2 (en) moving body
JP6695974B2 (en) Running body
JP2013209063A (en) Travel control device
JP5346480B2 (en) Driving mode switching control device and switching control method for automatic guided vehicle
JP5134402B2 (en) Route change method and route change device for automated guided vehicle
JP4641300B2 (en) Self-propelled in-pipe inspection camera device
JP7162449B2 (en) running body
JPH07285475A (en) Rotational driving method of spherical shell and traveling device using spherical shell
JP2021519243A (en) Transport vehicle
JP3005151B2 (en) Traveling control device for beam-guided work vehicle
JP2024099290A5 (en)
JP2022136785A (en) Autonomously traveling body
JP3241182B2 (en) Independent traveling vehicle
JPH0737131Y2 (en) Obstacle detection device for transport vehicles
JP3005152B2 (en) Traveling control device for beam-guided work vehicle
JP2003330542A (en) Movement control method for omnidirectional vehicles
JP6890506B2 (en) Crawler device and vehicle
JP2008139963A (en) Unmanned transport vehicle body and control method thereof
JP3010273B2 (en) Traveling equipment for unmanned vehicles
JPH07317109A (en) Turning position detecting device of construction machine
JPH0755611Y2 (en) Obstacle detection device for automated guided vehicles
JPH0777869B2 (en) Car steering device
CN119138783A (en) Control method and device of cleaning robot
JP3044160B2 (en) Light receiving device and traveling control device for beam light guided work vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210427

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220330

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220405

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220603

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221018

R150 Certificate of patent or registration of utility model

Ref document number: 7162452

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250