[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP2008102698A - Self-propelled device charging system - Google Patents

Self-propelled device charging system Download PDF

Info

Publication number
JP2008102698A
JP2008102698A JP2006284050A JP2006284050A JP2008102698A JP 2008102698 A JP2008102698 A JP 2008102698A JP 2006284050 A JP2006284050 A JP 2006284050A JP 2006284050 A JP2006284050 A JP 2006284050A JP 2008102698 A JP2008102698 A JP 2008102698A
Authority
JP
Japan
Prior art keywords
light beam
self
propelled device
charging
detection means
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Withdrawn
Application number
JP2006284050A
Other languages
Japanese (ja)
Inventor
Hiroyuki Takenaka
博幸 竹中
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.)
Funai Electric Co Ltd
Original Assignee
Funai Electric 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 Funai Electric Co Ltd filed Critical Funai Electric Co Ltd
Priority to JP2006284050A priority Critical patent/JP2008102698A/en
Publication of JP2008102698A publication Critical patent/JP2008102698A/en
Withdrawn legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0225Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To make a self-propelled device autonomously travel to a charging device surely with a simple configuration at lower cost in a self-propelled device charging system having the self-propelled device and the charging device for supplying power for charging the self-propelled device. <P>SOLUTION: A security robot 4 includes a detection section 45 having a plurality of first light beam sensors 452a disposed at predetermined intervals along the entire circumference of the side face, and a second light beam sensor 452b disposed to be directed to the direction of movement of the security robot 4. When preset charging timing of the security robot 4 is decided, it is configured to rotate the security robot 4 so that the light beam M emitted by an emission section 22 of a charging device 2 is detected by the second light beam sensor 452b and at least one first light beam sensor 452a out of the two first light beam sensors 452a, 452a disposed on the left and right of the second light beam sensor 452b. <P>COPYRIGHT: (C)2008,JPO&INPIT

Description

本発明は、自走式装置充電システムに関する。   The present invention relates to a self-propelled device charging system.

近年、所定の走行パターンに基づいて走行して、所与の機能や任務を遂行する自走式装置が知られている。
このような自走式装置は、例えば、当該自走式装置の駆動電力を蓄える蓄電池の充電を行うために、所定の充電装置まで自律走行できるようになっている。
In recent years, a self-propelled device that travels based on a predetermined travel pattern and performs a given function or mission is known.
For example, such a self-propelled device can autonomously travel to a predetermined charging device in order to charge a storage battery that stores the drive power of the self-propelled device.

具体的には、例えば、充電装置に配置された点滅光源からの光点滅信号を受光して、光切断法による三角測量の原理によって充電装置までの距離を計算し、当該計算結果に基づいて充電装置まで自律走行する自走式装置(例えば、特許文献1参照)、充電装置からコード等が異なる複数種類の信号が発生されるようにしておき、充電装置から発生される信号を受信する受信部を備え、当該受信部で感知した信号の種類に基づいて、斜めに走行したり或いは90度に回転した後直進する等して、自走式装置の移動方式を変えながら、充電装置まで自律走行する自走式装置(例えば、特許文献2参照)、充電装置から赤外線ビームが発生されるようにしておき、充電装置から発生される赤外線ビームを検出する検出器を前方及び後方に向けて備え、当該前方に向けられた検出器により直接ビームを検出するとともに、当該後方に向けられた検出器により反射ビームを検出するように、自走式装置を回転させながら、充電装置まで自律走行する自走式装置(例えば、特許文献3参照)、充電装置から第1及び第2の赤外線信号が発生されるようにしておき、自走式装置の本体部に設置された揺動板に装着されることで、揺動されながら充電装置から発生される第1及び第2の赤外線信号を受信する赤外線受信部を備え、当該赤外線受信部により受信された第1及び第2の赤外線信号が発生する方向の中心に沿って自走式装置を移動させることによって、充電装置まで自律走行する自走式装置(例えば、特許文献4参照)等が提案されている。
特開2004−151924号公報 特開2006−127448号公報 特表2001−525567号公報 特開2004−275716号公報
Specifically, for example, a light blinking signal from a blinking light source arranged in the charging device is received, a distance to the charging device is calculated according to the principle of triangulation by the light cutting method, and charging is performed based on the calculation result. A self-propelled device that autonomously travels to the device (see, for example, Patent Document 1), a charging unit that generates a plurality of types of signals with different codes and the like, and receives a signal generated from the charging device Based on the type of signal sensed by the receiver, it runs autonomously to the charging device while changing the movement method of the self-propelled device by running diagonally or rotating straight after rotating 90 degrees, etc. A self-propelled device (see, for example, Patent Document 2), an infrared beam is generated from the charging device, and a detector for detecting the infrared beam generated from the charging device is provided forward and backward. Self-propelled that autonomously travels to the charging device while rotating the self-propelled device so that the detector directed to the front detects the beam directly and the reflected beam is detected by the detector directed to the rear The first and second infrared signals are generated from the charging device (for example, see Patent Document 3) and the charging device, and are attached to the swing plate installed in the main body of the self-propelled device. And an infrared receiving unit that receives the first and second infrared signals generated from the charging device while being swung, and in the direction in which the first and second infrared signals received by the infrared receiving unit are generated. A self-propelled device that autonomously travels to a charging device by moving the self-propelled device along the center (for example, see Patent Document 4) has been proposed.
JP 2004-151924 A JP 2006-127448 A JP-T-2001-525567 JP 2004-275716 A

しかしながら、特許文献1の自走式装置は、光切断法による三角測量の原理を利用して、充電装置まで自律走行するが、当該原理を利用するためには、自走式装置に、撮像素子、レーザ光の発光源、スキャナ機構等を具備する必要があるため、自走式装置の構成が複雑になる、コストがかかる、という問題がある。
また、特許文献2の自走式装置は、受信部で感知した信号の種類に基づいて、斜めに走行したり或いは90度回転した後直進する等して充電装置まで自律走行するが、回転の際の回転角度等が一定であるため、受信部が信号を感知した時、常に、自走式装置と充電装置との角度が一定でないと、なかなか充電装置まで到着できないという問題がある。
また、特許文献3の自走式装置は、充電装置から発生された赤外線ビームの直接ビームだけでなく反射ビームも利用して充電装置まで自律走行するが、充電装置を設置した室内に反射鏡を備える等して、反射ビームを発生可能な状態にしておかないと、充電装置まで自律走行できないという問題がある。
また、特許文献4の自走式装置は、充電装置から発生された第1及び第2の赤外線信号が発生する方向の中心に沿って、その充電装置まで自律走行するが、充電装置に、第1の赤外線信号を発生する赤外線発生部と、第2の赤外線信号を発生する赤外線発生部と、の2つの赤外線発生部を具備する必要があるため、充電装置の構成が複雑になる、コストがかかる、という問題がある。
However, the self-propelled device disclosed in Patent Document 1 autonomously travels to the charging device using the principle of triangulation by the light cutting method. In order to use the principle, the self-propelled device includes an image sensor. Further, since it is necessary to provide a laser light emission source, a scanner mechanism, and the like, there is a problem that the configuration of the self-propelled device becomes complicated and the cost is high.
In addition, the self-propelled device of Patent Document 2 autonomously travels to the charging device by traveling diagonally or straightly after rotating 90 degrees based on the type of signal sensed by the receiving unit. Since the rotation angle at the time is constant, there is a problem that it is difficult to reach the charging device unless the angle between the self-propelled device and the charging device is always constant when the receiving unit senses a signal.
In addition, the self-propelled device of Patent Document 3 autonomously travels to the charging device using not only the direct beam of the infrared beam generated from the charging device but also the reflected beam, but a reflecting mirror is installed in the room where the charging device is installed. There is a problem that the battery cannot travel autonomously unless the reflected beam can be generated, for example.
The self-propelled device of Patent Document 4 autonomously travels to the charging device along the center of the direction in which the first and second infrared signals generated from the charging device are generated. Since it is necessary to provide two infrared generators, namely, an infrared generator that generates one infrared signal and an infrared generator that generates a second infrared signal, the configuration of the charging device is complicated, and the cost is low. There is a problem of this.

本発明の課題は、自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、より簡易且つより低コストな構成で、確実に自走式装置を充電装置まで自律走行させることにある。   The subject of the present invention is a simpler and lower-cost configuration in a self-propelled device charging system comprising a self-propelled device and a charging device that supplies power for charging the self-propelled device. It is to make sure that the self-propelled device autonomously travels to the charging device.

上記課題を解決するために、請求項1に記載の発明は、
所定の室内の床面上を自立走行する自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
光ビームを発光する発光手段と、
を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
当該自走式装置の本体部の上面に配置され、前記発光手段により発光された光ビームを受光して検出する第1検出手段が、側面全周に沿って所定間隔で複数配置されるとともに、前記発光手段により発光された光ビームを受光して検出する第2検出手段が、当該自走式装置の進行方向を向き且つ当該複数の第1検出手段のうちの隣り合う2つの第1検出手段から等間隔の位置に配置された検出部と、
当該自走式装置を回転させる回転駆動部と、
予め設定された当該自走式装置の充電タイミングになったか否かを判断する判断手段と、
前記判断手段により予め設定された当該自走式装置の充電タイミングになったと判断された場合であって、前記第1検出手段又は前記第2検出手段により光ビームが検出された際に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により当該光ビームが検出されるように、前記回転駆動部を制御する回転制御手段と、
前記回転制御手段により前記回転駆動部が制御されている状態で、所定時間内に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、当該自走式装置をランダム走行させる走行制御手段と、
を備えることを特徴とする。
In order to solve the above-mentioned problem, the invention described in claim 1
In a self-propelled device charging system comprising a self-propelled device that independently runs on a floor surface in a predetermined room, and a charging device that supplies electric power for charging to the self-propelled device,
The charging device is:
The self-propelled device is detachable, and when the self-propelled device is attached, a contact terminal that supplies power for the charging to the self-propelled device;
A light emitting means for emitting a light beam;
With
The self-propelled device is
A terminal that is in contact with the contact terminal and receives supply of power for the charging from the contact terminal;
A plurality of first detection means arranged on the upper surface of the main body of the self-propelled device and receiving and detecting the light beam emitted by the light emitting means are arranged at predetermined intervals along the entire side surface, The second detection means that receives and detects the light beam emitted by the light emitting means faces the traveling direction of the self-propelled device and is adjacent to two of the plurality of first detection means. Detectors arranged at equally spaced positions from
A rotation drive for rotating the self-propelled device;
A judging means for judging whether or not the charging timing of the self-propelled device set in advance is reached;
When it is determined by the determination means that the charging timing of the self-propelled device set in advance is reached, when the light beam is detected by the first detection means or the second detection means, the first The rotation drive unit so that the light beam is detected by two detection means and at least one first detection means of the two first detection means arranged on the left and right of the second detection means. Rotation control means to control;
In a state where the rotation drive unit is controlled by the rotation control unit, at least of the second detection unit and the two first detection units arranged on the left and right of the second detection unit within a predetermined time. If the light beam is not detected by one first detection means, travel control means for causing the self-propelled device to travel randomly,
It is characterized by providing.

