WO2007132572A1 - 自走機器の走行装置 - Google Patents

自走機器の走行装置 Download PDF

Info

Publication number
WO2007132572A1
WO2007132572A1 PCT/JP2007/050581 JP2007050581W WO2007132572A1 WO 2007132572 A1 WO2007132572 A1 WO 2007132572A1 JP 2007050581 W JP2007050581 W JP 2007050581W WO 2007132572 A1 WO2007132572 A1 WO 2007132572A1
Authority
WO
WIPO (PCT)
Prior art keywords
collision
traveling
detection unit
travel
self
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.)
Ceased
Application number
PCT/JP2007/050581
Other languages
English (en)
French (fr)
Inventor
Toshiki Moriguchi
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.)
Murata Machinery Ltd
Original Assignee
Murata Machinery 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 Murata Machinery Ltd filed Critical Murata Machinery Ltd
Priority to US12/299,916 priority Critical patent/US20090164123A1/en
Priority to JP2008515439A priority patent/JP4788767B2/ja
Priority to EP07706896A priority patent/EP2019348A4/en
Publication of WO2007132572A1 publication Critical patent/WO2007132572A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

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/0227Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/007Manipulators mounted on wheels or on carriages mounted on wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/0006Exoskeletons, i.e. resembling a human figure
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1674Program controls characterised by safety, monitoring, diagnostic
    • B25J9/1676Avoiding collision or forbidden zones
    • 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/60Intended control result
    • G05D1/617Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards

Definitions

  • the present invention relates to a traveling device for a self-propelled device.
  • a traveling device of a self-propelled device such as an automatic guided vehicle or a self-propelled robot generally includes a collision detection device that detects a collision with an obstacle, and the collision is detected by the collision detection device. When traveling, it is configured to stop traveling immediately in order to prevent accidents and damage to equipment.
  • Patent Document 1 discloses a device having a tape switch provided in bumpers on the front and rear sides of a vehicle body.
  • the tape switch described in Patent Document 1 includes two tapes made of silicon rubber, and different voltages are applied to these two tapes.
  • the collision detection device is configured to detect a bumper collision by detecting voltage fluctuations of the two tapes. If a collision is detected by the collision detection device, the brake will be activated and the self-propelled device will stop emergency.
  • Patent Document 1 JP-A-6-219226
  • Patent Document 1 The collision detection device of Patent Document 1 described above only detects that the traveling device has collided with some obstacle, and cannot determine the degree of collision. For this reason, if there is no risk of accidents or equipment damage due to a weak collision with a contact level, it is only necessary to avoid obstacles and travel in a different direction. Will stop completely. Therefore, unnecessary emergency stops frequently occur and the running becomes jerky, and the burden on the operator who performs the return operation after the emergency stop is increased.
  • the main object of the present invention is self-running capable of detecting two types of collision states having different degrees of collision.
  • An apparatus for traveling a device is provided.
  • a traveling device for a self-propelled device includes a main body, a traveling wheel rotatably supported by the main body, and a traveling drive unit that rotationally drives the traveling wheel.
  • a traveling device for a traveling device further comprising: a collision detection unit that is provided in the main body part and detects a collision when the main body unit collides with an obstacle during traveling, and the collision detection unit includes: Two types of collision states, the first collision state and the second collision state in which the degree of collision is larger than the first collision state, can be detected.
  • This traveling device can detect two types of collision states with different degrees of collision by the collision detection means, and therefore can perform different operations depending on the two types of detected collision states. It can. For example, when the first collision state with a small degree (intensity) of collision is detected, frequent travel stops can be suppressed by avoiding obstacles. On the other hand, if a second collision state with a high degree of collision (strength) is detected, the vehicle can be stopped urgently to prevent accidents and damage to the main body.
  • a traveling device for a self-propelled device is the traveling device according to the first aspect, wherein the main body portion is the obstacle when the first collision state is detected by the collision detection means.
  • An avoidance control means for controlling the travel drive means to avoid the travel stop, and a travel stop for stopping the driving of the travel wheels by the travel drive means when the second collision state is detected by the collision detection means. Means.
  • a traveling device for a self-propelled device is the traveling device according to the second aspect, wherein the traveling stopping means drives the traveling wheels by cutting off power supply to the traveling driving means. Is stopped. According to this configuration, it is possible to stop traveling instantaneously by shutting off the power supply to the traveling wheels, resulting in an accident or damage to the main body. Scratches can be surely prevented.
  • a traveling device for a self-propelled device is the first detection unit according to any one of the first to third aspects, wherein the collision detection means detects the first collision state. And a second detection unit for detecting the second detection state, wherein the first detection unit and the second detection unit have a pair of electrodes facing each other at a predetermined interval, and the pair of detection units.
  • Each of the elastic bodies covering the electrodes is provided, and the elasticity of the elastic body of the first detection unit is larger than the elasticity of the elastic body of the second detection unit.
  • the elastic body When the traveling device collides with an obstacle, the elastic body is deformed by the impact force applied at the time of collision in each of the first detection unit and the second detection unit, and is further covered with the elastic body. A collision is detected by the contact of a pair of electrodes.
  • the elastic body of the first detection unit is more elastic than the elastic body of the second detection unit, even if the same impact force is applied, the elastic body of the first detection unit is elastic of the second detection unit. Since the body is more easily deformed than the body, the first collision state where the degree of collision is small (impact force is small) is detected by the first detection unit, and is not detected by the second detection unit.
  • each detection unit has a simple configuration including a pair of electrodes and an elastic body, and two types of collision states can be detected only by making the elasticity of the two elastic bodies different. As a result, the configuration of the collision detection means becomes simple, which is advantageous in terms of cost.
  • a traveling device for a self-propelled device is that in the fourth aspect of the invention, the elastic body of the first detection unit and the elastic body of the second detection unit include the pair of electrodes. Overlapped in the direction of separation! / It is characterized by scolding.
  • a traveling device for a self-propelled device is the travel device according to any one of the fourth and fifth aspects, wherein the pair of electrodes of the first detection unit and the second detection unit And the elastic bodies are each formed in a shape that is long in one direction, and the first detection portion and the second detection portion are provided over substantially the entire circumference of the outer peripheral portion of the main body portion. It is characterized by that. According to this configuration, the collision can be reliably detected regardless of the direction in which the obstacle collides with the main body.
  • FIG. 1 is a front view of a guidance robot according to an embodiment of the present invention.
  • FIG. 2 is a plan view of a traveling device for a guide robot according to an embodiment of the present invention.
  • FIG. 3 is a cross-sectional view taken along line III-III in FIG.
  • FIG. 4 is a view showing a deformed state of the tape switch when the degree of collision is small! /.
  • FIG. 5 is a diagram showing a deformed state of the tape switch when the degree of collision is large.
  • FIG. 6 is a circuit diagram schematically showing a configuration for performing an obstacle avoidance operation of the traveling device.
  • FIG. 7 is a circuit diagram schematically showing a configuration for performing a travel stop operation of the travel device.
  • FIG. 8 is a cross-sectional view corresponding to FIG. 3 of two tape switches according to a modified embodiment. Explanation of symbols
  • This embodiment does not interact with the person being guided.
  • the guide robot 1 is a humanoid robot including a body part 10, a leg part 11, two arm parts 13, a head part 14 and the like. Further, a traveling device 40 having traveling wheels 12 is connected to the leg portion 11.
  • a battery (not shown) that is a drive source of the guide robot 1 and a control device 19 that controls the operation of each part of the guide robot 1 are provided inside the body portion 10.
  • the control device 19 will be described in detail later.
  • a plurality of ultrasonic sensors 20 for detecting various objects such as a subject person and an obstacle existing around are provided on the outer peripheral portion of the body portion 10.
  • a leg 11 is connected to the lower end of the body 10.
  • Two shoulder portions 26 are rotatably connected to the left and right side portions of the upper portion of the body portion 10 via a shaft (not shown) extending in the left-right direction. 26, two arms 13 are connected to each other through a shaft 27 extending in the front-rear direction (perpendicular to the plane of FIG. 1). That is, the arm portion 13 can swing in the front-rear direction and the left-right direction via the shoulder portion 26.
  • the head portion 14 is rotatably connected to the upper end portion of the body portion 10.
  • a CCD camera 15 for acquiring visual information of an object such as a guided person
  • a microphone for acquiring audio information around the guiding robot 1 17 and a speaker 18 for transmitting voice information to the outside are provided.
  • the traveling device 40 includes a frame 21 (main body portion), a bumper 23 provided on the outer peripheral portion of the frame 21, and left and right end portions of the lower portion of the frame 21.
  • Two traveling wheels 12 that are rotatably provided, and auxiliary wheels (casters) 22 that are rotatably provided at the center in the left-right direction of the frame 21 are provided.
  • the two traveling wheels 12 are each driven to rotate by a motor 64 (see FIGS. 6 and 7).
  • the traveling device 40 can travel on a flat traveling surface by rotating the two traveling wheels 12 by the motor 64 and rotating the two auxiliary wheels 22 in a driven manner. It is. In addition, the motor 64 rotates the left and right traveling wheels 12 at different rotational speeds. By moving and generating a differential between the two wheels, the direction of the traveling device 40 (traveling direction) can be changed to an arbitrary direction.
  • the guide robot 1 controls the operation of each part of the guide robot 1 by the control device 19 based on information from various sensors such as the CCD camera 15 and the like, while communicating with the person. It is possible to guide to the position.
  • a person is recognized by the ultrasonic sensor 20 and the CCD camera 15, voice information emitted by the person is acquired by the microphone 17, and voice information is transmitted to the person by the speaker 18. Furthermore, the position of the guidance target is recognized by the CCD camera 15, and the arm 13 is swung or the head 14 is rotated, so that the person can self-run while gesturing and guides the person to the target position. .
  • the tape switch 24 has a pair of electrode plates 31 facing each other with a predetermined interval and a covering material 30 covering the pair of electrode plates 31.
  • the electrode plate 31 and the covering material 30 are formed in a tape shape (band shape) that is long in one direction.
  • the tape switch 24 is fixed over almost the entire circumference of the outer periphery of the bumper 23 (frame 21) in a state in which the surface direction is parallel to the outer surface of the bumper 23.
  • the tape switch 25 also has a pair of electrode plates 34 facing each other with a predetermined interval and a covering material 33 covering the pair of electrode plates 34, and the pair of electrode plates 34 and The covering material 33 is formed in a tape shape (strip shape) that is long in one direction.
  • the tape switch 25 is bonded to the tape switch 24 in a state where the tape switch 25 is overlaid on the outside of the tape switch 24 (that is, in the direction in which the pair of electrodes are separated from each other). That is, the two tape switches 24 and 25 are provided to overlap the bumper 23 at the same position.
  • the covering materials 30, 33 of the tape switches 24, 25 are both formed of an elastic material such as a rubber material (elastic body). Furthermore, the elasticity of the covering material 33 of the outer tape switch 25 is larger than the elasticity of the covering material 30 of the inner tape switch 24. Accordingly, the outer covering material 33 is more easily deformed than the inner covering material 30. [0030] Then, as shown in FIG. 4, the frame 25 lightly collides (contacts) with an obstacle during traveling, and an external force (in a direction perpendicular to the surface direction) is applied to the outer tape switch 25 ( Assume that impact force is applied.
  • the covering material 33 covering the pair of electrode plates 34 is deformed inwardly, and the outer electrode plate 34 is pressed inward to contact the inner electrode plate 34.
  • the pair of electrode plates 34 are electrically connected to each other (ON state).
  • the covering material 30 of the inner tape switch 24 is less elastic (higher rigidity) than the outer covering material 33, its deformation is small.
  • a pair of electrode plates 31 covered with the covering material 30 are in contact with each other. No (OFF state) o
  • only the outer tape switch 25 is turned ON to detect a light collision state (first collision state) with a small degree of collision. That is, the tape switch 25 corresponds to the first detector of the present invention.
  • the frame 21 strongly collides with an obstacle due to the traveling device 40 running away, and a large external force is applied by the outer tape switch 25.
  • the outer tape switch 25 is naturally turned ON.
  • the covering material 30 is elastically deformed, and the outer electrode plate 31 is pressed inward to come into contact with the inner electrode plate 31, so that the tape switch 24 is turned on. That is, when the inner tape switch 24 is turned on, a strong collision state (second collision state) in which the degree of collision is larger than the first collision state described above is detected. That is, the tape switch 24 corresponds to the second detection unit of the present invention.
  • a pair of electrode plates 31, 34 and covering members 30, 33 formed of an elastic material cover and tape switches 24, 25 having a simple configuration that also has a force are used. Since the two types of collisions can be detected simply by changing the elasticity of the two coverings 30 and 33, the configuration for detecting the collision becomes simple, which is advantageous in terms of cost.
  • the two tape switches 24 and 25 are provided over the entire circumference of the outer peripheral portion (bumper 23) of the frame 21, even if an obstacle collides with the frame 21 in any direction force, Can be detected. Therefore, not only when the traveling device 40 collides with an obstacle while traveling back and forth, but also when the side of the frame 21 collides with an obstacle while turning (turning direction), the collision is reliably detected. can do.
  • the two tape switches 24, 25 are arranged at the same position on the bumper 23 at the electrode plate 3 1 and 34 are provided so as to overlap with each other in the separation direction (direction perpendicular to the surface direction). If the two tape switches 24 and 25 are provided at different positions on the bumper 23, the obstacle may not be in force contact with one tape switch and the collision state may not be detected. The force that the two tape switches 24 and 25 overlap does not cause such a problem, and the collision state can be detected more reliably.
  • the tape switch 24 is divided into two parts (24a, 24b), one in the running direction (upper in FIG. 2) and the other (lower in FIG. 2).
  • the same tape switch 25 is also divided into two parts (25a, 25b) in one direction and the other in the running direction. Therefore, it becomes possible to recognize which part of the frame 21 has collided with the obstacle depending on which part of the two parts has detected the collision!
  • the control device 19 is a CPU (Central Processing Unit) that is a central processing unit, a ROM (Read Only Memory) in which programs and data for controlling each part of the guide robot 1 are stored, and the CPU. RAM (Random Access Memory) etc. for temporarily storing stored data.
  • CPU Central Processing Unit
  • ROM Read Only Memory
  • RAM Random Access Memory
  • the control device 19 relates to objects such as a guided person and an obstacle, which are obtained by a plurality of ultrasonic sensors 20, a CCD camera 15, and a microphone 17 and are present around the guidance robot 1.
  • Information location information, visual information, audio information, etc.
  • information character information, voice message, etc.
  • the control device 19 drives each part (traveling wheel 12, arm part 13, head part 14 and the like) based on the information about the guided person acquired by the ultrasonic sensor 20, the CCD camera 15, etc., and the ROM
  • the predetermined guidance operation set by the guidance control program stored in the above is performed.
  • the guide robot 1 when the first collision state in which the degree of collision is relatively small is detected by the tape switch 25, the motor 64 that drives the traveling wheels 12 is controlled by the control device 19, The traveling device 40 is configured to avoid an obstacle (obstacle avoiding operation). On the other hand, when the second collision state in which the degree of collision is large is detected by the tape switch 24, the guide robot 1 forcibly stops the driving of the traveling wheels 12 by the motor and stops traveling of the traveling device 40. It is comprised so that (travel stop operation
  • the driver 63 receives power (electric power) from the power supply source 53 and drives the motor 64 in accordance with a command signal from the control device 19.
  • a power supply voltage (+ V) is applied to one electrode plate 34 of the tape switch 25 (25a, 25b) via a resistor 52, and the other electrode plate 34 is connected to GND.
  • a coil 50 a of the relay 50 and a diode 51 are connected in parallel between the pair of electrode plates 34.
  • the diode 51 and the resistor 52 are protective elements.
  • the contact 50b of the relay 50 is connected in series between + V and GND together with the resistor 54.
  • an interrupt signal (IRQ) is input to the control device 19.
  • the relay 50 is provided for each of the tape switches 25a and 25b divided into two, and when one of the tape switches 25a and 25b is turned on, the corresponding contact 50b of the relay 50 is provided. Is turned ON, and an interrupt signal is input to the control device 19.
  • the obstacle avoidance program is stored in the ROM of the control device 19, and when an interrupt signal is input, this obstacle avoidance program is executed preferentially by the CPU.
  • the resistor 54 is a protective element.
  • the control device 19 controls the motor 64 that drives the traveling wheels 12 via the driver 63 according to the guidance control program stored in the ROM, and the traveling device 40 corresponds to the guidance operation and the like. Perform normal driving.
  • the bumper 23 collides lightly to the extent that it touches an obstacle while the guide robot 1 is running, the pair of electrode plates 33 are conductive (short-circuited), and the tape switch 25 is turned on.
  • the coil 50a becomes the GND potential and the coil 50a is not driven.
  • the contact 50 b of the relay 50 is turned on, and an interrupt signal is input to the control device 19.
  • the CPU of the control device 19 executes the avoidance control program stored in the ROM in preference to other control programs such as a guide control program, and the frame 21 of the traveling device 40 avoids the obstacle.
  • the motor 64 is controlled as follows. That is, the control device 19 corresponds to the avoidance control means of the present invention.
  • the control device 19 once causes the traveling device 40 to travel in the direction opposite to the traveling direction immediately before the collision. Further, when the traveling device 40 collides with an obstacle while turning (changing direction), the traveling device 40 is temporarily turned in the direction opposite to the turning direction immediately before the collision. As shown in FIG. 2, since the tape switch 25 is divided into two parts 25a and 25b, the control device 19 immediately before the collision depends on which of these two parts 25a and 25b is turned on.
  • the traveling direction of the traveling device 40 can be estimated to some extent.
  • the rotational direction and rotational speed data of the motor 64 is stored in a RAM or the like, and the traveling direction of the traveling device 40 immediately before the collision is estimated by the control device 19 referring to past data related to the motor 64. May be.
  • the tape switch 25 is divided into two parts, it is possible to estimate the force of collision from any direction even when an obstacle such as a moving person collides. Can be avoided.
  • the bumper 23 is separated from the obstacle and the tape switch 25 is turned OFF. Further, when a predetermined time has elapsed since the tape switch 25 was turned OFF, the control device 19 determines that the traveling device 40 has reached a position where the obstacle force is sufficiently separated, and the traveling device 40 avoids the obstacle. End the operation. Then, the traveling device 40 resumes normal traveling associated with the guidance operation of the guided person.
  • the traveling device 40 when the frame 21 of the traveling device 40 lightly collides with an obstacle, the traveling device 40 performs an obstacle avoiding operation and does not stop traveling, so that frequent traveling stop is suppressed. This reduces the burden on the operator who performs a return operation after an emergency stop.
  • the power supply voltage (+ V) is applied to one electrode plate 31 of the tape switch 24 (24a, 24b) via a resistor 65.
  • the other electrode plate 31 is connected to GND.
  • a coil 60 a of the relay 60 and a diode 66 are connected in parallel.
  • the diode 66 and the resistor 65 are protective elements.
  • the contact 60b of the relay 60 is provided between + V and GND.
  • a contact 61b of the relay 61 is provided between the contact 60b and + V, and a coil 61a and a resistor 67 of the relay 61 are provided between the contact 60b and GND.
  • Contact 61b is turned ON / OFF by coil 61a.
  • a reset switch 62 is connected in parallel with the contact 61c.
  • a contact 61c is provided between the driver 63 and the power supply source 53, and this contact 61c is also turned ON / OFF by the coil 61a of the relay 61, like the contact 61b.
  • the resistor 67 is a protective element.
  • the traveling device 40 collides with an obstacle and is in a sad state, the pair of electrode plates 31 of the tape switch 24 are not in contact with each other, and the tape switch 24 is OFF.
  • the power supply voltage (+ V) is applied to the coil 60a, and the contact 60b is ON.
  • the contact 6 lb is ON and the power supply voltage (+ V) is applied to the coil 6 la, the coil 61a is driven and the contact 61c is turned ON. That is, power is supplied from the power supply source 53 to the driver 63, and the motor 64 can drive the traveling wheels 12.
  • the relays 60, 61, etc. are provided for each of the tape switches 24a, 24b which are divided into two, so that when either one of the tape switches 24a, 24b is turned ON The contact 61c to be turned off is turned off, and the power supply to the motor 64 (driver 63) is cut off. [0050]
  • the power to the motor 64 (driver 63) is Since the supply is cut off, the traveling of the traveling device 40 is stopped instantaneously, and accidents and damage to the guide robot 1 can be reliably prevented.
  • the tape switch 25 is also turned on.
  • the above-mentioned obstacle avoidance control interrupt signal is input to the control device 19 (see FIG. 6), but at the same time, the power supply to the motor 64 (driver 63) is cut off. The That is, the travel stop operation is performed with priority over the obstacle avoidance operation, and the traveling device 40 stops immediately without performing the obstacle avoidance operation.
  • the traveling device 40 stops, when the traveling device 40 is separated from the obstacle, the pair of electrode plates 31 of the tape switch 24 are separated, and the tape switch 24 is turned off again.
  • the contact 60b is turned on because the power supply voltage (+ V) is applied to the coil 60a.
  • the contact 6 lb is OFF and the coil 61a is also at the GND potential, the contact 61c is kept OFF. That is, even if the travel device 40 is released from the obstacle force after the emergency stop, the power is not supplied to the motor 64 from the power supply unit 53, so the travel device 40 is in a state in which it cannot travel. Therefore, when the traveling device 40 is out of control due to a malfunction or the like, the traveling device 40 does not start to run away again after the traveling device 40 is urgently stopped.
  • the reset switch 62 is pushed when the traveling device 40 is returned to the travelable state. Then, since the power supply voltage (+ V) is applied to the coil 61a and both the contacts 61b and 61c are turned on, the power is supplied again from the power supply unit 53 to the driver 63, and the motor 64 is driven. Will be able to.
  • the two tape switches 24 and 25 can detect two collision states with different degrees of collision, and thus the traveling device.
  • the 40 can perform two types of actions: obstacle avoidance and running stop. As a result, it is possible to prevent an accident or damage by stopping the traveling reliably in the case of a strong collision and not stopping frequently by a weak collision.
  • the preferred embodiments of the present invention have been described, but the present invention can be modified within the scope not exceeding the gist thereof.
  • the tape switches 24 and 25 are provided on the bumper 23 in a state where the electrode plates are arranged side by side in a direction in which the electrode plates are separated from each other.
  • the tape switches 24 and 25 may be provided on the bumper 23 in a state of being orthogonal to the longitudinal direction.
  • the number of divisions of the tape switches 24 and 25 is not limited to two, and may be divided into three or more. As the number of divisions increases, it becomes possible to more accurately detect which part of the bumper 23 has collided with, and it is possible to perform an obstacle avoidance operation suitable for the collision part.
  • the tape switches 24 and 25 are provided over the entire outer periphery of the bumper 23.
  • a part of the outer periphery that easily collides with an obstacle for example, a bumper is formed at a corner). If it has, it is provided only at both ends in the running direction and four corners).
  • the power supply from the power supply source 53 to the driver 63 is directly cut off using the relay 61 (see FIG. 7).
  • an interrupt signal is input to the control device 19, and the driver 63 is configured to stop driving the motor 64 in response to a command from the control device 19. Also good.
  • the collision detection means for detecting two types of collision states with different degrees of collision is not limited to the tape switches 24 and 25 of the embodiment.
  • an impact force detection sensor capable of measuring the magnitude of impact force at the time of collision with a strain gauge or the like is used, it is possible to determine the degree of collision based on the magnitude of the measured impact force.
  • the embodiment described above is an example in which the present invention is applied to a guide robot that guides a guided person to a target position.
  • the self-propelled device to which the present invention can be applied is limited to the guide robot. Absent. That is, the present invention can be applied to other self-propelled devices such as automatic guided vehicles and industrial self-propelled robots.