請求項2に記載の発明は、
所定の室内の床面上を自立走行する自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
光ビームを発光する発光手段と、
を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
前記発光手段により発光された光ビームを受光して検出する第1検出手段が、側面全周に沿って所定間隔で複数配置されるとともに、前記発光手段により発光された光ビームを受光して検出する第2検出手段が、当該自走式装置の進行方向を向き且つ当該複数の第1検出手段のうちの隣り合う2つの第1検出手段から等間隔の位置に配置された検出部と、
当該自走式装置を回転させる回転駆動部と、
予め設定された当該自走式装置の充電タイミングになったか否かを判断する判断手段と、
前記判断手段により予め設定された当該自走式装置の充電タイミングになったと判断された場合であって、前記第1検出手段又は前記第2検出手段により光ビームが検出された際に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により当該光ビームが検出されるように、前記回転駆動部を制御する回転制御手段と、
を備えることを特徴とする。
The invention described in claim 2
In a self-propelled device charging system comprising a self-propelled device that independently runs on a floor surface in a predetermined room, and a charging device that supplies electric power for charging to the self-propelled device,
The charging device is:
The self-propelled device is detachable, and when the self-propelled device is attached, a contact terminal that supplies power for the charging to the self-propelled device;
A light emitting means for emitting a light beam;
With
The self-propelled device is
A terminal that is in contact with the contact terminal and receives supply of power for the charging from the contact terminal;
A plurality of first detection means for receiving and detecting the light beam emitted by the light emitting means are arranged at predetermined intervals along the entire circumference of the side surface, and receiving and detecting the light beam emitted by the light emitting means. A second detecting means that faces the traveling direction of the self-propelled device and is arranged at equal intervals from two adjacent first detecting means of the plurality of first detecting means;
A rotation drive for rotating the self-propelled device;
A judging means for judging whether or not the charging timing of the self-propelled device set in advance is reached;
When it is determined by the determination means that the charging timing of the self-propelled device set in advance is reached, when the light beam is detected by the first detection means or the second detection means, the first The rotation drive unit so that the light beam is detected by two detection means and at least one first detection means of the two first detection means arranged on the left and right of the second detection means. Rotation control means to control;
It is characterized by providing.

請求項3に記載の発明は、
請求項2に記載の自走式装置充電システムにおいて、
前記自走式装置は、
前記回転制御手段により前記回転駆動部が制御されている状態で、所定時間内に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、当該自走式装置をランダム走行させる走行制御手段を備えることを特徴とする。
The invention described in claim 3
In the self-propelled device charging system according to claim 2,
The self-propelled device is
In a state where the rotation drive unit is controlled by the rotation control unit, at least of the second detection unit and the two first detection units arranged on the left and right of the second detection unit within a predetermined time. When a light beam is not detected by one first detection means, the self-propelled device is provided with a travel control means that randomly travels.

請求項4に記載の発明は、
請求項2又は3に記載の自走式装置充電システムにおいて、
前記検出部は、前記自走式装置の本体部の上面に配置されていることを特徴とする。
The invention according to claim 4
In the self-propelled device charging system according to claim 2 or 3,
The detection unit is arranged on an upper surface of a main body of the self-propelled device.

請求項1に記載の発明によれば、充電装置は、光ビームを発光する発光手段を備えており、そして、自走式装置は、充電装置の発光手段により発光された光ビームを受光して検出する第1検出手段が、側面全周に沿って所定間隔で複数配置されるとともに、充電装置の発光手段により発光された光ビームを受光して検出する第2検出手段が、自走式装置の進行方向を向き且つ当該複数の第1検出手段のうちの隣り合う2つの第1検出手段から等間隔の位置に配置された検出部と、当該自走式装置を回転させる回転駆動部と、を備え、判断手段によって、予め設定された当該自走式装置の充電タイミングになったか否かを判断することができ、回転制御手段によって、判断手段により予め設定された自走式装置の充電タイミングになったと判断された場合であって、第1検出手段又は第2検出手段により光ビームが検出された際に、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により当該光ビームが検出されるように、回転駆動部を制御することができる。
すなわち、自走式装置は、充電装置を検出するための検出部を具備しているだけなので、構成が簡易であるとともに低コストであり、また、充電装置は、自走式装置に検出されるための発光手段を具備しているだけなので、構成が簡易であるとともに低コストである。さらに、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されるように、すなわち、自走式装置が備える検出部と充電装置が備える発光手段とによって、確実に自走式装置を充電装置へ誘導できる状態となるように、自走式装置は回転されるため、確実に充電装置まで到着することができる。したがって、自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、より簡易且つより低コストな構成で、確実に自走式装置を充電装置まで自立走行させることができる。
According to the first aspect of the present invention, the charging device includes light emitting means for emitting a light beam, and the self-propelled device receives the light beam emitted by the light emitting means of the charging device. A plurality of first detecting means for detecting are arranged at predetermined intervals along the entire circumference of the side surface, and second detecting means for receiving and detecting the light beam emitted by the light emitting means of the charging device is a self-propelled device. A detection unit disposed at equal intervals from two adjacent first detection units among the plurality of first detection units, a rotation drive unit that rotates the self-propelled device, It is possible to determine whether the charging timing of the self-propelled device set in advance is reached by the determining means, and the charging timing of the self-propelled device preset by the determining means is determined by the rotation control means Judged to be And when the light beam is detected by the first detection means or the second detection means, the second detection means and the two first detection means arranged on the left and right of the second detection means. The rotation drive unit can be controlled so that the light beam is detected by at least one of the first detection means.
That is, since the self-propelled device only includes a detection unit for detecting the charging device, the configuration is simple and the cost is low, and the charging device is detected by the self-propelled device. Therefore, the configuration is simple and the cost is low. Further, the light beam is detected by the second detection means and at least one of the two first detection means arranged on the left and right of the second detection means, that is, self-running. The self-propelled device is rotated so that the self-propelled device can be reliably guided to the charging device by the detection unit and the light-emitting means included in the charging device, so that the mobile device reliably arrives at the charging device. can do. Therefore, in a self-propelled device charging system that includes a self-propelled device and a charging device that supplies power for charging to the self-propelled device, the self-propelled device is surely self-propelled with a simpler and lower-cost configuration. Can be made to stand on its own to the charging device.

また、自走式装置は、走行制御手段によって、回転制御手段により回転駆動部が制御されている状態で、所定時間内に、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、自走式装置をランダム走行させることができる。
すなわち、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されるまで、すなわち、自走式装置が備える検出部と充電装置が備える発光手段とによって、確実に自走式装置を充電装置へ誘導できる状態になるまで、自走式装置はランダム走行されるため、より確実に自走式装置を充電装置まで自立走行させることができる。
Further, the self-propelled device is disposed within the predetermined time and on the left and right of the second detection means within a predetermined time while the rotation control unit is controlled by the rotation control means by the travel control means. If the light beam is not detected by at least one of the two first detection means, the self-propelled device can be run at random.
That is, when a light beam is not detected by the second detection means and at least one first detection means of the two first detection means arranged on the left and right of the second detection means, the second detection means And at least one first detection means of the two first detection means arranged on the left and right of the second detection means until a light beam is detected, that is, a detection unit provided in the self-propelled device, The self-propelled device is driven randomly until the self-propelled device can be reliably guided to the charging device by the light-emitting means included in the charging device, so that the self-propelled device can travel more reliably to the charging device. Can be made.

また、第1検出手段及び第2検出手段が、自走式装置の本体部の上面に配置された検出部の側面全周に沿って配置されているため、360度全範囲から、光ビームを確実に検出することができる。   In addition, since the first detection means and the second detection means are arranged along the entire circumference of the side surface of the detection unit arranged on the upper surface of the main body of the self-propelled device, the light beam is emitted from the entire 360 degree range. It can be detected reliably.

請求項2に記載の発明によれば、充電装置は、光ビームを発光する発光手段を備えており、そして、自走式装置は、充電装置の発光手段により発光された光ビームを受光して検出する第1検出手段が、側面全周に沿って所定間隔で複数配置されるとともに、充電装置の発光手段により発光された光ビームを受光して検出する第2検出手段が、自走式装置の進行方向を向き且つ当該複数の第1検出手段のうちの隣り合う2つの第1検出手段から等間隔の位置に配置された検出部と、当該自走式装置を回転させる回転駆動部と、を備え、判断手段によって、予め設定された当該自走式装置の充電タイミングになったか否かを判断することができ、回転制御手段によって、判断手段により予め設定された自走式装置の充電タイミングになったと判断された場合であって、第1検出手段又は第2検出手段により光ビームが検出された際に、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により当該光ビームが検出されるように、回転駆動部を制御することができる。
すなわち、自走式装置は、充電装置を検出するための検出部を具備しているだけなので、構成が簡易であるとともに低コストであり、また、充電装置は、自走式装置に検出されるための発光手段を具備しているだけなので、構成が簡易であるとともに低コストである。さらに、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されるように、すなわち、自走式装置が備える検出部と充電装置が備える発光手段とによって、確実に自走式装置を充電装置へ誘導できる状態となるように、自走式装置は回転されるため、確実に充電装置まで到着することができる。したがって、自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、より簡易且つより低コストな構成で、確実に自走式装置を充電装置まで自立走行させることができる。
According to the second aspect of the present invention, the charging device includes light emitting means for emitting a light beam, and the self-propelled device receives the light beam emitted by the light emitting means of the charging device. A plurality of first detecting means for detecting are arranged at predetermined intervals along the entire circumference of the side surface, and second detecting means for receiving and detecting the light beam emitted by the light emitting means of the charging device is a self-propelled device. A detection unit disposed at equal intervals from two adjacent first detection units among the plurality of first detection units, a rotation drive unit that rotates the self-propelled device, It is possible to determine whether the charging timing of the self-propelled device set in advance is reached by the determining means, and the charging timing of the self-propelled device preset by the determining means is determined by the rotation control means Judged to be And when the light beam is detected by the first detection means or the second detection means, the second detection means and the two first detection means arranged on the left and right of the second detection means. The rotation drive unit can be controlled so that the light beam is detected by at least one of the first detection means.
That is, since the self-propelled device only includes a detection unit for detecting the charging device, the configuration is simple and the cost is low, and the charging device is detected by the self-propelled device. Therefore, the configuration is simple and the cost is low. Further, the light beam is detected by the second detection means and at least one of the two first detection means arranged on the left and right of the second detection means, that is, self-running. The self-propelled device is rotated so that the self-propelled device can be reliably guided to the charging device by the detection unit and the light-emitting means included in the charging device, so that the mobile device reliably arrives at the charging device. can do. Therefore, in a self-propelled device charging system that includes a self-propelled device and a charging device that supplies power for charging to the self-propelled device, the self-propelled device is surely self-propelled with a simpler and lower-cost configuration. Can be made to stand on its own to the charging device.

請求項3に記載の発明によれば、請求項2に記載の発明と同様の効果が得られることは無論のこと、自走式装置は、走行制御手段によって、回転制御手段により回転駆動部が制御されている状態で、所定時間内に、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、自走式装置をランダム走行させることができる。
すなわち、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、第2検出手段と、当該第2検出手段の左右に配置された2つの第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されるまで、すなわち、自走式装置が備える検出部と充電装置が備える発光手段とによって、確実に自走式装置を充電装置へ誘導できる状態になるまで、自走式装置はランダム走行されるため、より確実に自走式装置を充電装置まで自立走行させることができる。
According to the invention described in claim 3, it is needless to say that the same effect as that of the invention described in claim 2 can be obtained. In the self-propelled device, the rotation drive unit is provided by the rotation control means. In a controlled state, within a predetermined time, the second detection means and at least one first detection means of two first detection means arranged on the left and right of the second detection means cause the light beam to be emitted. If not detected, the self-propelled device can run randomly.
That is, when a light beam is not detected by the second detection means and at least one first detection means of the two first detection means arranged on the left and right of the second detection means, the second detection means And at least one first detection means of the two first detection means arranged on the left and right of the second detection means until a light beam is detected, that is, a detection unit provided in the self-propelled device, The self-propelled device is driven randomly until the self-propelled device can be reliably guided to the charging device by the light-emitting means included in the charging device, so that the self-propelled device can travel more reliably to the charging device. Can be made.

請求項4に記載の発明によれば、請求項2又は3に記載の発明と同様の効果が得られることは無論のこと、第1検出手段及び第2検出手段が、自走式装置の本体部の上面に配置された検出部の側面全周に沿って配置されているため、360度全範囲から、光ビームを確実に検出することができる。   According to the invention described in claim 4, it is needless to say that the same effect as that of the invention described in claim 2 or 3 can be obtained. Since it is arranged along the entire circumference of the side surface of the detection unit arranged on the upper surface of the unit, the light beam can be reliably detected from the entire 360 ° range.