Landscapes

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

Abstract

 本発明の目的は、衝突の程度の異なる2種類の衝突状態を検出できる自走機器の走行装置を提供することである。本発明は、走行装置40は、フレーム21に回転自在に支持された2つの走行輪12と、これら2つの走行輪12を回転駆動するモータと、フレーム21(本体部)の障害物との衝突を検出する2つのテープスイッチ24、25を備えている。そして、テープスイッチ25により衝突の程度の小さい第1の衝突状態が検出されたときには、走行装置40は障害物を回避する動作を行い、テープスイッチ24により第1の衝突状態よりも程度の大きい第2の衝突状態が検出されたときには、走行装置40は走行を停止する。

Description

明 細 書
自走機器の走行装置
技術分野
[0001] 本発明は、自走機器の走行装置に関する。
背景技術
[0002] 無人搬送車や自走式ロボットなどの自走機器の走行装置は、一般的に、障害物と の衝突を検出する衝突検出装置を備えており、この衝突検出装置により衝突が検出 されたときには、事故の発生や機器の損傷などを防止するために、走行を直ぐに停 止するように構成されている。
[0003] このような衝突検出装置として、例えば、特許文献 1には、車体前後のバンパーに 設けられたテープスィッチを有するものが開示されて 、る。特許文献 1に記載のテー プスィッチは、シリコンゴムからなる 2本のテープを備えており、これら 2本のテープに は互いに異なる電圧が印加されている。ここで、バンパーが障害物に衝突したときに は 2本のテープが短絡して電圧が変動する。従って、衝突検出装置は、 2本のテープ の電圧変動を検知することによりバンパーの衝突を検出するように構成されて 、る。 また、衝突検出装置により衝突が検出された場合には、ブレーキが作動して自走機 器は非常停止する。
特許文献 1 :特開平 6— 219226号公報
発明の開示
発明が解決しょうとする課題
[0004] 前述した特許文献 1の衝突検出装置は、走行装置が何らかの障害物に衝突したこ とだけを検出するものであり、衝突の程度を判別できるものではない。そのため、接触 程度の弱い衝突であって事故や機器の損傷が生じる虞がない場合には、本来は障 害物を回避して別の方向に走行すればよいのであるが、実際には、走行が完全に停 止してしまうことになる。従って、不必要な非常停止が頻発し、走行がぎくしゃくしたも のとなるし、また、非常停止後の復帰操作等を行うオペレータの負担も増えてしまう。
[0005] 本発明の主たる目的は、衝突の程度の異なる 2種類の衝突状態を検出できる自走 機器の走行装置を提供するものである。
課題を解決するための手段及びその効果
[0006] 第 1の発明である自走機器の走行装置は、本体部と、この本体部に回転自在に支 持された走行輪と、前記走行輪を回転駆動する走行駆動手段を備えた自走機器の 走行装置であって、前記本体部に設けられて、走行中に前記本体部が障害物に衝 突したときに、その衝突を検出する衝突検出手段をさらに備え、前記衝突検出手段 は、第 1の衝突状態と、この第 1の衝突状態よりも衝突の程度が大きい第 2の衝突状 態の、 2種類の衝突状態をそれぞれ検出可能であることを特徴とするものである。
[0007] この走行装置は、衝突検出手段により、衝突の程度の異なる 2種類の衝突状態を 検出することができるため、検出された 2種類の衝突状態に応じてそれぞれ異なった 動作を行うことができる。例えば、衝突の程度 (強さ)が小さい第 1の衝突状態が検出 された場合には、障害物を回避することで、頻繁な走行停止を抑制することができる 。一方、衝突の程度 (強さ)が大きい第 2の衝突状態が検出された場合には、走行を 緊急に停止して事故や本体部等の損傷を防止することができる。
[0008] 第 2の発明である自走機器の走行装置は、前記第 1の発明において、前記衝突検 出手段により前記第 1の衝突状態が検出されたときに、前記本体部が前記障害物を 回避するように前記走行駆動手段を制御する回避制御手段と、前記衝突検出手段 により前記第 2の衝突状態が検出されたときに、前記走行駆動手段による前記走行 輪の駆動を停止させる走行停止手段とを有することを特徴とするものである。この構 成によれば、衝突の程度 (強さ)が小さい第 1の衝突状態が検出された場合には、回 避制御手段により走行駆動手段が制御されて障害物を回避するため、頻繁な走行 停止を抑制することができる。一方、走行装置の暴走などが発生して、衝突の程度( 強さ)が大きい第 2の衝突状態が検出された場合には、走行停止手段により走行輪 の駆動が緊急に停止されて事故や本体部等の損傷を防止することができる。
[0009] 第 3の発明である自走機器の走行装置は、前記第 2の発明において、前記走行停 止手段は、前記走行駆動手段への動力供給を遮断することにより前記走行輪の駆 動を停止させることを特徴とするものである。この構成によれば、走行輪への動力供 給を遮断することにより、瞬時に走行を停止させることができ、事故や本体部等の損 傷を確実に防止することができる。
[0010] 第 4の発明である自走機器の走行装置は、前記第 1〜第 3の何れかの発明におい て、前記衝突検出手段は、前記第 1の衝突状態を検出する第 1検出部と、前記第 2 の検出状態を検出する第 2検出部とを備え、前記第 1検出部と前記第 2検出部は、所 定間隔を空けて対向する 1対の電極と、前記 1対の電極を被覆する弾性体をそれぞ れ有し、前記第 1検出部の弾性体の弾性は、前記第 2検出部の弾性体の弾性よりも 大き 、ことを特徴とするものである。
[0011] 走行装置が障害物に衝突したときには、第 1検出部と第 2検出部のそれぞれにお いて、衝突時に作用した衝撃力により弾性体が変形し、さら〖こ、弾性体で被覆された 1対の電極が接触することによって衝突が検出される。ここで、第 1検出部の弾性体 は、第 2検出部の弾性体よりも弾性が大きいため、同じ衝撃力が作用しても、第 1検 出部の弾性体は第 2検出部の弾性体よりも変形しやすいことから、衝突の程度の小さ い (衝撃力が小さい)第 1の衝突状態が第 1検出部により検出され、第 2検出部では 検出されない。一方、衝突時の衝撃力が大きくなると、弾性の小さい第 2検出部の弾 性体の変形も大きくなるため、 1対の電極が接触して、衝突の程度の大きい第 2の衝 突状態が第 2検出部で検出される。この第 4の発明によれば、各検出部が 1対の電極 と弾性体とからなる簡単な構成であり、 2つの弾性体の弾性を異ならせるだけで、 2種 類の衝突状態をそれぞれ検出できることから、衝突検出手段の構成が簡単なものと なり、コスト面で有利である。
[0012] 第 5の発明である自走機器の走行装置は、前記第 4の発明において、前記第 1検 出部の弾性体と前記第 2検出部の弾性体は、前記 1対の電極が離間する方向に重 ねられて!/ヽることを特徴とするものである。
[0013] 重ねられた 2つの弾性体に対して電極の離間方向と平行な方向に衝突の衝撃力が 作用したときに、衝突の程度が小さい場合には第 1検出部の弾性体のみが大きく変 形して、第 1検出部の電極が導通する力 衝突の程度が大きい場合には両検出部の 弾性体が大きく変形して、両検出部の電極がそれぞれ導通する。つまり、本体部の 同一箇所に重ねて設けられた 2つの検出部により、衝突の程度の異なる 2種類の衝 突状態をそれぞれ検出することができる。従って、 2つの検出部が異なる位置にそれ ぞれ設けられている場合には障害物が一方の検出部にしか接触せず、衝突状態を 検出できない虞がある力 この第 5の発明では 2つの検出部の位置が重なっているこ とからそのような問題は生じず、衝突状態をより確実に検出することができる。
[0014] 第 6の発明である自走機器の走行装置は、前記第 4又は第 5の何れかの発明にお いて、前記第 1検出部と前記第 2検出部の、前記 1対の電極及び前記弾性体がそれ ぞれ一方向に長い形状に形成されており、前記第 1検出部と前記第 2検出部は、前 記本体部の外周部のほぼ全周に亘つて設けられて ヽることを特徴とするものである。 この構成によれば、本体部に対して障害物がどの方向から衝突しても、衝突を確実 に検出することができる。
図面の簡単な説明
[0015] [図 1]図 1は、本発明の実施形態に係る案内ロボットの正面図である。
[図 2]図 2は、本発明の実施形態に係る案内ロボットの走行装置の平面図である。
[図 3]図 3は、図 2の III III線断面図である。
[図 4]図 4は、衝突の程度が小さ!/、時のテープスィッチの変形状態を示す図である。
[図 5]図 5は、衝突の程度が大きい時のテープスィッチの変形状態を示す図である。
[図 6]図 6は、走行装置の障害物回避動作を行うための構成を概略的に示す回路図 である。
[図 7]図 7は、走行装置の走行停止動作を行うための構成を概略的に示す回路図で ある。
[図 8]図 8は、変更形態に係る 2つのテープスィッチの図 3相当の断面図である。 符号の説明
[0016] 12 走行輪
21 フレーム
24 テープスィッチ
25 テープスィッチ
40 走行装置
発明を実施するための最良の形態
[0017] 次に、本発明の実施形態について説明する。本実施形態は、被案内者と対話しな がら被案内者を所定の目標位置まで案内する、自走式案内ロボットの走行装置に本 発明を適用した一例である。
[0018] まず、案内ロボット(自走機器)の概略構成について簡単に説明しておく。図 1に示 すように、案内ロボット 1は、胴体部 10と、脚部 11と、 2つの腕部 13と、頭部 14などを 備えた人型のロボットである。さらに、脚部 11には、走行輪 12を備えた走行装置 40 が連結されている。
[0019] 胴体部 10の内部には、案内ロボット 1の駆動源であるバッテリ(図示省略)と、案内 ロボット 1の各部の動作を制御する制御装置 19が設けられている。制御装置 19につ いては後ほど詳しく説明する。また、胴体部 10の外周部には、周囲に存在する被案 内者や障害物などの種々の物体を検出する複数の超音波センサ 20が設けられてい る。この胴体部 10の下端部には脚部 11が連結されて 、る。
[0020] 胴体部 10の上部の左右両側部には、 2つの肩部 26が、左右方向に延びる軸(図 示省略)を介して回転自在に連結されており、さらに、これら 2つの肩部 26に、 2つの 腕部 13が、前後方向(図 1の紙面垂直方向)に延びる軸 27を介してそれぞれ回転自 在に連結されている。つまり、腕部 13は、肩部 26を介して前後方向及び左右方向に それぞれ揺動可能である。
[0021] 頭部 14は胴体部 10の上端部に回転自在に連結されている。この頭部 14の正面( 図 1における手前側の面)には、被案内者等の物体の視覚情報を取得するための C CDカメラ 15と、案内ロボット 1の周囲の音声情報を取得するマイク 17と、外部に対し て音声情報を発信するスピーカ 18等が設けられている。
[0022] 図 1、図 2に示すように、走行装置 40は、フレーム 21 (本体部)と、このフレーム 21 の外周部に設けられたバンパー 23と、フレーム 21の下部の左右両端側部分に回転 自在に設けられた 2つの走行輪 12と、フレーム 21の左右方向中央部に回転自在に 設けられた補助輪 (キャスター) 22とを備えている。 2つの走行輪 12は、モータ 64 (図 6、図 7参照)によりそれぞれ回転駆動される。
[0023] そして、走行装置 40は、モータ 64により 2つの走行輪 12が回転駆動されるとともに 、 2つの補助輪 22が従動回転することで、平坦な走行面上を走行することが可能とな つている。また、モータ 64により、左右 2つの走行輪 12を異なった回転速度で回転駆 動して両輪間に差動を生じさせることで、走行装置 40の向き (走行方向)を任意の方 向に変えることが可能である。
[0024] また、図 2に示すように、バンパー 23の外周部には走行中にフレーム 21が障害物 に衝突したときに、その衝突を検出する 2種類のテープスィッチ 24、 25 (衝突検出手 段)が設けられている。これらテープスィッチ 24、 25については、後ほど詳述する。
[0025] そして、案内ロボット 1は、 CCDカメラ 15等の各種センサ類力もの情報に基づいて、 制御装置 19により案内ロボット 1の各部の動作を制御することにより、人とコミュニケ ーシヨンをとりながら所定の位置まで案内することが可能に構成されている。
[0026] 即ち、超音波センサ 20や CCDカメラ 15で人を認識し、その人が発する音声情報を マイク 17で取得し、スピーカ 18でその人に対して音声情報を発信する。さらに、 CC Dカメラ 15で案内目標の位置を認識し、腕部 13を揺動させたり、頭部 14を回転させ たりして、ジェスチャーを交えながら自走して、人を目標位置まで案内する。
[0027] 次に、衝突検出用のテープスィッチ 24、 25について詳細に説明する。図 2、図 3に 示すように、テープスィッチ 24は、所定間隔を空けて対向する 1対の電極板 31と、こ の 1対の電極板 31を被覆する被覆材 30を有し、 1対の電極板 31及び被覆材 30はと もに一方向に長いテープ状 (帯状)に形成されている。そして、このテープスィッチ 24 は、その面方向がバンパー 23の外面と平行な状態で、バンパー 23 (フレーム 21)の 外周部のほぼ全周に亘つて固着されて 、る。
[0028] 同様に、テープスィッチ 25も、所定間隔を空けて対向する 1対の電極板 34と、この 1対の電極板 34を被覆する被覆材 33を有し、 1対の電極板 34及び被覆材 33はとも に一方向に長いテープ状 (帯状)に形成されている。そして、このテープスィッチ 25 は、テープスィッチ 24の外側(即ち、面方向と直交する、 1対の電極の離間方向)に 重ねられた状態で、テープスィッチ 24と接着されている。即ち、 2つのテープスィッチ 24、 25は、バンパー 23の同じ位置に重ねて設けられている。
[0029] テープスィッチ 24、 25の被覆材 30、 33は、ともにゴム材料などの弾性材料で形成 されている(弾性体)。さらに、外側のテープスィッチ 25の被覆材 33の弾性は、内側 のテープスィッチ 24の被覆材 30の弾性よりも大きい。従って、外側の被覆材 33は、 内側の被覆材 30よりも変形しやすくなつている。 [0030] そして、図 4に示すように、走行中にフレーム 25が障害物に軽く衝突 (接触)して、 外側のテープスィッチ 25に、その面方向に直交する方向にある大きさの外力(衝撃 力)が作用したとする。このとき、 1対の電極板 34を覆っている被覆材 33が内側へ弹 性変形し、さら〖こ、外側の電極板 34が内側へ押圧されて内側の電極板 34に接触し て、 1対の電極板 34が互いに導通する(ON状態)。しかし、内側のテープスィッチ 24 の被覆材 30は、外側の被覆材 33よりも弾性が低い(剛性が高い)ため、その変形は 小さぐ被覆材 30により被覆された 1対の電極板 31が接触することはない (OFF状態 ) oつまり、外側のテープスィッチ 25のみが ONすることにより、衝突の程度が小さい、 軽い衝突状態 (第 1の衝突状態)が検出される。即ち、テープスィッチ 25が本願発明 の第 1検出部に相当する。
[0031] 一方、図 5に示すように、走行装置 40が暴走するなどして、フレーム 21が障害物に 強く衝突し、外側のテープスィッチ 25により大きな外力が作用したとする。このとき、 外側のテープスィッチ 25は当然ながら ONになる。さらに、内側のテープスィッチ 24 にお 、ても被覆材 30が弾性変形して、外側の電極板 31が内側へ押圧されて内側の 電極板 31に接触するため、テープスィッチ 24が ONとなる。つまり、内側のテープス イッチ 24が ONすることにより、前述した第 1の衝突状態よりも衝突の程度が大きい、 強い衝突状態 (第 2の衝突状態)が検出されることになる。即ち、テープスィッチ 24が 本願発明の第 2検出部に相当する。
[0032] このように、衝突検出手段として 1対の電極板 31、 34と弾性材料カゝら形成された被 覆体 30、 33と力もなる簡単な構成のテープスィッチ 24、 25を用いるとともに、 2つの 被覆体 30、 33の弾性を異ならせるだけで、 2種類の衝突状態をそれぞれ検出できる ことから、衝突を検出するための構成が簡単なものとなり、コスト面で有利である。また 、 2つのテープスィッチ 24、 25は、フレーム 21の外周部(バンパー 23)の全周に亘っ て設けられていることから、フレーム 21に対して障害物がどの方向力も衝突しても、そ の衝突を検出することができる。従って、走行装置 40が前後に走行中に障害物に衝 突する場合はもちろんのこと、旋回中(方向転換中)にフレーム 21の側部が障害物と 衝突する場合も、衝突を確実に検出することができる。
[0033] また、 2つのテープスィッチ 24、 25は、バンパー 23の同じ位置において、電極板 3 1、 34の離間方向(面方向と直交する方向)に重ねて設けられている。 2つのテープ スィッチ 24、 25がバンパー 23の異なる位置にそれぞれ設けられている場合には障 害物が一方のテープスィッチにし力接触せず、衝突状態を検出できない虞があるが 、本実施形態では 2つのテープスィッチ 24、 25が重なっていること力もそのような問 題は生じず、衝突状態をより確実に検出することができる。
[0034] 尚、テープスィッチ 24は、走行方向一方(図 2における上方)と他方(図 2における 下方)の 2つの部分(24a、 24b)に分割されている。同じぐテープスィッチ 25も、走 行方向一方と他方の 2つの部分(25a、 25b)に分割されている。そのため、 2つの部 分の何れにおいて衝突が検出されたかによって、フレーム 21のどの部分が障害物に 衝突したかを認識できるようになって!/ヽる。
[0035] 次に、制御装置 19を中心とする案内ロボット 1の電気的な構成について、図 6及び 図 7を用いて説明する。制御装置 19は、中央演算処理装置である CPU (Central Pro cessing Unit)と、案内ロボット 1の各部の制御を行うためのプログラムやデータ等が格 納された ROM (Read Only Memory)、 CPUで処理されるデータを一時的に記憶する RAM (Random Access Memory)等を備えている。
[0036] この制御装置 19には、複数の超音波センサ 20、 CCDカメラ 15、及び、マイク 17で 取得された、案内ロボット 1の周囲に存在する、被案内者や障害物等の物体に関す る情報 (位置情報、視覚情報、音声情報など)が入力される。また、スピーカ 18に対し て、被案内者に伝達すべき情報 (文字情報や音声メッセージ等)を出力する。さらに 、制御装置 19は、超音波センサ 20や CCDカメラ 15等により取得された被案内者に 関する情報に基づいて、各部(走行輪 12、腕部 13、頭部 14など)を駆動し、 ROMに 記憶された案内制御プログラムによって設定された所定の案内動作を行う。
[0037] さらに、案内ロボット 1は、テープスィッチ 25により比較的衝突の程度が小さい第 1 の衝突状態が検出されたときには、制御装置 19により走行輪 12を駆動するモータ 6 4が制御されて、走行装置 40が障害物を回避するように構成されている(障害物回避 動作)。一方で、案内ロボット 1は、テープスィッチ 24により衝突の程度が大きい第 2 の衝突状態が検出されたときには、モータによる走行輪 12の駆動が強制的に停止し て、走行装置 40の走行を停止するように構成されている(走行停止動作)。これら 2つ の動作にっ 、て、これらの動作を実現するための具体的な構成と合わせて以下詳細 に説明する。
[0038] (障害物回避動作)
まず、走行装置 40の障害物回避動作について説明する。図 6に示すように、ドライ バ 63は、動力供給源 53から動力(電力)の供給を受けて、制御装置 19からの指令 信号に従ってモータ 64を駆動する。一方、テープスィッチ 25 (25a、 25b)の一方の 電極板 34には抵抗 52を介して電源電圧(+V)が印加されており、他方の電極板 34 は GNDに接続されている。さらに、 1対の電極板 34の間には、リレー 50のコイル 50a とダイオード 51が並列に接続されている。尚、ダイオード 51及び抵抗 52は保護素子 である。
[0039] リレー 50の接点 50bは、抵抗 54とともに +Vと GND間に直列に接続されており、こ の接点 50bが ONとなったときに制御装置 19に割り込み信号 (IRQ)が入力される。ま た、リレー 50は、 2つに分割されたテープスィッチ 25a、 25bのそれぞれに対して設け られており、テープスィッチ 25a、 25bの何れか一方が ONしたときに、対応するリレー 50の接点 50bが ONとなって制御装置 19に割り込み信号が入力されるようになって いる。一方で、制御装置 19の ROMには障害物回避プログラムが格納されており、割 り込み信号が入力されたときには、この障害物回避プログラムが CPUで優先的に実 行される。尚、抵抗 54は保護素子である。
[0040] 走行装置 40が障害物と衝突して ヽな ヽ状態では、テープスィッチ 25の 1対の電極 板 34は接触しておらず、テープスィッチ 25は OFFになっている。このとき、図 6に示 すように、コイル 50aに電源電圧(+V)が印加されており、コイル 50aが駆動されてリ レー 50の接点 50bが OFFとなっているため、走行装置 40に回避動作を行わせるた めの割り込み信号は制御装置 19に入力されていない。従って、制御装置 19は、 RO Mに格納された案内制御プログラム等に従って、ドライバ 63を介して走行輪 12を駆 動するモータ 64を制御することになり、走行装置 40は案内動作等に対応した通常の 走行を行う。
[0041] この状態から、案内ロボット 1の走行中に、バンパー 23が障害物と接触する程度に 軽く衝突したときには、 1対の電極板 33が導通(短絡)して、テープスィッチ 25が ON の状態になり、コイル 50aは GND電位となってコイル 50aが駆動されなくなる。すると 、リレー 50の接点 50bが ONになって、制御装置 19に割り込み信号が入力される。こ のとき、制御装置 19の CPUは、 ROMに格納された回避制御プログラムを、案内制 御プログラム等の他の制御プログラムに優先して実行し、走行装置 40のフレーム 21 が障害物を回避するようにモータ 64を制御する。つまり、制御装置 19が本願発明の 回避制御手段に相当する。
[0042] より具体的には、制御装置 19は、衝突直前の走行方向と反対の方向に走行装置 4 0を一旦走行させる。また、走行装置 40が旋回中(方向転換中)に障害物に衝突した 場合には、衝突直前の旋回方向と逆方向に走行装置 40を一旦旋回させる。尚、図 2 に示すように、テープスィッチ 25は 2つの部分 25a、 25bに分割されていることから、 これら 2つの部分 25a、 25bのどちらが ONになったかによつて、制御装置 19は衝突 直前の走行装置 40の走行方向をある程度推測することが可能である。または、モー タ 64の回転方向や回転速度のデータを RAM等に記憶させ、制御装置 19がこのモ ータ 64に関する過去のデータを参照することにより、衝突直前の走行装置 40の走行 方向を推測してもよい。あるいは、テープスィッチ 25が 2つの部分に分割されていると 、移動してくる人などの障害物が衝突する場合でも、どの方向から衝突した力をある 程度推測することが可能であるので、適切な回避行動を行える。
[0043] 以上説明したような障害物回避動作を行うことにより、バンパー 23が障害物から離 れてテープスィッチ 25が OFFとなる。さらに、テープスィッチ 25が OFFとなってから ある所定時間が経過したときには、制御装置 19は走行装置 40が障害物力も十分に 離れた位置に達したと判断して、走行装置 40の障害物回避動作を終了する。すると 、走行装置 40は、被案内者の案内動作等に伴う通常の走行を再開する。
[0044] このように、走行装置 40のフレーム 21が障害物に軽く衝突した場合には、走行装 置 40は障害物回避動作を行い、走行を停止しないため、頻繁な走行停止を抑制す ることができ、非常停止後の復帰操作等を行うオペレータの負担が軽減される。
[0045] (走行停止動作)
次に、走行装置 40の走行停止動作について説明する。図 7に示すように、テープ スィッチ 24 (24a、 24b)の一方の電極板 31には抵抗 65を介して電源電圧(+V)が 印加されており、他方の電極板 31は GNDに接続されている。さら〖こ、 1対の電極板 3 1の間には、リレー 60のコイル 60aとダイオード 66が並列に接続されている。尚、ダイ オード 66及び抵抗 65は保護素子である。
[0046] リレー 60の接点 60bは +Vと GND間に設けられている。また、この接点 60bと +V との間にはリレー 61の接点 61bが設けられ、接点 60bと GNDとの間にはリレー 61の コイル 61aと抵抗 67が設けられている。接点 61bはコイル 61aにより ONZOFFされ る。また、接点 61cと並列にリセットスィッチ 62が接続されている。さらに、ドライバ 63 と動力供給源 53との間には、接点 61cが設けられており、この接点 61cも、接点 61b と同じく、リレー 61のコイル 61aにより ONZOFFされる。尚、抵抗 67は保護素子であ る。
[0047] 走行装置 40が障害物と衝突して ヽな ヽ状態では、テープスィッチ 24の 1対の電極 板 31は接触しておらず、テープスィッチ 24は OFFになっている。このとき、コイル 60 aには電源電圧(+V)が印加されており、接点 60bは ONとなっている。また、接点 6 lbが ONで、コイル 6 laに電源電圧(+V)が印加されているため、コイル 61aが駆動 されて接点 61cが ONとなる。つまり、動力供給源 53からドライバ 63へ動力が供給さ れて、モータ 64が走行輪 12を駆動可能な状態である。
[0048] この状態から、走行装置 40の暴走等などにより、フレーム 21のバンパー 23が障害 物と強く衝突し、テープスィッチ 25に大きな衝撃力が作用したときには、 1対の電極 板 31が導通(短絡)してテープスィッチ 25が ONとなる。このとき、コイル 60aが GND 電位となって駆動されなくなり、接点 60bが OFFとなる。すると、コイル 61aも GND電 位となって駆動されなくなり、接点 61b、 61cがともに OFFとなる。そして、接点 61cが OFFになることにより、動力供給源 53からドライバ 63への動力供給が瞬時に遮断さ れて、モータ 64による走行輪 12の駆動が停止するため、走行装置 40の走行が停止 することになる。尚、モータ 64への動力供給を遮断するためのリレー 60、 61が、本願 発明の走行停止手段に相当する。
[0049] 尚、リレー 60、 61等は、 2つに分割されたテープスィッチ 24a、 24bのそれぞれに対 して設けられており、テープスィッチ 24a、 24bの何れか一方が ONしたときに、対応 する接点 61cが OFFとなって、モータ 64 (ドライバ 63)への動力供給が遮断される。 [0050] このように、走行装置 40の暴走等によってフレーム 21のバンパー 23が障害物に強 く衝突して、テープスィッチ 24が ONの状態になったときには、モータ 64 (ドライバ 63 )への動力供給が遮断されることから、走行装置 40の走行を瞬時に停止され、事故 や案内ロボット 1の損傷を確実に防止できる。
[0051] また、前述したように、テープスィッチ 24が ONとなるときには、テープスィッチ 25も 必ず ONとなる。このテープスィッチ 25が ONとなったときには、前述した障害物回避 制御の割り込み信号が制御装置 19に入力されるが(図 6参照)、同時にモータ 64 (ド ライバ 63)への動力供給が遮断される。つまり、走行停止動作が障害物回避動作に 優先して行われることになり、走行装置 40は障害物回避動作を行うことなぐ直ちに 停止することになる。
[0052] ところで、走行装置 40が停止したのち、走行装置 40が障害物から離されると、テー プスィッチ 24の 1対の電極板 31が離れて、テープスィッチ 24は再び OFFの状態とな る。このとき、コイル 60aには電源電圧(+V)が印加されること力も接点 60bは ONに なる。し力し、接点 6 lbは OFFで、コイル 61aも GND電位のままであるため、接点 61 cが OFFの状態が保持される。つまり、非常停止後に走行装置 40が障害物力も離さ れても、モータ 64には動力供給部 53から動力が供給されないため、走行装置 40は 走行不能の状態である。従って、走行装置 40に不具合などが生じて暴走した場合に 、走行装置 40を緊急に停止させた後に、再び走行装置 40が暴走し始めることはな い。
[0053] 尚、走行装置 40を走行可能な状態に復帰させる場合には、リセットスィッチ 62を押 す。すると、コイル 61aに電源電圧(+V)が印加されて、接点 61b、 61cがともに ON となるため、動力供給部 53からドライバ 63に動力が再び供給されることとなり、モータ 64を駆動することができるようになる。
[0054] 以上説明した本実施形態の案内ロボット 1の走行装置 40によれば、 2つのテープス イッチ 24、 25により、衝突の程度の異なる 2つの衝突状態を検出することができるた め、走行装置 40は障害物回避と走行停止の 2種類の動作を行うことができる。これに より、弱い衝突で頻繁に停止せず、且つ、強い衝突時には走行を確実に停止させて 、事故や損傷を防止することができる。 [0055] 以上、本発明の好適な実施形態について説明したが、本発明はその趣旨を超えな い範囲において変更が可能である。例えば、前述した実施形態では、図 3に示すよう に、テープスィッチ 24、 25は電極板同士が離間する方向に並べて配置した状態で バンパー 23に設けられていたが、図 8に示すように、テープスィッチ 24、 25は長手方 向に対して直交した状態に並べてバンパー 23に設けられてもよ 、。
[0056] また、テープスィッチ 24、 25の分割数は 2つに限られず、 3以上の数に分割されて いてもよい。この分割数が多いほど、バンパー 23のどの部分に障害物が衝突したか をより正確に検出できるようになり、その衝突箇所に適した障害物回避動作を行うこと が可能になる。
[0057] さらに、テープスィッチ 24、 25がバンパー 23の外周部の全周に亘つて設けられて いる必要は必ずしもなぐ障害物に特に衝突しやすい外周部の一部(例えば、パンパ 一が隅部をもつ場合には走行方向両端部と 4つの隅部など)にのみ設けられていて ちょい。
[0058] さらに、前記実施形態では、案内ロボット 1の走行を停止するために、動力供給源 5 3からドライバ 63への動力供給を、リレー 61を用いて直接遮断していたが(図 7参照) 、障害物回避動作 (図 6参照)と同様に、割り込み信号が制御装置 19に入力されて、 制御装置 19からの指令によりドライバ 63がモータ 64の駆動を停止するように構成さ れていてもよい。
[0059] また、テープスィッチ 24、 25で 2つの衝突状態がそれぞれ検出されたときに、それ らの情報が外部の中央制御装置に送られて、この中央制御装置力 の指令により、 走行装置 40の障害物回避動作や走行停止動作が行われるように構成されて 、ても よい。
[0060] 衝突の程度が異なる 2種類の衝突状態を検出する衝突検出手段としては、前記実 施形態のテープスィッチ 24、 25に限られるものではない。例えば、ひずみゲージ等 により衝突時の衝撃力の大きさを計測可能な衝撃力検出センサを用いれば、計測さ れた衝撃力の大きさによって、衝突の程度を判別することが可能となる。
[0061] 以上の説明した実施形態は、被案内者を目標位置まで案内する案内ロボットに本 発明を適用した一例であるが、本発明を適用できる自走機器は案内ロボットに限られ ない。即ち、無人搬送車や産業用の自走ロボットなどの他の自走機器にも本発明を 適用することが可能である。

Claims

請求の範囲
[1] 本体部と、この本体部に回転自在に支持された走行輪と、前記走行輪を回転駆動す る走行駆動手段を備えた自走機器の走行装置であって、
前記本体部に設けられて、走行中に前記本体部が障害物に衝突したときに、その衝 突を検出する衝突検出手段をさらに備え、
前記衝突検出手段は、第 1の衝突状態と、この第 1の衝突状態よりも衝突の程度が大 き ヽ第 2の衝突状態の、 2種類の衝突状態をそれぞれ検出可能であることを特徴とす る自走機器の走行装置。
[2] 前記衝突検出手段により前記第 1の衝突状態が検出されたときに、前記本体部が前 記障害物を回避するように前記走行駆動手段を制御する回避制御手段と、
前記衝突検出手段により前記第 2の衝突状態が検出されたときに、前記走行駆動 手段による前記走行輪の駆動を停止させる走行停止手段とを有することを特徴とす る請求項 1に記載の自走機器の走行装置。
[3] 前記走行停止手段は、前記走行駆動手段への動力供給を遮断することにより前記 走行輪の駆動を停止させることを特徴とする請求項 2に記載の自走機器の走行装置
[4] 前記衝突検出手段は、前記第 1の衝突状態を検出する第 1検出部と、前記第 2の検 出状態を検出する第 2検出部とを備え、
前記第 1検出部と前記第 2検出部は、所定間隔を空けて対向する 1対の電極と、前 記 1対の電極を被覆する弾性体をそれぞれ有し、
前記第 1検出部の弾性体の弾性は、前記第 2検出部の弾性体の弾性よりも大きいこ とを特徴とする請求項 1〜3の何れかに記載の自走機器の走行装置。
[5] 前記第 1検出部の弾性体と前記第 2検出部の弾性体は、前記 1対の電極が離間する 方向に重ねられていることを特徴とする請求項 4に記載の自走機器の走行装置。
[6] 前記第 1検出部と前記第 2検出部の、前記 1対の電極及び前記弾性体がそれぞれ一 方向に長 ヽ形状に形成されており、
前記第 1検出部と前記第 2検出部は、前記本体部の外周部のほぼ全周に亘つて設 けられて ヽることを特徴とする請求項 4又は 5に記載の自走機器の走行装置。
PCT/JP2007/050581 2006-05-17 2007-01-17 自走機器の走行装置 Ceased WO2007132572A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US12/299,916 US20090164123A1 (en) 2006-05-17 2007-01-17 Travel device for self-propelled device
JP2008515439A JP4788767B2 (ja) 2006-05-17 2007-01-17 自走機器の走行装置
EP07706896A EP2019348A4 (en) 2006-05-17 2007-01-17 MOVEMENT DEVICE FOR A SELF-DRIVEN DEVICE

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2006-137268 2006-05-17
JP2006137268 2006-05-17