以下、図を参照して、本発明にかかる自走式装置充電システムの最良の形態を詳細に説明する。なお、発明の範囲は、図示例に限定されない。
本実施の形態では、自走式装置としてセキュリティロボットを例示して説明することとする。
Hereinafter, the best mode of a self-propelled device charging system according to the present invention will be described in detail with reference to the drawings. The scope of the invention is not limited to the illustrated example.
In this embodiment, a security robot will be described as an example of a self-propelled device.

<自走式装置充電システムの構成>
まず、自走式装置充電システム1の構成について、図1〜図7を参照して説明する。
<Configuration of self-propelled device charging system>
First, the structure of the self-propelled device charging system 1 will be described with reference to FIGS.

自走式装置充電システム1は、例えば、図1に示すように、所定の室内Rの床面F上を所定の走行パターンに基づいて自立走行して、室内Rに侵入する不審者等を監視するセキュリティロボット4と、セキュリティロボット4に充電のための電力を供給する充電装置2と、を備えて構成される。   For example, as shown in FIG. 1, the self-propelled device charging system 1 runs independently on the floor F of a predetermined room R based on a predetermined driving pattern, and monitors suspicious persons entering the room R. The security robot 4 and the charging device 2 that supplies the security robot 4 with power for charging are configured.

(充電装置の構成)
充電装置2は、例えば、図1及び図2に示すように、四角柱形状に形成された本体部20と、本体部20の正面に配置された接触端子21と、本体部20の正面に配置された発光手段としての発光部22と、等を備えて構成される。
ここで、本体部20のおける床面Fに略直交する一側面を前側(正面)とし、正面に対向する一側面を後側とする。また、前後方向に直交し且つ床面Fに略平行する方向を左右方向とし、前後方向及び左右方向の双方に直交する方向を上下方向とする。
(Configuration of charging device)
For example, as illustrated in FIGS. 1 and 2, the charging device 2 includes a main body portion 20 formed in a quadrangular prism shape, a contact terminal 21 disposed in front of the main body portion 20, and a front surface of the main body portion 20. And a light emitting unit 22 as a light emitting means.
Here, one side surface that is substantially orthogonal to the floor surface F of the main body 20 is defined as the front side (front surface), and one side surface that faces the front surface is defined as the rear side. Further, a direction orthogonal to the front-rear direction and substantially parallel to the floor surface F is defined as the left-right direction, and a direction orthogonal to both the front-rear direction and the left-right direction is defined as the up-down direction.

(接触端子)
接触端子21は、例えば、セキュリティロボット4が着脱自在であり、セキュリティロボット4が装着されると、セキュリティロボット4にセキュリティロボット4の蓄電池(図示省略)の充電のための電力を供給する。
(Contact terminal)
For example, the security robot 4 is detachably attached to the contact terminal 21. When the security robot 4 is attached, the contact terminal 21 supplies power for charging a storage battery (not shown) of the security robot 4 to the security robot 4.

(発光部)
発光部22は、例えば、LED(Light Emitting Diode)等を備えており、例えば、指向性のある光ビームMを発光する。
(Light emitting part)
The light emitting unit 22 includes, for example, an LED (Light Emitting Diode) or the like, and emits a directional light beam M, for example.

ここで、発光部22により発光される光ビームMは、例えば、セキュリティロボット4の検出部45(後述)が有する光ビームセンサ452(後述)により受光されて検出される。
その受光範囲M1の幅は、例えば、図3に示すように、発光部22からの距離が0〜約x1の間では、発光部22から離れるにつれて拡がって、発光部22からの距離が約x1の地点で約(y5+y5)になり、発光部22からの距離が約x1〜約x2mの間では、発光部22から離れるにつれて急激に狭まって、発光部22からの距離が約x2の地点で約(y2+y2)になり、発光部22からの距離が約x2〜約x10の間では、発光部22から離れるにつれて緩やかに狭まり、そして、発光部22からの距離が約x10以上になると、受光範囲M1は存在しなくなる。
Here, the light beam M emitted by the light emitting unit 22 is received and detected by, for example, a light beam sensor 452 (described later) included in the detection unit 45 (described later) of the security robot 4.
For example, as shown in FIG. 3, the width of the light receiving range M1 increases as the distance from the light emitting unit 22 increases from the light emitting unit 22 when the distance from the light emitting unit 22 is between 0 and about x1, and the distance from the light emitting unit 22 is about x1. It becomes about (y5 + y5) at the point of, and when the distance from the light emitting unit 22 is between about x1 and about x2 m, the distance from the light emitting unit 22 decreases abruptly, and the distance from the light emitting unit 22 is about x2 When the distance from the light emitting unit 22 is between about x2 and about x10, the distance gradually decreases as the distance from the light emitting unit 22 increases, and when the distance from the light emitting unit 22 becomes about x10 or more, the light receiving range M1 No longer exists.

(セキュリティロボットの構成)
セキュリティロボット4は、例えば、図1,図4〜図6に示すように、平面視略円盤状に形成された本体部40と、セキュリティロボット4が所定の室内Rの床面F上を自立走行するための走行部41と、セキュリティロボット4が所定の室内Rに侵入する不審者等を監視するための監視部42と、セキュリティロボット4が充電するための充電部43と、所定の指示をユーザが入力するための入力部44と、セキュリティロボット4が充電装置2を検出するための検出部45と、これら各部を制御するための制御部46と、等を備えて構成される。
ここで、セキュリティロボット4の進行方向に沿った方向を前後方向として、進行方向側を前側(正面)とし、進行方向の反対側を後側とする。また、前後方向に直交し且つ床面Fに略平行する方向を左右方向とし、前後方向及び左右方向の双方に直交する方向を上下方向とする。
(Configuration of security robot)
The security robot 4 is, for example, as shown in FIGS. 1 and 4 to 6, a main body portion 40 formed in a substantially disk shape in plan view, and the security robot 4 runs independently on a floor F in a predetermined room R. A traveling unit 41 for monitoring, a monitoring unit 42 for monitoring a suspicious person or the like that the security robot 4 enters a predetermined room R, a charging unit 43 for charging the security robot 4, and a predetermined instruction by the user Input unit 44 for input, a detection unit 45 for security robot 4 to detect charging device 2, a control unit 46 for controlling these units, and the like.
Here, the direction along the traveling direction of the security robot 4 is the front-rear direction, the traveling direction side is the front side (front), and the opposite side of the traveling direction is the rear side. Further, a direction orthogonal to the front-rear direction and substantially parallel to the floor surface F is defined as the left-right direction, and a direction orthogonal to both the front-rear direction and the left-right direction is defined as the up-down direction.

(本体部)
本体部40は、例えば、走行部41や制御部46などを衝撃や塵埃から保護するためのものであり、走行部41や制御部46などを覆うようにして設けられている。
(Main body)
The main body 40 is, for example, for protecting the traveling unit 41, the control unit 46, and the like from impact and dust, and is provided so as to cover the traveling unit 41, the control unit 46, and the like.

(走行部)
走行部41は、例えば、左キャタピラ411L及び右キャタピラ411Rと、左走行モータ412L及び右走行モータ412Rと、ジャイロセンサ413と、走行用センサ414と、等を備えて構成される。
(Traveling part)
The traveling unit 41 includes, for example, a left caterpillar 411L and a right caterpillar 411R, a left traveling motor 412L and a right traveling motor 412R, a gyro sensor 413, a traveling sensor 414, and the like.

左キャタピラ411L及び右キャタピラ411Rは、例えば、それぞれセキュリティロボット4の左側及び右側に配設されている。   The left caterpillar 411L and the right caterpillar 411R are disposed on the left side and the right side of the security robot 4, for example.

左走行モータ412L及び右走行モータ412Rは、制御部46から入力される制御信号に従って、例えば、セキュリティロボット4を走行させる駆動源として機能するとともに、例えば、回転駆動部として、セキュリティロボット4を回転(左転回や右転回)させる駆動源として機能する。
具体的には、左走行モータ412L及び右走行モータ412Rは、制御部46から入力される制御信号に従って、所定の駆動伝達部材を介して、それぞれ左キャタピラ411L及び右キャタピラ411Rを回転させる。
The left traveling motor 412L and the right traveling motor 412R function as a driving source for traveling the security robot 4 according to a control signal input from the control unit 46, for example, and rotate the security robot 4 as a rotational driving unit ( It functions as a driving source for turning left or right).
Specifically, the left traveling motor 412L and the right traveling motor 412R rotate the left caterpillar 411L and the right caterpillar 411R, respectively, via predetermined drive transmission members in accordance with a control signal input from the control unit 46.

ジャイロセンサ413は、例えば、機械式、光学式、流体式等のジャイロセンサであり、セキュリティロボット4の左転回時や右転回時の角速度を検出して、当該角速度検出信号を制御部46に出力する。   The gyro sensor 413 is, for example, a gyro sensor such as a mechanical type, an optical type, or a fluid type, and detects an angular velocity when the security robot 4 turns left or right, and outputs the angular velocity detection signal to the control unit 46. To do.

走行用センサ411は、例えば、超音波センサ、赤外線センサ等であり、本体部40の前面や側面などの所定箇所に設けられ、セキュリティロボット4の前方や側方などに位置する障害物を検出して、当該障害物検出信号を制御部46に出力する。   The traveling sensor 411 is, for example, an ultrasonic sensor, an infrared sensor, or the like, and is provided at a predetermined location such as a front surface or a side surface of the main body 40 and detects an obstacle located in front of the security robot 4 or on the side. Then, the obstacle detection signal is output to the control unit 46.

(監視部)
監視部42は、例えば、撮像レンズ421と、撮像素子422と、信号処理部423と、等を備えて構成される。
(Monitoring Department)
The monitoring unit 42 includes, for example, an imaging lens 421, an imaging element 422, a signal processing unit 423, and the like.

撮像レンズ421は、例えば、セキュリティロボット4の本体部40の正面に配置されている。   The imaging lens 421 is disposed, for example, in front of the main body 40 of the security robot 4.

撮像素子422は、例えば、CMOS(Complementary Metal-Oxide Semiconductor)型イメージセンサやCCD(Charge Coupled Device)型イメージセンサなどの撮像素子であり、制御部46から入力される制御信号に従って、例えば、撮像レンズ421を介して入力された被写体像を画像データに光電変換して、信号処理部423に出力する。   The imaging element 422 is an imaging element such as a complementary metal-oxide semiconductor (CMOS) type image sensor or a charge coupled device (CCD) type image sensor. For example, according to a control signal input from the control unit 46, for example, an imaging lens The subject image input via 421 is photoelectrically converted into image data and output to the signal processing unit 423.

信号処理部423は、制御部46から入力される制御信号に従って、例えば、撮像素子422から入力された画像データに所定の画像処理を施して、制御部46に出力する。   The signal processing unit 423 performs, for example, predetermined image processing on the image data input from the image sensor 422 in accordance with the control signal input from the control unit 46 and outputs the processed image data to the control unit 46.

(充電部)
充電部43は、例えば、端子431と、電力量センサ432と、等を備えて構成される。
(Charging part)
The charging unit 43 includes, for example, a terminal 431, an electric energy sensor 432, and the like.

端子431は、例えば、セキュリティロボット4の本体部40の正面に配置され、充電装置2の接触端子21と接触して、接触端子21からセキュリティロボット4の蓄電池(図示省略)の充電のための電力の供給を受ける。   The terminal 431 is disposed, for example, in front of the main body 40 of the security robot 4, contacts the contact terminal 21 of the charging device 2, and power for charging a storage battery (not shown) of the security robot 4 from the contact terminal 21. Receive the supply.

電力量センサ432は、例えば、セキュリティロボット4の蓄電池(図示省略)に蓄えられた電力量を検出して、当該電力量検出信号を制御部46に出力する。   For example, the power amount sensor 432 detects the amount of power stored in a storage battery (not shown) of the security robot 4 and outputs the power amount detection signal to the control unit 46.