Publications (1)

Publication Number Publication Date
WO2007132572A1 true WO2007132572A1 (ja) 2007-11-22

Family

ID=38693673

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2007/050581 Ceased WO2007132572A1 (ja) 2006-05-17 2007-01-17 自走機器の走行装置

Country Status (6)

Country Link
US (1) US20090164123A1 (ja)
EP (1) EP2019348A4 (ja)
JP (1) JP4788767B2 (ja)
KR (1) KR20090007786A (ja)
TW (1) TW200800684A (ja)
WO (1) WO2007132572A1 (ja)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009011362A (ja) * 2007-06-29 2009-01-22 Sony Computer Entertainment Inc 情報処理システム、ロボット装置及びその制御方法
JP6104519B2 (ja) * 2012-05-07 2017-03-29 シャープ株式会社 自走式電子機器
DE102012107115A1 (de) * 2012-08-02 2014-02-06 Brose Fahrzeugteile Gmbh & Co. Kommanditgesellschaft, Hallstadt Verfahren zur Steuerung eines kapazitiven Einklemmschutzsystems und Einklemmschutzsystem
CN105666504B (zh) * 2016-04-20 2018-01-19 广州蓝海机器人系统有限公司 一种具有专业解说功能的机器人
TWI665538B (zh) * 2016-12-12 2019-07-11 日商日本電產新寶股份有限公司 進行障礙物之迴避動作的移動體及記錄其之電腦程式的記錄媒體
CN106515946A (zh) * 2016-12-23 2017-03-22 纳恩博(北京)科技有限公司 机器人
KR102235270B1 (ko) * 2017-01-18 2021-04-01 엘지전자 주식회사 이동 로봇 시스템 및 그 제어방법
CN108088642A (zh) * 2018-02-09 2018-05-29 无锡顺达智能自动化工程股份有限公司 一种碰撞检测系统
NL2023389B1 (nl) * 2019-06-26 2021-02-01 Lely Patent Nv Zelfrijdende maaier met veiligheidsvoorziening
CN212808994U (zh) * 2020-07-08 2021-03-26 达闼机器人有限公司 机器人和机器人底盘系统及其碰撞检测机构
GB2610793B (en) 2021-01-22 2023-09-13 Dyson Technology Ltd Autonomous surface treatment apparatus
GB2612567B (en) 2021-01-22 2023-11-22 Dyson Technology Ltd Autonomous surface treatment apparatus

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05189041A (ja) * 1992-01-14 1993-07-30 Matsushita Electric Ind Co Ltd 移動作業ロボットの障害物検知装置
JPH06219226A (ja) 1993-01-21 1994-08-09 Murata Mach Ltd バンパーの衝突検出装置

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0386005A (ja) * 1989-08-28 1991-04-11 Matsushita Electric Works Ltd 電動車椅子
US5392024A (en) * 1991-06-14 1995-02-21 Toyota Jidosha Kabushiki Kaisha Collision detection system
EP0937612A3 (en) * 1998-02-24 2000-03-15 Kabushiki Kaisha Toyota Chuo Kenkyusho A collision discriminating apparatus for vehicles using detecting means in the front bumper
US6941199B1 (en) * 1998-07-20 2005-09-06 The Procter & Gamble Company Robotic system
JP3277279B2 (ja) * 1999-11-30 2002-04-22 科学技術振興事業団 ロボット聴覚装置
JP3910130B2 (ja) * 2002-09-30 2007-04-25 ファナック株式会社 ロボットシステム

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05189041A (ja) * 1992-01-14 1993-07-30 Matsushita Electric Ind Co Ltd 移動作業ロボットの障害物検知装置
JPH06219226A (ja) 1993-01-21 1994-08-09 Murata Mach Ltd バンパーの衝突検出装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP2019348A4

Also Published As

Publication number Publication date
EP2019348A4 (en) 2010-06-09
JP4788767B2 (ja) 2011-10-05
US20090164123A1 (en) 2009-06-25
JPWO2007132572A1 (ja) 2009-09-24
KR20090007786A (ko) 2009-01-20
EP2019348A1 (en) 2009-01-28
TW200800684A (en) 2008-01-01

Similar Documents

Publication Publication Date Title
JP4788767B2 (ja) 自走機器の走行装置
JP7014508B2 (ja) 自律走行装置及び自律走行制御方法と制御プログラム
CN105313142B (zh) 移动式人机协调型机器人
US9855948B2 (en) Vehicle control device
KR101361562B1 (ko) 청소로봇
EP3466314A1 (en) Cleaning robot and method of surmounting obstacle
US20160202703A1 (en) Self-propelled electronic device
JP2015131544A (ja) 車両用制御装置
JP7462416B2 (ja) 自律走行作業装置
US20110308365A1 (en) Safety device for machine tool
CN105022396B (zh) 前向暨左右侧向跟随装置及其跟随控制方法
JP2010122916A (ja) 自律移動装置
JP2015084129A (ja) 案内用ロボット
KR100635824B1 (ko) 청소로봇의 장애물 감지 및 구동 제어 방법과 그를 이용한청소로봇
JP2009151382A (ja) 移動体
JP4655912B2 (ja) 自律走行ロボットシステム
GB2102999A (en) Vehicle safety devices
JP7799476B2 (ja) 自律走行ロボットシステム
JP2010122930A (ja) 自律移動装置
JP2006334082A (ja) 電動車椅子用着脱可能な安全停止装置
JP5517422B2 (ja) 自律移動装置
CN115194821B (zh) 一种机器人紧急制动系统和方法
JP5928321B2 (ja) 駐車支援装置
TWI619486B (zh) Transport auxiliary device
JPH07160335A (ja) 走行ロボットの前方障害物検出装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 07706896

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2008515439

Country of ref document: JP

WWE Wipo information: entry into national phase

Ref document number: 12299916

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 2007706896

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 1020087029595

Country of ref document: KR