(入力部)
入力部44は、例えば、各種機能キー等から構成され、ユーザのキー操作に伴う押下信号を制御部46に出力する。
(Input section)
The input unit 44 includes, for example, various function keys and the like, and outputs a press signal accompanying the user's key operation to the control unit 46.

(検出部)
検出部45は、例えば、セキュリティロボット4の本体部40の上面に配設されており、例えば、突出部451と、突出部451の側面全周に沿って配置された複数の光ビームセンサ452と、等を備えて構成される。
(Detection unit)
The detection unit 45 is disposed, for example, on the upper surface of the main body 40 of the security robot 4. For example, the detection unit 45 includes a protrusion 451 and a plurality of light beam sensors 452 arranged along the entire side surface of the protrusion 451. , And so on.

突出部451は、例えば、円柱形状に形成されており、例えば、セキュリティロボット4の本体部40の上面から突出するように設けられている。
なお、突出部451の形状は、円柱形の限りでなく、平面視において略円形(例えば、円柱形や円筒形など)であってもよいし、平面視において多角形(例えば、多角柱形や多角筒形など)であってもよい。
The protruding portion 451 is formed in, for example, a cylindrical shape, and is provided so as to protrude from the upper surface of the main body portion 40 of the security robot 4, for example.
The shape of the protruding portion 451 is not limited to a columnar shape, but may be a substantially circular shape (for example, a columnar shape or a cylindrical shape) in a plan view, or a polygon shape (for example, a polygonal column shape or the like) It may be a polygonal cylinder or the like.

光ビームセンサ452は、例えば、充電装置2の発光部22により発光された光ビームMの波長と同等の波長の光を検出するように構成され、光ビームMを受光して検出すると、当該光ビーム検出信号を制御部46に出力する。   For example, the light beam sensor 452 is configured to detect light having a wavelength equivalent to the wavelength of the light beam M emitted by the light emitting unit 22 of the charging device 2. When the light beam M is received and detected, the light beam sensor 452 receives the light. The beam detection signal is output to the control unit 46.

具体的には、光ビームセンサ452は、例えば、突出部451の側面全周に沿って所定間隔で複数(例えば、5個)配置された第1検出手段としての第1光ビームセンサ452aと、セキュリティロボット4の進行方向を向き且つ複数の第1光ビームセンサ452aのうちの隣り合う2つの第1光ビームセンサ452a,452aから等間隔の位置に配置された第2検出手段としての第2光ビームセンサ452bと、等から構成されている。
なお、第1光ビームセンサ452aの個数は、5個の限りでなく、複数であれば任意である。
Specifically, the light beam sensor 452 includes, for example, a plurality of (for example, five) first light beam sensors 452a that are arranged at predetermined intervals along the entire side surface of the protrusion 451, and Second light as second detection means which faces the traveling direction of the security robot 4 and is arranged at equal intervals from two adjacent first light beam sensors 452a and 452a among the plurality of first light beam sensors 452a. It consists of a beam sensor 452b and the like.
Note that the number of the first light beam sensors 452a is not limited to five and may be any number as long as it is plural.

(制御部)
制御部46は、例えば、図6に示すように、CPU(Central Processing Unit)461と、RAM(Random Access Memory)462と、ROM(Read Only Memory)463と、等を備えて構成される。
(Control part)
For example, as illustrated in FIG. 6, the control unit 46 includes a CPU (Central Processing Unit) 461, a RAM (Random Access Memory) 462, a ROM (Read Only Memory) 463, and the like.

CPU461は、例えば、ROM462に記憶されたセキュリティロボット4用の各種処理プログラムに従って各種の制御動作を行う。   The CPU 461 performs various control operations according to various processing programs for the security robot 4 stored in the ROM 462, for example.

RAM462は、例えば、CPU461によって実行される処理プログラム等を展開するためのプログラム格納領域や、入力データや上記処理プログラムが実行される際に生じる処理結果等を格納するデータ格納領域などを備える。   The RAM 462 includes, for example, a program storage area for expanding a processing program executed by the CPU 461, a data storage area for storing input data, a processing result generated when the processing program is executed, and the like.

ROM463は、例えば、セキュリティロボット4で実行可能なシステムプログラム、当該システムプログラムで実行可能な各種処理プログラム、これら各種処理プログラムを実行する際に使用されるデータ、CPU461によって演算処理された処理結果のデータ等を記憶する。なお、プログラムは、コンピュータが読み取り可能なプログラムコードの形でROM463に記憶されている。   The ROM 463 is, for example, a system program that can be executed by the security robot 4, various processing programs that can be executed by the system program, data used when executing these various processing programs, and data of processing results that are arithmetically processed by the CPU 461. Memorize etc. Note that the program is stored in the ROM 463 in the form of a computer-readable program code.

具体的には、ROM463は、例えば、通常動作モードプログラム463aと、判断プログラム463bと、回転制御プログラム463cと、ランダム走行制御プログラム463dと、直進走行制御プログラム463eと、等を記憶している。   Specifically, the ROM 463 stores, for example, a normal operation mode program 463a, a determination program 463b, a rotation control program 463c, a random travel control program 463d, a straight travel control program 463e, and the like.

通常動作モードプログラム463aは、例えば、セキュリティロボット4に通常動作をさせるために、走行部41や監視部42などのセキュリティロボット4の各部を制御する機能を、CPU461に実現させる。
ここで、通常動作とは、例えば、セキュリティロボット4が、所定の室内Rの床面F上を所定の走行パターンに基づいて自立走行して、室内Rを監視する動作である。
For example, the normal operation mode program 463a causes the CPU 461 to realize a function of controlling each part of the security robot 4 such as the traveling unit 41 and the monitoring unit 42 in order to cause the security robot 4 to perform a normal operation.
Here, the normal operation is, for example, an operation in which the security robot 4 travels independently on the floor F of the predetermined room R based on a predetermined traveling pattern and monitors the room R.

判断プログラム463bは、例えば、予め設定されたセキュリティロボット4の充電タイミングになったか否かを判断する機能を、CPU461に実現させる。   For example, the determination program 463b causes the CPU 461 to realize a function of determining whether or not a preset charging timing of the security robot 4 has come.

具体的には、CPU461は、例えば、電力量センサ432から入力された電力量検出信号に基づいて、セキュリティロボット4の蓄電池(図示省略)に蓄えられた電力量が一定量以下になったか否かを判断し、そして、セキュリティロボット4の蓄電池に蓄えられた電力量が一定量以下になったと判断した場合に、セキュリティロボット4の充電タイミングになったと判断する。
CPU461は、かかる判断プログラム463bを実行することによって、判断手段として機能する。
Specifically, for example, the CPU 461 determines whether the amount of power stored in the storage battery (not shown) of the security robot 4 has become a certain amount or less based on the power amount detection signal input from the power amount sensor 432. When it is determined that the amount of electric power stored in the storage battery of the security robot 4 has become a certain amount or less, it is determined that the timing for charging the security robot 4 has come.
The CPU 461 functions as a determination unit by executing the determination program 463b.

回転制御プログラム463cは、例えば、判断プログラム463bを実行したCPU461により予め設定されたセキュリティロボット4の充電タイミングになったと判断された場合であって、第1光ビームセンサ452a又は第2光ビームセンサ452bにより光ビームMが検出された際に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、の2つ又は3つの光ビームセンサ452により光ビームMが検出されるように、すなわち、光ビームMが到来する方向にセキュリティロボット4の進行方向が向くように、左走行モータ412L及び右走行モータ412Rを制御して、セキュリティロボット4を回転させる機能を、CPU461に実現させる。   The rotation control program 463c is, for example, a case where the CPU 461 that has executed the determination program 463b determines that the charging timing of the security robot 4 is set in advance, and the first light beam sensor 452a or the second light beam sensor 452b. When the light beam M is detected by the second light beam sensor 452b, and at least one first light beam among the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. The left traveling motor 412L so that the light beam M is detected by the two or three light beam sensors 452 of the sensor 452a, that is, the traveling direction of the security robot 4 is directed in the direction in which the light beam M arrives. And the right traveling motor 412R to control the security robot 4 The function of the rolling, to realize the CPU461.

ここで、CPU461は、例えば、複数(5個)の第1光ビームセンサ452aのうちの1つの第1光ビームセンサ452a又は隣り合う2つの第1光ビームセンサ452a,452aから光ビーム検出信号が入力された場合に、第1光ビームセンサ452aにより光ビームMが検出されたと判断する。   Here, for example, the CPU 461 receives a light beam detection signal from one first light beam sensor 452a or two adjacent first light beam sensors 452a and 452a out of a plurality (five) of first light beam sensors 452a. If it is input, it is determined that the light beam M is detected by the first light beam sensor 452a.

具体的には、CPU461は、第2光ビームセンサ452bにより光ビームMが検出されたと判断すると、或いは、例えば、図7に示すように、第1光ビームセンサ452aにより光ビームMが検出されたと判断すると、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されるまで、すなわち、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、から光ビーム検出信号が入力されるまで、セキュリティロボット4を回転させる。   Specifically, when the CPU 461 determines that the light beam M is detected by the second light beam sensor 452b, or for example, as shown in FIG. 7, the light beam M is detected by the first light beam sensor 452a. When the determination is made, the light beam M is generated by the second light beam sensor 452b and at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. That is, that is, the second light beam sensor 452b and at least one of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, Until the light beam detection signal is input, the security robot 4 is rotated.

また、回転制御プログラム463cは、例えば、直進走行制御プログラム463eを実行したCPU461による制御によってセキュリティロボット4が直進走行している間、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出され続けるように、左走行モータ412L及び右走行モータ412Rを制御して、セキュリティロボット4を回転させる機能を、CPU461に実現させる。   The rotation control program 463c is, for example, on the left and right sides of the second light beam sensor 452b and the second light beam sensor 452b while the security robot 4 is traveling straight by control by the CPU 461 executing the straight traveling control program 463e. The left traveling motor 412L and the right traveling motor 412R are controlled so that the light beam M is continuously detected by at least one first light beam sensor 452a of the two disposed first light beam sensors 452a and 452a. The CPU 461 realizes the function of rotating the security robot 4.

具体的には、CPU461は、例えば、セキュリティロボット4が直進走行している間に、光ビームMを検出している光ビームセンサ452が切り替わったと判断すると、セキュリティロボット4の直進走行を停止して、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されるように、セキュリティロボット4を回転させ、そして、セキュリティロボット4の直進走行を開始させる。   Specifically, for example, when the CPU 461 determines that the light beam sensor 452 detecting the light beam M has been switched while the security robot 4 is traveling straight, the CPU 461 stops the straight traveling of the security robot 4. The light beam M is detected by the second light beam sensor 452b and at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. As described above, the security robot 4 is rotated, and the security robot 4 starts to travel straight ahead.

より具体的には、CPU461は、例えば、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出された後に、当該3つの光ビームセンサ452により光ビームMが検出されなくなった場合には、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、の2つ又は3つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させる。   More specifically, the CPU 461, for example, includes three light beam sensors 452 including a second light beam sensor 452b and two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. When the light beam M is not detected by the three light beam sensors 452 after the light beam M is detected by the above, the second light beam sensor 452b and the second light beam sensor 452b are arranged on the left and right sides. The security robot 4 is rotated so that the light beam M is detected by two or three light beam sensors 452 of at least one of the two first light beam sensors 452a and 452a. .

また、CPU461は、例えば、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出された後に、当該2つの光ビームセンサ452により光ビームMが検出されなくなった場合には、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、の2つ又は3つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させる。
なお、例えば、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出された後に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出された場合には、CPU461は、セキュリティロボット4を回転させないこととする。
Further, the CPU 461, for example, a second light beam sensor 452b, one first light beam sensor 452a out of two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, When the light beam M is not detected by the two light beam sensors 452 after the light beam M is detected by the two light beam sensors 452, the second light beam sensor 452b and the second light beam sensor 452 The light beam M is detected by two or three light beam sensors 452 of at least one of the two first light beam sensors 452a and 452a arranged on the left and right of 452b. The security robot 4 is rotated.
Note that, for example, two of the second light beam sensor 452b and one first light beam sensor 452a out of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. After the light beam M is detected by the light beam sensor 452, three light beams, that is, a second light beam sensor 452b and two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. When the light beam M is detected by the beam sensor 452, the CPU 461 does not rotate the security robot 4.

ここで、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出された場合が、セキュリティロボット4の接触端子431と充電装置2の端子21とが正対している場合である。
したがって、CPU461は、まず、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させ、第1所定時間内に当該3つの光ビームセンサ452により光ビームMが検出されない場合には、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させることとする。
CPU461は、かかる回転制御プログラム463cを実行することによって、回転制御手段として機能する。
Here, the light beam M is detected by the three light beam sensors 452 including the second light beam sensor 452b and the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. This is a case where the contact terminal 431 of the security robot 4 and the terminal 21 of the charging device 2 face each other.
Therefore, first, the CPU 461 uses the three light beam sensors 452 including the second light beam sensor 452b and the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. When the security robot 4 is rotated so that the light beam M is not detected by the three light beam sensors 452 within the first predetermined time, the security robot 4 is arranged on the left and right sides of the second light beam sensor 452b. The security robot 4 is rotated so that the light beam M is detected by one of the two first light beam sensors 452a and 452a and the first light beam sensor 452a. .
The CPU 461 functions as a rotation control unit by executing the rotation control program 463c.

ランダム走行制御プログラム463dは、例えば、セキュリティロボット4をランダム走行させるために、走行部41等のセキュリティロボット4の各部を制御する機能を、CPU461に実現させる。   The random traveling control program 463d causes the CPU 461 to realize a function of controlling each part of the security robot 4 such as the traveling unit 41 in order to cause the security robot 4 to randomly travel, for example.

具体的には、CPU461は、例えば、判断プログラム463bを実行したCPU461により予め設定されたセキュリティロボット4の充電タイミングになったと判断された場合に、セキュリティロボット4をランダム走行させる。   Specifically, for example, when the CPU 461 that has executed the determination program 463b determines that the charging timing of the security robot 4 set in advance is reached, the CPU 461 causes the security robot 4 to run at random.

また、CPU461は、例えば、回転制御プログラム453cを実行したCPU461により左走行モータ412L及び右走行モータ412Rが制御されている状態で、すなわち、セキュリティロボット4が回転している状態で、所定時間内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されない場合には、セキュリティロボット4をランダム走行させる。
より具体的には、例えば、第1所定時間内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されず、その後、第2所定時間内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されなかった場合に、CPU461は、所定時間(=第1所定時間+第2所定時間)内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されないと判断して、セキュリティロボット4をランダム走行させる。
In addition, the CPU 461, for example, in a state where the left traveling motor 412L and the right traveling motor 412R are controlled by the CPU 461 executing the rotation control program 453c, that is, in a state where the security robot 4 is rotating, within a predetermined time. The light beam M is detected by the second light beam sensor 452b and at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. If not, the security robot 4 is run at random.
More specifically, for example, the first light beam sensor 452b and two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b within the first predetermined time are provided. The light beam M is not detected by the light beam sensor 452, and then the second light beam sensor 452b and the two first light beam sensors 452a arranged on the left and right of the second light beam sensor 452b within the second predetermined time. , 452a, and the first light beam sensor 452a and the two light beam sensors 452 do not detect the light beam M, the CPU 461 determines the predetermined time (= first predetermined time + second predetermined time). ), The second light beam sensor 452b, and two of the first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b are small. Also one of the first light beam sensor 452a, it is determined that the light beam M is not detected by, it is a random travel security robot 4.

なお、第1光ビームセンサ452a又は第2光ビームセンサ452bにより光ビームMが検出された後、セキュリティロボット4が回転している状態で、所定時間内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、の2つ又は3つの光ビームセンサ452により光ビームMが検出されない場合、すなわち、1つの光ビームセンサ452にしか光ビームMが検出されない場合とは、例えば、充電装置2とセキュリティロボット4との間の距離が所定距離以上の場合である。
光ビームセンサ452による光ビームMの受光範囲M1の幅は、例えば、図3に示すように、発光部22からの距離が約x1〜約x10の間では、発光部22から離れるにつれて狭まっていく。そのため、充電装置2とセキュリティロボット4との間の距離が所定距離以上の場合には、1つの光ビームセンサ452により光ビームMを検出することはできるものの、複数の光ビームセンサ452により同時に光ビームMを検出することができない。
CPU461は、かかるランダム走行制御プログラム453dを実行することによって、走行制御手段として機能する。
In addition, after the light beam M is detected by the first light beam sensor 452a or the second light beam sensor 452b, the second light beam sensor 452b and the second light beam sensor 452b are within a predetermined time while the security robot 4 is rotating. The light beam M is detected by two or three light beam sensors 452 of at least one of the two first light beam sensors 452a and 452a arranged on the left and right of the two light beam sensors 452b. The case where the light beam M is detected only by one light beam sensor 452 is a case where the distance between the charging device 2 and the security robot 4 is a predetermined distance or more, for example.
For example, as shown in FIG. 3, the width of the light receiving range M1 of the light beam M by the light beam sensor 452 decreases as the distance from the light emitting unit 22 increases when the distance from the light emitting unit 22 is between about x1 and about x10. . Therefore, when the distance between the charging device 2 and the security robot 4 is equal to or greater than a predetermined distance, the light beam M can be detected by one light beam sensor 452, but the light beams M 452 can simultaneously detect light. The beam M cannot be detected.
The CPU 461 functions as a travel control unit by executing the random travel control program 453d.

直進走行制御プログラム463eは、例えば、回転制御プログラム463cを実行したCPU461による制御によってセキュリティロボット4が回転している状態で、所定時間内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出された場合に、セキュリティロボット4を直進(前進)走行させるために、すなわち、セキュリティロボット4を充電装置2に向けて走行させるために、走行部41等のセキュリティロボット4の各部を制御する機能を、CPU461に実現させる。   The straight traveling control program 463e is, for example, the second light beam sensor 452b and the second light beam sensor 452b within a predetermined time in a state where the security robot 4 is rotating under the control of the CPU 461 executing the rotation control program 463c. When the light beam M is detected by at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of the security robot 4, the security robot 4 is caused to travel straight (forward). Therefore, in order to run the security robot 4 toward the charging device 2, the CPU 461 realizes a function of controlling each part of the security robot 4 such as the running unit 41.

<自走式装置充電システムによる処理(充電処理)>
次に、自走式装置充電システム1のセキュリティロボット4による充電に関する処理について、図8〜図10のフローチャートを参照して説明する。
<Processing by self-propelled device charging system (charging process)>
Next, processing related to charging by the security robot 4 of the self-propelled device charging system 1 will be described with reference to the flowcharts of FIGS.

まず、セキュリティロボット4のCPU461は、通常動作モードプログラム463aを実行して、セキュリティロボット4による通常動作を開始させる(ステップS11)。   First, the CPU 461 of the security robot 4 executes the normal operation mode program 463a to start normal operation by the security robot 4 (step S11).

次いで、CPU461は、判断プログラム463bを実行して、予め設定されたセキュリティロボット4の充電タイミングになったか否かを判断する(ステップS12)。   Next, the CPU 461 executes the determination program 463b, and determines whether or not the preset charging timing of the security robot 4 has come (step S12).

ステップS12で、予め設定されたセキュリティロボット4の充電タイミングになっていないと判断すると(ステップS12;No)、CPU461は、ステップS12の処理を繰り返して行う。   If it is determined in step S12 that the charging timing of the security robot 4 set in advance is not reached (step S12; No), the CPU 461 repeats the process of step S12.

一方、ステップS12で、予め設定されたセキュリティロボット4の充電タイミングになったと判断すると(ステップS12;Yes)、CPU461は、セキュリティロボット4による通常動作を終了させ(ステップS13)、ランダム走行制御プログラム463dを実行して、セキュリティロボット4によるランダム走行を開始させる(ステップS14)。   On the other hand, if it is determined in step S12 that the preset charging timing of the security robot 4 has been reached (step S12; Yes), the CPU 461 ends the normal operation by the security robot 4 (step S13), and the random travel control program 463d. To start random running by the security robot 4 (step S14).

次いで、CPU461は、光ビームセンサ452により光ビームMが検出されたか否かを判断する(ステップS15)。   Next, the CPU 461 determines whether or not the light beam M is detected by the light beam sensor 452 (step S15).

ステップS15で、光ビームセンサ452により光ビームMが検出されていないと判断すると(ステップS15;No)、CPU461は、ステップS15の処理を繰り返して行う。   If it is determined in step S15 that the light beam M is not detected by the light beam sensor 452 (step S15; No), the CPU 461 repeats the process of step S15.

一方、ステップS15で、光ビームセンサ452により光ビームMが検出されたと判断すると(ステップS15;Yes)、CPU461は、セキュリティロボット4によるランダム走行を終了させる(ステップS16)。   On the other hand, if it is determined in step S15 that the light beam M has been detected by the light beam sensor 452 (step S15; Yes), the CPU 461 ends random running by the security robot 4 (step S16).

次いで、CPU461は、回転制御プログラム463cを実行して、計時部(図示省略)による計時を開始させて(ステップS17)、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させる(ステップS18)。   Next, the CPU 461 executes the rotation control program 463c to start measuring time by a time measuring unit (not shown) (step S17), and is arranged on the left and right of the second light beam sensor 452b and the second light beam sensor 452b. The security robot 4 is rotated so that the light beam M is detected by the two first light beam sensors 452a and 452a (step S18).

次いで、CPU461は、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されたか否かを判断する(ステップS19)。   Next, the CPU 461 detects the light beam M by the three light beam sensors 452 including the second light beam sensor 452b and the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. It is determined whether or not it has been done (step S19).

ステップS19で、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されたと判断すると(ステップS19;Yes)、CPU461は、ステップS25の処理に移行する。   In step S19, the light beam M is detected by the three light beam sensors 452 including the second light beam sensor 452b and the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. If the CPU 461 determines that it has been satisfied (step S19; Yes), the process proceeds to step S25.

一方、ステップS19で、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されていないと判断すると(ステップS19;No)、CPU461は、計時部(図示省略)による計時結果に基づいて、第1所定時間が経過したか否かを判断する(ステップS20)。   On the other hand, in step S19, the light beam M is generated by the three light beam sensors 452 including the second light beam sensor 452b and the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. If it is determined that it has not been detected (step S19; No), the CPU 461 determines whether or not the first predetermined time has elapsed based on the time measurement result by the time measuring unit (not shown) (step S20).

ステップS20で、第1所定時間が経過していないと判断すると(ステップS20;No)、CPU461は、ステップS18以降の処理を繰り返して行う。   If it is determined in step S20 that the first predetermined time has not elapsed (step S20; No), the CPU 461 repeatedly performs the processing from step S18.

一方、ステップS20で、第1所定時間が経過したと判断すると(ステップS20;Yes)、CPU461は、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させる(ステップS21)。   On the other hand, if it is determined in step S20 that the first predetermined time has elapsed (step S20; Yes), the CPU 461 has a second light beam sensor 452b and two first light beams arranged on the left and right of the second light beam sensor 452b. The security robot 4 is rotated so that the light beam M is detected by one of the light beam sensors 452a and 452a and the first light beam sensor 452a of the light beam sensors 452a (step S21).

次いで、CPU462は、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されたか否かを判断する(ステップS22)。   Next, the CPU 462 includes two of the second light beam sensor 452b and one first light beam sensor 452a out of the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. It is determined whether or not the light beam M is detected by the two light beam sensors 452 (step S22).

ステップS22で、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されていないと判断すると(ステップS22;No)、CPU461は、計時部(図示省略)による計時結果に基づいて、所定時間(=第1所定時間+第2所定時間)が経過したか否かを判断する(ステップS23)。   In step S22, two of the second light beam sensor 452b and one first light beam sensor 452a out of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. If it is determined that the light beam M is not detected by the light beam sensor 452 (step S22; No), the CPU 461 determines a predetermined time (= first predetermined time + second) based on a time measurement result by a time measuring unit (not shown). It is determined whether or not a predetermined time has elapsed (step S23).

ステップS23で、所定時間が経過していないと判断すると(ステップS23;No)、CPU461は、ステップS21以降の処理を繰り返して行う。   If it is determined in step S23 that the predetermined time has not elapsed (step S23; No), the CPU 461 repeats the processing after step S21.

一方、ステップS23で、所定時間が経過したと判断すると(ステップS23;Yes)、CPU461は、充電装置2とセキュリティロボット4との間の距離が所定距離以上であると判断して、計時部(図示省略)による計時を終了させ(ステップS24)、ステップS14以降の処理を繰り返して行う。   On the other hand, if it is determined in step S23 that the predetermined time has elapsed (step S23; Yes), the CPU 461 determines that the distance between the charging device 2 and the security robot 4 is equal to or greater than the predetermined distance, and the time counting unit ( The timing by (not shown) is terminated (step S24), and the processes after step S14 are repeated.

また、ステップS22で、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの第1光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されたと判断すると(ステップS22;Yes)、CPU461は、計時部(図示省略)による計時を終了させ(ステップS25)、直進走行制御プログラム463eを実行して、セキュリティロボット4による直進走行を開始させる(ステップS26)。   In step S22, the second light beam sensor 452b and one first light beam sensor 452a out of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, If it is determined that the light beam M is detected by the two light beam sensors 452 (step S22; Yes), the CPU 461 ends the time measurement by the time measuring unit (not shown) (step S25) and executes the straight traveling control program 463e. Then, the straight traveling by the security robot 4 is started (step S26).

次いで、CPU461は、回転制御プログラム463cを実行して、光ビームMを検出している光ビームセンサ452が切り替わったか否かを判断する(ステップS27)。   Next, the CPU 461 executes the rotation control program 463c to determine whether or not the light beam sensor 452 that detects the light beam M has been switched (step S27).

ステップS27で、光ビームMを検出している光ビームセンサ452が切り替わっていないと判断すると(ステップS27;No)、CPU451は、ステップS30の処理に移行する。   If it is determined in step S27 that the light beam sensor 452 that detects the light beam M has not been switched (step S27; No), the CPU 451 proceeds to the process of step S30.

一方、ステップS27で、光ビームMを検出している光ビームセンサ452が切り替わったと判断すると(ステップS27;Yes)、CPU461は、光ビームMを検出している光ビームセンサ452が、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの光ビームセンサ452aと、の2つの光ビームセンサ452から、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452に切り替わったか否かを判断する(ステップS28)。   On the other hand, when it is determined in step S27 that the light beam sensor 452 that detects the light beam M has been switched (step S27; Yes), the CPU 461 detects that the light beam sensor 452 that detects the light beam M is the second light. The second light from the two light beam sensors 452 of the beam sensor 452b and one of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. It is determined whether or not the three light beam sensors 452 of the beam sensor 452b and the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b have been switched (step S28).

ステップS28で、光ビームMを検出している光ビームセンサ452が、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの光ビームセンサ452aと、の2つの光ビームセンサ452から、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452に切り替わっていないと判断すると(ステップS28;No)、CPU461は、セキュリティロボット4による直進走行を終了させて(ステップS29)、ステップS17以降の処理を繰り返して行う。   In step S28, the light beam sensor 452 detecting the light beam M is a second light beam sensor 452b, and two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. A first light beam sensor 452a, a second light beam sensor 452b, two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, When the CPU 461 determines that the three light beam sensors 452 have not been switched (step S28; No), the CPU 461 ends the straight traveling by the security robot 4 (step S29), and repeats the processing from step S17 onward.

一方、ステップS28で、光ビームMを検出している光ビームセンサ452が、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうちの1つの光ビームセンサ452aと、の2つの光ビームセンサ452から、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452に切り替わったと判断すると(ステップS28;Yes)、CPU461は、電気的に、又はスイッチによって、端子431が、充電装置2の接触端子21と接触したか否かを判断する(ステップS30)。   On the other hand, in step S28, the light beam sensor 452 detecting the light beam M is a second light beam sensor 452b and two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. The first light beam sensor 452a, the second light beam sensor 452b, the second light beam sensor 452b, and the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. When the CPU 461 determines that the terminal 431 is in contact with the contact terminal 21 of the charging device 2 electrically or by a switch, the CPU 461 determines that the three light beam sensors 452 are switched (step S28; Yes). Judgment is made (step S30).

ステップS30で、端子431が、充電装置2の接触端子21と接触していないと判断すると(ステップS30;No)、CPU461は、ステップS27以降の処理を繰り返して行う。   If it is determined in step S30 that the terminal 431 is not in contact with the contact terminal 21 of the charging device 2 (step S30; No), the CPU 461 repeatedly performs the processing from step S27.

一方、ステップS30で、端子431が、充電装置2の接触端子21と接触したと判断すると(ステップS30;Yes)、CPU461は、電力量センサ432から入力された電力量検出信号に基づいて、セキュリティロボット4の充電が完了したか否かを判断する(ステップS31)。   On the other hand, if it is determined in step S30 that the terminal 431 has come into contact with the contact terminal 21 of the charging device 2 (step S30; Yes), the CPU 461 performs security based on the power amount detection signal input from the power amount sensor 432. It is determined whether charging of the robot 4 has been completed (step S31).

ステップS31で、セキュリティロボット4の充電が完了していないと判断すると(ステップS31;No)、CPU461は、ステップS31の処理を繰り返して行う。   If it is determined in step S31 that charging of the security robot 4 has not been completed (step S31; No), the CPU 461 repeats the process of step S31.

一方、ステップS31で、セキュリティロボット4の充電が完了したと判断すると(ステップS31;Yes)、CPU461は、ステップS11以降の処理を繰り返して行う。   On the other hand, when it is determined in step S31 that charging of the security robot 4 has been completed (step S31; Yes), the CPU 461 repeatedly performs the processing from step S11.

以上説明した本発明の自走式装置充電システム1によれば、所定の室内Rの床面F上を自立走行するセキュリティロボット4と、セキュリティロボット4に充電のための電力を供給する充電装置2と、を備えている。
そして、充電装置2は、セキュリティロボット4が着脱自在であり、セキュリティロボット4が装着されるとセキュリティロボット4に充電のための電力を供給する接触端子21と、光ビームMを発光する発光部22と、を備えている。
また、セキュリティロボット4は、接触端子21と接触して、接触端子21から充電のための電力の供給を受ける端子431と、発光部22により発光された光ビームMを受光して検出する第1光ビームセンサ452aが、側面全周に沿って所定間隔で複数配置されるとともに、発光部22により発光された光ビームMを受光して検出する第2光ビームセンサ452bが、セキュリティロボット4の進行方向を向き且つ複数の第1光ビームセンサ452aのうちの隣り合う2つの第1光ビームセンサ452a,452aから等間隔の位置に配置された検出部45と、セキュリティロボット4を回転させる左走行モータ412L及び右走行モータ412Rと、を備え、判断プログラム463bを実行したCPU461によって、予め設定されたセキュリティロボット4の充電タイミングになったか否かを判断することができ、回転制御プログラム463cを実行したCPU461によって、判断プログラム463bを実行したCPU461により予め設定されたセキュリティロボット4の充電タイミングになったと判断された場合であって、第1光ビームセンサ452a又は第2光ビームセンサ452bにより光ビームMが検出された際に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されるように、左走行モータ412L及び右走行モータ412Rを制御して、セキュリティロボット4を回転させることができる。
すなわち、セキュリティロボット4は、充電装置2を検出するための検出部45を具備しているだけなので、構成が簡易であるとともに低コストであり、また、充電装置2は、セキュリティロボット4に検出されるための発光部22を具備しているだけなので、構成が簡易であるとともに低コストである。さらに、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されるように、すなわち、セキュリティロボット4が備える検出部45と充電装置1が備える発光部22とによって、確実にセキュリティロボット4を充電装置2へ誘導できる状態となるように、セキュリティロボット4は回転されるため、確実に充電装置2まで到着することができる。したがって、セキュリティロボット4と、セキュリティロボット4に充電のための電力を供給する充電装置2と、を備える自走式装置充電システム1において、より簡易且つより低コストな構成で、確実にセキュリティロボット4を充電装置2まで自立走行させることができる。
According to the self-propelled device charging system 1 of the present invention described above, the security robot 4 that runs autonomously on the floor F of the predetermined room R, and the charging device 2 that supplies the security robot 4 with power for charging. And.
The charging device 2 is detachably attachable to the security robot 4, and when the security robot 4 is attached, the contact terminal 21 that supplies power for charging to the security robot 4 and the light emitting unit 22 that emits the light beam M. And.
In addition, the security robot 4 is in contact with the contact terminal 21 to receive and detect the terminal 431 that receives supply of power for charging from the contact terminal 21 and the light beam M emitted from the light emitting unit 22. A plurality of light beam sensors 452a are arranged at a predetermined interval along the entire circumference of the side surface, and a second light beam sensor 452b that receives and detects the light beam M emitted by the light emitting unit 22 is advanced by the security robot 4. A left traveling motor that rotates the security robot 4 and a detection unit 45 that is oriented at an equal interval from two adjacent first light beam sensors 452a and 452a among the plurality of first light beam sensors 452a. 412L and a right traveling motor 412R, which are preset by a CPU 461 that has executed the determination program 463b. It can be determined whether or not the charging timing of the security robot 4 has come, and the CPU 461 that has executed the rotation control program 463c determines that the charging timing of the security robot 4 that has been preset by the CPU 461 that has executed the determination program 463b has come. When the light beam M is detected by the first light beam sensor 452a or the second light beam sensor 452b, the second light beam sensor 452b and the second light beam sensor 452b are arranged on the left and right sides. The left traveling motor 412L and the right traveling motor 412R are controlled so that the light beam M is detected by at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a. The robot 4 can be rotated.
That is, since the security robot 4 includes only the detection unit 45 for detecting the charging device 2, the configuration is simple and the cost is low, and the charging device 2 is detected by the security robot 4. Therefore, the configuration is simple and the cost is low. Further, the light beam M is generated by the second light beam sensor 452b and at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b. The security robot 4 is detected so that the security robot 4 can be reliably guided to the charging device 2 by the detection unit 45 provided in the security robot 4 and the light emitting unit 22 provided in the charging device 1. Since it rotates, it can arrive at the charging device 2 reliably. Accordingly, in the self-propelled device charging system 1 that includes the security robot 4 and the charging device 2 that supplies the security robot 4 with power for charging, the security robot 4 can be surely configured with a simpler and lower cost configuration. Can be driven independently up to the charging device 2.

また、セキュリティロボット4は、ランダム走行制御プログラム463dを実行したCPU461によって、回転制御プログラム463cを実行したCPU461により左走行モータ412L及び右走行モータ412Rが制御されてセキュリティロボット4が回転している状態で、所定時間内に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されない場合には、セキュリティロボット4をランダム走行させることができる。
すなわち、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されない場合には、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されるまで、すなわち、セキュリティロボット4が備える検出部45と充電装置2が備える発光部22とによって、確実にセキュリティロボット4を充電装置2へ誘導できる状態になるまで、セキュリティロボット4はランダム走行されるため、より確実にセキュリティロボット4を充電装置2まで自立走行させることができる。
The security robot 4 is in a state where the security robot 4 is rotated by the CPU 461 executing the random travel control program 463d and the CPU 461 executing the rotation control program 463c controlling the left travel motor 412L and the right travel motor 412R. Within a predetermined time, the second light beam sensor 452b and at least one of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, When the light beam M is not detected, the security robot 4 can be run at random.
That is, the light beam M is generated by the second light beam sensor 452b and at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. If not detected, the second light beam sensor 452b and at least one first light beam sensor 452a out of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, Until the light beam M is detected, that is, until the security robot 4 can be reliably guided to the charging device 2 by the detection unit 45 provided in the security robot 4 and the light emitting unit 22 provided in the charging device 2, the security robot 4 is run at random, charging the security robot 4 more reliably It can be self-supporting travel to the location 2.

また、第1光ビームセンサ452a及び第2光ビームセンサ452bが、セキュリティロボット4の本体部40の上面に配置された検出部45の側面全周に沿って配置されているため、360度全範囲から、光ビームMを確実に検出することができる。   In addition, since the first light beam sensor 452a and the second light beam sensor 452b are disposed along the entire side surface of the detection unit 45 disposed on the upper surface of the main body 40 of the security robot 4, a 360 ° full range is provided. Therefore, the light beam M can be reliably detected.

また、セキュリティロボット4は、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出された後、直進走行制御プログラム463eを実行したCPU461と、回転制御プログラム463cを実行したCPU461と、によって、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMを検出し続けながら、充電装置2に近づくことができる。
したがって、確実にセキュリティロボット4を充電装置2へ誘導することができることとなって、より一層確実にセキュリティロボット4を充電装置2まで自立走行させることができる。
The security robot 4 includes a second light beam sensor 452b, and at least one first light beam sensor 452a out of two first light beam sensors 452a and 452a arranged on the left and right sides of the second light beam sensor 452b, After the light beam M is detected by the CPU 461, the CPU 461 that executes the straight traveling control program 463 e and the CPU 461 that executes the rotation control program 463 c are arranged to the left and right of the second light beam sensor 452 b and the second light beam sensor 452 b. It is possible to approach the charging device 2 while continuing to detect the light beam M with at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged.
Therefore, the security robot 4 can be reliably guided to the charging device 2, and the security robot 4 can be autonomously driven to the charging device 2 even more reliably.

なお、本発明は、上記した実施の形態のものに限るものではなく、その要旨を逸脱しない範囲で適宜変更可能である。   The present invention is not limited to the above-described embodiment, and can be appropriately changed without departing from the gist thereof.

光ビームセンサ452が配置される箇所は、突出部451の限りでなく、セキュリティロボット4の本体部40の所定部位に設けられた所定部材であれば任意である。
具体的には、例えば、本体部40の側面全周に沿って回転可能なベルトを本体部40に設け、光ビームセンサ452を、当該ベルトの側面全周に沿って配置するようにしてもよい。この場合、突出部451の代わりに当該ベルトが検出部45を構成することになる。
また、例えば、光ビームセンサ452を、本体部40の側面全周に沿って本体部40に直接配置するようにしてもよい。この場合、突出部451の代わりに本体部40が検出部45を構成することになる。
The location where the light beam sensor 452 is disposed is not limited to the protruding portion 451 but may be any predetermined member provided at a predetermined portion of the main body 40 of the security robot 4.
Specifically, for example, a belt capable of rotating along the entire side surface of the main body 40 is provided in the main body 40, and the light beam sensor 452 may be disposed along the entire side of the belt. . In this case, the belt constitutes the detection unit 45 instead of the protrusion 451.
Further, for example, the light beam sensor 452 may be arranged directly on the main body 40 along the entire side surface of the main body 40. In this case, the main body portion 40 constitutes the detection portion 45 instead of the protruding portion 451.

複数(例えば、5個)の第1光ビームセンサ452aのうちの1つの第1光ビームセンサ452a又は隣り合う2つの第1光ビームセンサ452a,452aから光ビーム検出信号が入力された場合に、第1光ビームセンサ452aにより光ビームMが検出されたと判断するようにしたが、例えば、1つの第1光ビームセンサ452a又は隣り合う複数の第1光ビームセンサ452a,…から光ビーム検出信号が入力された場合に、第1光ビームセンサ452aにより光ビームMが検出されたと判断するようにしてもよい。   When a light beam detection signal is input from one first light beam sensor 452a or two adjacent first light beam sensors 452a and 452a among a plurality of (for example, five) first light beam sensors 452a, Although it is determined that the light beam M is detected by the first light beam sensor 452a, for example, a light beam detection signal is received from one first light beam sensor 452a or a plurality of adjacent first light beam sensors 452a,. When input, it may be determined that the light beam M has been detected by the first light beam sensor 452a.

自走式装置は、セキュリティロボット4の限りでなく、自律走行が可能な自走式装置であれば、任意である。   The self-propelled device is not limited to the security robot 4 and may be any self-propelled device capable of autonomous traveling.

回転制御プログラム463cを実行したCPU461による制御の仕方は、第1光ビームセンサ452a又は第2光ビームセンサ452bにより光ビームMが検出された後に、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出されるように、セキュリティロボット4を回転させることができれば、任意である。
ここで、当該制御において、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aとのうちの1つの光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されるように、セキュリティロボット4を回転させることよりも、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されるようにセキュリティロボット4を回転させることが優先的になされれば、より好都合である。
The CPU 461 that executes the rotation control program 463c is controlled by the second light beam sensor 452b and the second light beam sensor after the light beam M is detected by the first light beam sensor 452a or the second light beam sensor 452b. If the security robot 4 can be rotated so that the light beam M is detected by at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of 452b. Is optional.
Here, in the control, the second light beam sensor 452b and one of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, Rather than rotating the security robot 4 so that the light beam M is detected by the two light beam sensors 452, the second light beam sensor 452b and the two second light beam sensors 452b arranged on the left and right sides of the second light beam sensor 452b are used. It is more convenient if the security robot 4 is preferentially rotated so that the light beam M is detected by the three light beam sensors 452a and 452a.

第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMが検出された後の、直進走行制御プログラム463eを実行したCPU461と、回転制御プログラム463cを実行したCPU461と、による制御の仕方は、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aのうち少なくとも1つの第1光ビームセンサ452aと、により光ビームMを検出し続けながら、セキュリティロボット4を充電装置2に向けて直進走行させることができれば、任意である。
ここで、当該制御において、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aとのうちの1つの光ビームセンサ452aと、の2つの光ビームセンサ452により光ビームMが検出されるようにセキュリティロボット4を回転させることよりも、第2光ビームセンサ452bと、第2光ビームセンサ452bの左右に配置された2つの第1光ビームセンサ452a,452aと、の3つの光ビームセンサ452により光ビームMが検出されるようにセキュリティロボット4を回転させることが優先的になされれば、より好都合である。
The light beam M is detected by the second light beam sensor 452b and at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b. The control method by the CPU 461 that executes the straight traveling control program 463e and the CPU 461 that executes the rotation control program 463c is arranged on the left and right of the second light beam sensor 452b and the second light beam sensor 452b. If the security robot 4 can travel straight toward the charging device 2 while continuing to detect the light beam M with at least one first light beam sensor 452a of the two first light beam sensors 452a and 452a. Is optional.
Here, in the control, the second light beam sensor 452b and one of the two first light beam sensors 452a and 452a arranged on the left and right of the second light beam sensor 452b, Rather than rotating the security robot 4 so that the light beam M is detected by the two light beam sensors 452, the two first light beams 452b and the two first light beams arranged on the left and right of the second light beam sensor 452b are used. It is more convenient if the security robot 4 is preferentially rotated such that the light beam M is detected by the three light beam sensors 452a and 452a.

<変形例>
自走式装置充電システム1が備えるセキュリティロボット4は、例えば、図11に示すセキュリティロボット4Aのように、第2光ビームセンサ452bと第2光ビームセンサ452bの左に配置された第1光ビームセンサ452aとの間と、第2光ビームセンサ452bと第2光ビームセンサ452bの右に配置された第1光ビームセンサ452aとの間と、にスリット453Aを備えていてもよい。
<Modification>
The security robot 4 included in the self-propelled device charging system 1 is, for example, a first light beam arranged on the left side of the second light beam sensor 452b and the second light beam sensor 452b, as in the security robot 4A shown in FIG. A slit 453A may be provided between the sensor 452a and between the second light beam sensor 452b and the first light beam sensor 452a disposed on the right side of the second light beam sensor 452b.

具体的には、スリット453Aは、例えば、突出部451に、前後方向に可動するように配設されており、制御部46から入力される制御信号に従って、例えば、前方向に移動して突出部451から突出したり、或いは、後方向に移動して突出部451に収容されるようになっている。   Specifically, the slit 453A is disposed, for example, in the projecting portion 451 so as to be movable in the front-rear direction, and moves in the forward direction according to a control signal input from the control unit 46, for example. It protrudes from 451 or moves backward and is accommodated in the protruding portion 451.

より具体的には、例えば、直進走行制御プログラム463eを実行したCPU461により制御されてセキュリティロボット4Aが充電装置2に向けて直進走行している間に、例えば、走行用センサ414から入力された障害物検出信号に基づいてセキュリティロボット4Aと充電装置2との間の距離が一定距離以下になったと判断すると、制御部46(CPU461)は、例えば、図11(a)に示す、スリット453Aが突出部451に収容された状態から、例えば、図11(b)に示す、スリット453Aが突出部451から突出した状態に切り替わるように、スリット453Aを制御する。
ここで、スリット453Aが突出部451から突出した後は、第2光ビームセンサ453bのみにより光ビームMが検出され続けるように、セキュリティロボット4を回転制御してもよい。
More specifically, for example, a failure input from the travel sensor 414 while the security robot 4A travels straight toward the charging device 2 under the control of the CPU 461 that executes the straight travel control program 463e. If the controller 46 (CPU 461) determines that the distance between the security robot 4A and the charging device 2 is equal to or less than a certain distance based on the object detection signal, for example, the slit 453A shown in FIG. For example, the slit 453A is controlled so that the slit 453A is switched from the state accommodated in the portion 451 to the state in which the slit 453A protrudes from the protruding portion 451 shown in FIG.
Here, after the slit 453A protrudes from the protruding portion 451, the rotation of the security robot 4 may be controlled so that the light beam M is continuously detected only by the second light beam sensor 453b.

さらに、例えば、端子431が、充電装置2の接触端子21と接触したと判断すると、制御部46(CPU461)は、例えば、図11(b)に示す、スリット453Aが突出部451から突出した状態から、例えば、図11(a)に示す、スリット453Aが突出部451に収容された状態に切り替わるように、スリット453Aを制御する。   Furthermore, for example, when it is determined that the terminal 431 has come into contact with the contact terminal 21 of the charging device 2, the control unit 46 (CPU 461), for example, a state in which the slit 453 </ b> A protrudes from the protruding portion 451 shown in FIG. For example, the slit 453A is controlled so that the slit 453A shown in FIG.

変形例の場合、セキュリティロボット4Aと充電装置2との距離が一定距離以下になった際に、スリット453Aが、突出部451から突出して、第2光ビームセンサ452bの光ビームMの検出範囲を狭めるため、セキュリティロボット4Aは、光ビームMが到来する方向にセキュリティロボット4Aの進行方向が確実に向くように、すなわち、セキュリティロボット4を充電装置2へ確実に誘導できるように、回転制御されることとなって、より一層確実に確実に自走式装置4Aを充電装置2まで自立走行させることができる。   In the case of the modified example, when the distance between the security robot 4A and the charging device 2 is equal to or less than a certain distance, the slit 453A protrudes from the protruding portion 451, and the detection range of the light beam M of the second light beam sensor 452b is increased. In order to reduce the width, the security robot 4A is rotationally controlled so that the traveling direction of the security robot 4A is surely directed in the direction in which the light beam M arrives, that is, the security robot 4 can be reliably guided to the charging device 2. As a result, the self-propelled device 4A can be made to autonomously travel to the charging device 2 more reliably and reliably.

本発明における自走式装置充電システムの構成を示す平面図である。It is a top view which shows the structure of the self-propelled apparatus charging system in this invention. 本発明における充電装置の斜視図である。It is a perspective view of the charging device in the present invention. 本発明における充電装置の発光部から発光される光ビームの受光範囲を示す図である。It is a figure which shows the light-receiving range of the light beam light-emitted from the light emission part of the charging device in this invention. 本発明におけるセキュリティロボットの斜視図である。It is a perspective view of the security robot in the present invention. 本発明におけるセキュリティロボットの平面図である。It is a top view of the security robot in the present invention. 本発明におけるセキュリティロボットの機能的構成を示すブロック図である。It is a block diagram which shows the functional structure of the security robot in this invention. 本発明におけるセキュリティロボットの回転の仕方を説明するための図である。It is a figure for demonstrating the method of rotation of the security robot in this invention. 本発明における自走式装置充電システムのセキュリティロボットによる充電に関する第1の処理について説明するためのフローチャートである。It is a flowchart for demonstrating the 1st process regarding the charge by the security robot of the self-propelled apparatus charging system in this invention. 本発明における自走式装置充電システムのセキュリティロボットによる充電に関する第2の処理について説明するためのフローチャートである。It is a flowchart for demonstrating the 2nd process regarding the charge by the security robot of the self-propelled apparatus charging system in this invention. 本発明における自走式装置充電システムのセキュリティロボットによる充電に関する第3の処理について説明するためのフローチャートである。It is a flowchart for demonstrating the 3rd process regarding the charge by the security robot of the self-propelled apparatus charging system in this invention. 変形例におけるセキュリティロボットの平面図である。It is a top view of the security robot in a modification.

符号の説明Explanation of symbols

1 自走式装置充電システム
2 充電装置
21 接触端子
22 発光部(発光手段)
4 セキュリティロボット(自走式装置)
45 検出部
412L 左走行モータ(回転駆動部)
412R 右走行モータ(回転駆動部)
431 端子
452a 第1光ビームセンサ(第1検出手段)
452b 第2光ビームセンサ(第2検出手段)
461 CPU(判断手段、回転制御手段、走行制御手段)
463b 判断プログラム(判断手段)
463c 回転制御プログラム(回転制御手段)
463d ランダム走行制御プログラム(走行制御手段)
F 床面
M 光ビーム
R 所定の室内
DESCRIPTION OF SYMBOLS 1 Self-propelled apparatus charging system 2 Charging apparatus 21 Contact terminal 22 Light emission part (light emission means)
4 Security robot (self-propelled device)
45 Detection unit 412L Left travel motor (rotary drive unit)
412R Right travel motor (rotary drive)
431 Terminal 452a First light beam sensor (first detection means)
452b Second light beam sensor (second detection means)
461 CPU (determination means, rotation control means, travel control means)
463b Judgment program (judgment means)
463c Rotation control program (rotation control means)
463d Random travel control program (travel control means)
F Floor surface M Light beam R Predetermined room

Claims (4)

所定の室内の床面上を自立走行する自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
光ビームを発光する発光手段と、
を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
当該自走式装置の本体部の上面に配置され、前記発光手段により発光された光ビームを受光して検出する第1検出手段が、側面全周に沿って所定間隔で複数配置されるとともに、前記発光手段により発光された光ビームを受光して検出する第2検出手段が、当該自走式装置の進行方向を向き且つ当該複数の第1検出手段のうちの隣り合う2つの第1検出手段から等間隔の位置に配置された検出部と、
当該自走式装置を回転させる回転駆動部と、
予め設定された当該自走式装置の充電タイミングになったか否かを判断する判断手段と、
前記判断手段により予め設定された当該自走式装置の充電タイミングになったと判断された場合であって、前記第1検出手段又は前記第2検出手段により光ビームが検出された際に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により当該光ビームが検出されるように、前記回転駆動部を制御する回転制御手段と、
前記回転制御手段により前記回転駆動部が制御されている状態で、所定時間内に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、当該自走式装置をランダム走行させる走行制御手段と、
を備えることを特徴とする自走式装置充電システム。
In a self-propelled device charging system comprising a self-propelled device that independently runs on a floor surface in a predetermined room, and a charging device that supplies electric power for charging to the self-propelled device,
The charging device is:
The self-propelled device is detachable, and when the self-propelled device is attached, a contact terminal that supplies power for the charging to the self-propelled device;
A light emitting means for emitting a light beam;
With
The self-propelled device is
A terminal that is in contact with the contact terminal and receives supply of power for the charging from the contact terminal;
A plurality of first detection means arranged on the upper surface of the main body of the self-propelled device and receiving and detecting the light beam emitted by the light emitting means are arranged at predetermined intervals along the entire side surface, The second detection means that receives and detects the light beam emitted by the light emitting means faces the traveling direction of the self-propelled device and is adjacent to two of the plurality of first detection means. Detectors arranged at equally spaced positions from
A rotation drive for rotating the self-propelled device;
A judging means for judging whether or not the charging timing of the self-propelled device set in advance is reached;
When it is determined by the determination means that the charging timing of the self-propelled device set in advance is reached, when the light beam is detected by the first detection means or the second detection means, the first The rotation drive unit so that the light beam is detected by two detection means and at least one first detection means of the two first detection means arranged on the left and right of the second detection means. Rotation control means to control;
In a state where the rotation drive unit is controlled by the rotation control unit, at least of the second detection unit and the two first detection units arranged on the left and right of the second detection unit within a predetermined time. If the light beam is not detected by one first detection means, travel control means for causing the self-propelled device to travel randomly,
A self-propelled device charging system comprising:
所定の室内の床面上を自立走行する自走式装置と、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置充電システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
光ビームを発光する発光手段と、
を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
前記発光手段により発光された光ビームを受光して検出する第1検出手段が、側面全周に沿って所定間隔で複数配置されるとともに、前記発光手段により発光された光ビームを受光して検出する第2検出手段が、当該自走式装置の進行方向を向き且つ当該複数の第1検出手段のうちの隣り合う2つの第1検出手段から等間隔の位置に配置された検出部と、
当該自走式装置を回転させる回転駆動部と、
予め設定された当該自走式装置の充電タイミングになったか否かを判断する判断手段と、
前記判断手段により予め設定された当該自走式装置の充電タイミングになったと判断された場合であって、前記第1検出手段又は前記第2検出手段により光ビームが検出された際に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により当該光ビームが検出されるように、前記回転駆動部を制御する回転制御手段と、
を備えることを特徴とする自走式装置充電システム。
In a self-propelled device charging system comprising a self-propelled device that independently runs on a floor surface in a predetermined room, and a charging device that supplies electric power for charging to the self-propelled device,
The charging device is:
The self-propelled device is detachable, and when the self-propelled device is attached, a contact terminal that supplies power for the charging to the self-propelled device;
A light emitting means for emitting a light beam;
With
The self-propelled device is
A terminal that is in contact with the contact terminal and receives supply of power for the charging from the contact terminal;
A plurality of first detection means for receiving and detecting the light beam emitted by the light emitting means are arranged at predetermined intervals along the entire circumference of the side surface, and receiving and detecting the light beam emitted by the light emitting means. A second detecting means that faces the traveling direction of the self-propelled device and is arranged at equal intervals from two adjacent first detecting means of the plurality of first detecting means;
A rotation drive for rotating the self-propelled device;
A judging means for judging whether or not the charging timing of the self-propelled device set in advance is reached;
When it is determined by the determination means that the charging timing of the self-propelled device set in advance is reached, when the light beam is detected by the first detection means or the second detection means, the first The rotation drive unit so that the light beam is detected by two detection means and at least one first detection means of the two first detection means arranged on the left and right of the second detection means. Rotation control means to control;
A self-propelled device charging system comprising:
請求項2に記載の自走式装置充電システムにおいて、
前記自走式装置は、
前記回転制御手段により前記回転駆動部が制御されている状態で、所定時間内に、前記第2検出手段と、当該第2検出手段の左右に配置された2つの前記第1検出手段のうち少なくとも1つの第1検出手段と、により光ビームが検出されない場合には、当該自走式装置をランダム走行させる走行制御手段を備えることを特徴とする自走式装置充電システム。
In the self-propelled device charging system according to claim 2,
The self-propelled device is
In a state where the rotation drive unit is controlled by the rotation control unit, at least of the second detection unit and the two first detection units arranged on the left and right of the second detection unit within a predetermined time. A self-propelled device charging system comprising travel control means for randomly traveling the self-propelled device when no light beam is detected by one first detecting means.
請求項2又は3に記載の自走式装置充電システムにおいて、
前記検出部は、前記自走式装置の本体部の上面に配置されていることを特徴とする自走式装置充電システム。
In the self-propelled device charging system according to claim 2 or 3,
The said detection part is arrange | positioned at the upper surface of the main-body part of the said self-propelled apparatus, The self-propelled apparatus charging system characterized by the above-mentioned.
JP2006284050A 2006-10-18 2006-10-18 Self-propelled device charging system Withdrawn JP2008102698A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006284050A JP2008102698A (en) 2006-10-18 2006-10-18 Self-propelled device charging system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006284050A JP2008102698A (en) 2006-10-18 2006-10-18 Self-propelled device charging system

Publications (1)

Publication Number Publication Date
JP2008102698A true JP2008102698A (en) 2008-05-01

Family

ID=39436989

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006284050A Withdrawn JP2008102698A (en) 2006-10-18 2006-10-18 Self-propelled device charging system

Country Status (1)

Country Link
JP (1) JP2008102698A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015105178A1 (en) * 2014-01-09 2015-07-16 株式会社東芝 Self-propelled device
WO2016114463A1 (en) * 2015-01-14 2016-07-21 (주)바램시스템 Driving robot, and charging station docking method for the driving robot

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015105178A1 (en) * 2014-01-09 2015-07-16 株式会社東芝 Self-propelled device
US10048694B2 (en) 2014-01-09 2018-08-14 Toshiba Lifestyle Products & Services Corporation Self-propelled device
WO2016114463A1 (en) * 2015-01-14 2016-07-21 (주)바램시스템 Driving robot, and charging station docking method for the driving robot
US9874875B2 (en) 2015-01-14 2018-01-23 Varram System Co., Ltd. Mobile robot and method for docking the mobile robot with charging station

Similar Documents

Publication Publication Date Title
JP2008040725A (en) Charging system for self-propelled device
JP5053676B2 (en) Mobile robot charging stand return system and method
KR101771869B1 (en) Traveling body device
EP4223200B1 (en) Cleaning robot and controlling method thereof
KR101566207B1 (en) Robot cleaner and control method thereof
JP2006113952A (en) Charging type travel system
JP2005230032A (en) Autonomous running robot cleaner
JP6822788B2 (en) Cleaning robot
EP3738495B1 (en) Robotic vacuum cleaner and control method therefor
JP6569342B2 (en) Mobile robot
KR20160003435A (en) Cleaning robot and controlling method thereof
JP2008198057A (en) Self-propelled device guide system
KR20080093768A (en) Position sensing device of traveling robot and robot cleaner using the same
JP2008084007A (en) Self-propelled apparatus charging system
JP2008102698A (en) Self-propelled device charging system
JP2008139992A (en) Self-propelled device and self-propelled device guiding system
JP2005349497A (en) Self-propelled robot
JP2006039760A (en) Mobile robot
JP2016220823A (en) Self-propelled cleaner
KR102293657B1 (en) Moving Robot
KR101503601B1 (en) Robot cleaner
JP2008117185A (en) System of self-propelled type mobile object
JP6382634B2 (en) Autonomous vehicle
JP2004139264A (en) Autonomous traveling robot
JP2008198071A (en) Self-propelled device

Legal Events

Date Code Title Description
A761 Written withdrawal of application

Free format text: JAPANESE INTERMEDIATE CODE: A761

Effective date: 20080408