WO2021255797A1 - 自律移動装置、自律移動方法及びプログラム - Google Patents

自律移動装置、自律移動方法及びプログラム Download PDF

Info

Publication number
WO2021255797A1
WO2021255797A1 PCT/JP2020/023468 JP2020023468W WO2021255797A1 WO 2021255797 A1 WO2021255797 A1 WO 2021255797A1 JP 2020023468 W JP2020023468 W JP 2020023468W WO 2021255797 A1 WO2021255797 A1 WO 2021255797A1
Authority
WO
WIPO (PCT)
Prior art keywords
teaching
point
data
route
control
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/JP2020/023468
Other languages
English (en)
French (fr)
Inventor
章 大島
宏泰 城吉
茂 阪東
索 柄川
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Doog Inc
Original Assignee
Doog Inc
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 Doog Inc filed Critical Doog Inc
Priority to EP20941126.3A priority Critical patent/EP4167043A4/en
Priority to JP2022531118A priority patent/JP7495154B2/ja
Priority to PCT/JP2020/023468 priority patent/WO2021255797A1/ja
Priority to US18/002,025 priority patent/US20230341862A1/en
Priority to PCT/JP2021/015009 priority patent/WO2021256062A1/ja
Priority to US18/002,029 priority patent/US20230266762A1/en
Priority to JP2022532332A priority patent/JP7576343B2/ja
Publication of WO2021255797A1 publication Critical patent/WO2021255797A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0248—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means in combination with a laser

Definitions

  • the present invention relates to an autonomous mobile device, an autonomous mobile method and a program.
  • the route generation unit 13 generates a movement route from the current location to the destination based on the map data recorded in the map storage unit 22.
  • the method of generating this movement route is arbitrary.
  • the route generation unit 13 may generate the shortest route from the current location to the destination using a path that can be moved by the autonomous movement device 100 obtained from the map data, or may use the teaching route recorded during the follow-up instruction processing. A movement route may be generated based on this. Further, for example, when the current location is the teaching end point and the destination is the teaching start point, the route generation unit 13 generates a route that follows the teaching route recorded in the follow-up teaching process in the opposite direction as a movement route. May be good. In the following, it is assumed that the route generation unit 13 generates a movement route by using a teaching route and a route that follows the teaching route in the opposite direction.
  • the peripheral information conversion unit 14 uses the teaching route stored in the map storage unit 22 as the teaching route.
  • the surrounding environment data detected by the detection unit 31 is converted into data when the surrounding environment is detected from the reverse direction (reverse direction data) and recorded in the map storage unit 22. With this reverse direction data, the autonomous mobile device 100 can easily follow the teaching route in the reverse direction.
  • Step S205 is also referred to as a route movement step.
  • the control unit 10 grasps the current position and orientation of the autonomous movement device 100 by using the surrounding environment data detected by the detection unit 31 and the map data recorded in the map storage unit 22.
  • the control unit 10 When information on the arrangement and number of reflective materials is recorded in the map data, the control unit 10 is recognized by the peripheral information acquisition unit 11 when grasping the current position and orientation of the autonomous mobile device 100. Priority is given to the information on the reflective material (position and number of reflective materials) to match with the map data. If the information of the reflectors does not match (for example, the number of reflectors is different) continues for a predetermined time (for example, 10 seconds) or a predetermined movement distance (for example, 10 m), the control unit 10 autonomously moves. The device 100 may be stopped. Compared with other ordinary objects, the reflective material can accurately recognize its position and number by the detection unit 31, and the fact that the non-matching state continues for a predetermined time or moving distance means that the autonomous moving device 100 Is likely to deviate from the original route.
  • a predetermined time for example, 10 seconds
  • a predetermined movement distance for example, 10 m
  • the control unit 10 determines whether or not there is an obstacle in the traveling direction using the surrounding environment data detected by the detection unit 31 (step S206).
  • the control unit 10 collates the surrounding environment data detected by the detection unit 31 with the point data registered in the point storage unit 21. It is determined whether or not the autonomous mobile device 100 has arrived at the destination (step S207). This determination can be made by determining whether or not the acquired current location is the same as the destination in the same manner as the current location acquisition in step S203 described above.
  • step S207; No If the destination has not arrived (step S207; No), the process returns to step S205.
  • the movement control unit 15 stops the drive unit 40 (step S208) and returns to step S201.
  • step S206 determines whether or not the obstacle can be avoided.
  • the control unit 10 determines that the obstacle can be avoided.
  • the control unit 10 does not lose track of the current position (self-position) of the autonomous mobile device 100 (for example, the surrounding environment data detected by the detection unit 31 is collated with the map data recorded in the map storage unit 22. Obstacles can be avoided within the range (where the self-position can be grasped).
  • step S209 determines that the obstacle can be avoided (step S209; Yes)
  • the movement control unit 15 controls the drive unit 40 so as to avoid the obstacle, thereby avoiding the obstacle and moving (step S209; Yes).
  • step S210 determines whether or not there is an obstacle in the traveling direction by using the data detected by the detection unit 31 (step S211). If there is an obstacle (step S211; Yes), the process returns to step S209.
  • step S214 When the user's instruction is input (step S214; Yes), the control unit 10 proceeds to step S211 according to the user's instruction (step S215).
  • step S215 for example, it is assumed that the autonomous mobile device 100 moves to a place without obstacles or a place where obstacles can be avoided according to a user's instruction.
  • the obstacle avoidance in the above-mentioned reproduction process will be supplementarily described with reference to FIG.
  • the autonomous mobile device 100 detects an obstacle 73 and an obstacle 74 while moving from the first point 81 to the second point 82.
  • the peripheral environment data 60b and 60c detected by the detection unit 31 when moving the original movement route 62 and the peripheral environment data 60m detected by the detection unit 31 when moving the avoidance route 67. It is considered that the difference between the two is small and the control unit 10 does not lose sight of the self-position of the autonomous mobile device 100.
  • the obstacle 73 cannot be avoided without moving the avoidance route 68, such as the obstacle 73 protruding to the right of the avoidance route 67 shown in FIG.
  • the control unit 10 determines that the obstacle is unavoidable.
  • the control unit 10 determines that the obstacle is unavoidable.
  • the playback process has been explained above. An example of the reproduction process will be described with reference to FIG. First, it is assumed that the autonomous mobile device 100 follows the user from the first point 81 to the second point 82 and teaches by the above-mentioned follow-up teaching process in advance. As a result of this follow-up teaching process, the first point data and the second point data are registered in the point storage unit 21, and the route from the first point 81 to the second point 82 (first teaching route) and the surrounding environment data between them. Is recorded in the map storage unit 22.
  • step S202 the determination in step S202 is Yes, and the control unit 10 acquires that the current location is the second point 82 (step S203).
  • the route generation unit 13 generates a movement route from the current location to the destination (step S204).
  • the route generation unit 13 generates a route that traces the first teaching route recorded in the map storage unit 22 in the reverse direction during the follow-up teaching process as the movement route from the second point 82 to the first point 81.
  • the peripheral information conversion unit 14 uses the peripheral environment data 60a, 60b, 60c, 60d detected by the detection unit 31 when following the user among the data stored in the map storage unit 22. Is converted into data when detected from the reverse direction to generate reverse direction data (reverse direction data 60a', 60b', 60c', 60d') and recorded in the map storage unit 22.
  • the detection unit 31 since the detection unit 31 detects the surrounding environment in the angle range of 270 degrees, the data in the angle range of 90 degrees behind cannot be detected. Therefore, as shown in FIG. 9, when the surrounding environment is converted into the data when it is detected from the reverse direction, the data in the range of 90 degrees in front cannot be generated, and the reverse direction data 60a', 60b', 60c', 60d. 'Is data in an angle range of 90 degrees on each side. Even with such data, it is possible to match with the surrounding environment data detected by the detection unit 31 as described in the current location acquisition in step S203 described above. Of course, if a device capable of detecting the surrounding environment in an angle range of 360 degrees is used as the detection unit 31, it is possible to convert the peripheral environment data at the time of tracking into reverse direction data in the angle range of 360 degrees.
  • the control unit 10 collates the peripheral environment data detected by the detection unit 31 with the reverse direction data (for example, reverse direction data 60a', 60b', 60c', 60d') generated by the peripheral information conversion unit 14.
  • the movement control unit 15 controls the drive unit 40 so as to move according to the movement path (step S205).
  • the determination in step S206 is No, and the autonomous mobile device 100 continues to move according to the movement route until it arrives at the destination (first point 81), and continues to move according to the destination (first point 81). ) (Step S207; Yes), stop (step S208).
  • the autonomous mobile device 100 can move using the taught route in a direction other than the direction of movement when taught (in the above example, the reverse direction). As a result, the autonomous mobile device 100 enables more flexible route generation and operation.
  • the control unit 10 will perform the control unit 10. Autonomous by collating the surrounding environment data 60e detected by the detection unit 31 with the first point data (peripheral environment data 60a) and the second point data (peripheral environment data 60e) registered in the point storage unit 21. It is understood that the current position of the mobile device 100 is the second point 82, and the autonomous mobile device 100 faces in the opposite direction to the first point 81. In this case, the movement control unit 15 controls the drive unit 40 so that the direction of the autonomous movement device 100 is opposite to that of the autonomous movement device 100, and then moves to the first point 81 as described above.
  • the autonomous mobile device 100 follows the user from the third point 83 to the fourth point 84 and teaches by the above-mentioned follow-up teaching process. Then, as a result of this follow-up teaching process, the third point data and the fourth point data are registered in the point storage unit 21 in addition to the first point data and the second point data. Then, the route from the third point 83 to the fourth point 84 (second teaching route) and the surrounding environment data between them are also recorded in the map storage unit 22. Further, since the third point 83 exists on the route (first teaching route) from the first point 81 to the second point 82 where the instruction was first received, the control unit 10 stores the map at the third point 83. It is grasped that it is a point existing on the first teaching route recorded in the part 22.
  • the control unit 10 inputs the surrounding environment data 60k detected by the detection unit 31 to the first point data (1st point data) registered in the point storage unit 21. It is collated with the surrounding environment data 60a), the second point data (surrounding environment data 60e), the third point data (surrounding environment data 60h), and the fourth point data (surrounding environment data 60j).
  • the control unit 10 can determine that the current location is the fourth point 84. Therefore, the determination in step S202 is Yes, and the control unit 10 acquires that the current location is the fourth point 84 (step S203).
  • the route generation unit 13 generates a movement route from the current location to the destination (step S204).
  • the first point data, the second point data, the third point data, and the fourth point data are registered in the point storage unit 21, and since the current location is the fourth point 84, the destination is the first point 81.
  • the second point 82 or the third point 83 the user is requested to instruct, and the user is asked to input the destination from the operation acquisition unit 32.
  • the user has designated the second point 82 as the destination.
  • the route generation unit 13 traces the second teaching route recorded in the map storage unit 22 in the reverse direction at the time of the follow-up teaching process as the movement route from the fourth point 84 to the second point 82, and the third point.
  • a route to be traced to the second point 82 in the direction of following from the middle of the first teaching route recorded in the map storage unit 22 is generated.
  • the control unit 10 knows that the third point 83 is a point on the first teaching route. It can be recognized that the second teaching route is connected to the first teaching route at the third point 83. In this way, the route generation unit 13 can generate a movement route in which the teaching routes recorded so far are arbitrarily connected.
  • the peripheral information conversion unit 14 uses the peripheral environment data 60h and 60i detected by the detection unit 31 when the user is followed by the second teaching route among the map data stored in the map storage unit 22.
  • Reverse direction data (reverse direction data 60h', 60i') is generated by converting the surrounding environment into data when it is detected from the reverse direction, and is recorded in the map storage unit 22.
  • step S205 the determination in step S206 is No, and the autonomous mobile device 100 continues to move according to the movement route until it arrives at the destination (second point 82), and continues to move according to the movement route to the destination (second point 82). ) (Step S207; Yes), stop (step S208).
  • step S205 since the second teaching route is traced in the reverse direction from the fourth point 84 to the third point 83, the surrounding environment data detected by the detection unit 31 and the peripheral information conversion unit 14 generate the data.
  • the control unit 10 grasps the current position and orientation of the autonomous mobile device 100 by collating with the reverse direction data (for example, the reverse direction data 60h', 60i'). Further, since the first teaching route is traced in the forward direction from the third point 83 to the second point 82, the surrounding environment data detected by the detection unit 31 is stored in the map storage unit 22.
  • the control unit 10 grasps the current position and orientation of the autonomous mobile device 100 by collating with (for example, surrounding environment data 60c, 60d, 60e).
  • the autonomous mobile device 100 can not only move using the taught route in a direction other than the direction of movement when taught (reverse direction in the above example), but also the plurality of taught paths. It is also possible to move a route that combines the routes of.
  • this reproduction correction process also starts execution when the autonomous mobile device 100 is activated, and is in a state of waiting for a user's instruction to be input from the operation acquisition unit 32.
  • step S221 is executed between steps S205 and S206. Therefore, step S221 will be mainly described.
  • the control unit 10 autonomously moves using the surrounding environment data detected by the detection unit 31 and the map data recorded in the map storage unit 22. Grasp the current position and orientation of the device 100. At that time, in the above-mentioned reproduction process, especially when the information of the reflective material does not match, the control unit 10 determines that there is a high possibility that the autonomous moving device 100 deviates from the original path.
  • the control unit 10 causes the detection unit 31 to match.
  • the detected surrounding environment data is regarded as correct data, and the map data recorded in the map storage unit 22 is corrected (step S221).
  • the movement of the autonomous moving device 100 may become unstable, so the target used for the correction may be limited to the reflective material. That is, when the surrounding environment data and the map data do not match, the information of the reflective material included in the surrounding environment data is used for correcting the map data, and the information other than the reflective material contained in the surrounding environment data is the map data. It may be collated and used to correct the current position and orientation of the autonomous mobile device 100.
  • Map data can be corrected. Further, it is possible to improve the accuracy of the subsequent regeneration process by adding a reflective material installed on the wall of the corridor or the like.
  • the control unit 10 sets a pause location P1 and a pause time T1 when following the recognized follow-up object (when controlling the drive unit 40 according to the teaching control data).
  • the autonomous mobile device 100 may be controlled so as to be stored and stopped for the time T1 to be paused at the place P1 where the data is paused when moving according to the stored movement route (during the reproduction process or the reproduction correction process). For example, if there is an automatic shutter on the movement path stored by the autonomous mobile device 100, the location of the automatic shutter is memorized, and the autonomous mobile device 100 is temporarily stopped before the automatic shutter until all the doors are opened. This is because it can be operated more flexibly.
  • the temporary stop place P1 and the temporary stop time T1 may be stored during the follow-up teaching process, or may be performed by editing the teaching data after the follow-up teaching process is completed.
  • control unit 10 outputs a control signal S to a predetermined device when following the recognized tracking object (when controlling the drive unit 40 according to the teaching control data) in the above-mentioned follow-up teaching process.
  • Output location P2 that stores the location P2 (and the pause time T2 if necessary) and outputs a signal to a predetermined device when moving according to the stored movement route (during reproduction processing or reproduction correction processing).
  • the control signal S may be output with, and the predetermined device may be controlled to operate (or not operate).
  • the control unit 10 can store a 4-bit output pattern of 0000 to 1111, it is 0001 as an output pattern of the control signal S1 that disconnects the connection mechanism from the traction pallet or the like connected to the autonomous mobile device 100.
  • 0000 is defined as the output pattern of the control signal S2 that does not disconnect the connection mechanism. Then, by outputting the control signal S1 of the output pattern of 0001 at the predetermined output location P2, the connection mechanism with the traction pallet or the like connected to the autonomous mobile device 100 is disconnected (only the time T2 required for the disconnection). By outputting the control signal S2 of the output pattern of 0000), it is possible to store settings such as not disconnecting the connection mechanism with the traction pallet or the like connected to the autonomous moving device 100. As a result, it is selected whether or not to disconnect the connection mechanism with the traction pallet or the like connected to the autonomous mobile device 100 and leave the luggage at a predetermined place on the movement path stored in the autonomous mobile device 100.
  • the control signal S, the output location P2 for outputting the control signal, and the pause time T2 may be stored during the follow-up teaching process, or the teaching data may be edited after the follow-up teaching process is completed. You may be able to do it.
  • the autonomous mobile device 100 may be provided with an ultraviolet irradiation lamp as a predetermined device. Then, similarly, the "output of the control signal to a predetermined device" can be used for the on / off control of the ultraviolet irradiation lamp.
  • the control signal S can be output at the output location P2 to operate (or stop) the ultraviolet irradiation lamp.
  • the autonomous mobile device 100 may be able to store the condition C for outputting the control signal S instead of the output location P2. That is, in the above-mentioned follow-up teaching process, the condition C for outputting the control signal S to the predetermined device when following the recognized follow-up object (when the drive unit 40 is controlled according to the teaching control data) is stored. , When moving according to the stored movement path (during reproduction processing or reproduction correction processing), if condition C is satisfied, a control signal S is output to a predetermined device to operate (or not operate) the predetermined device. It may be controlled to.
  • the predetermined device may be changed between the time of teaching and the time of reproduction. For example, if you want to irradiate with ultraviolet rays during playback, but do not want to irradiate with ultraviolet rays at the time of teaching (however, you want to check how the ultraviolet irradiation is performed with a pilot lamp etc.), you can use the specified device as " It may be possible to set in a format such as "at the time of teaching: pilot lamp, at the time of reproduction: ultraviolet irradiation lamp".
  • the autonomous mobile device 100 can be configured to stop the ultraviolet irradiation during teaching, confirm the output signal by another pilot lamp or the like, and irradiate the ultraviolet rays during reproduction. As a result, it is possible to irradiate only a specific place with ultraviolet rays, and it is possible to stop the irradiation of ultraviolet rays when a person is in the vicinity.
  • the autonomous mobile device 100 may be able to select a speed mode.
  • a speed mode for example, a teaching speed mode (a mode in which the actual speed at the time of follow-up teaching or maneuvering teaching is memorized and moved at the same speed as at the time of teaching at the time of reproduction) or a set speed mode (the user can use the speed mode).
  • a teaching speed mode a mode in which the actual speed at the time of follow-up teaching or maneuvering teaching is memorized and moved at the same speed as at the time of teaching at the time of reproduction
  • a set speed mode the user can use the speed mode.
  • the control unit 10 can select a speed mode in the above-mentioned follow-up teaching process, and stores the selected speed mode together with the map data.
  • the control unit 10 uses the user when following the recognized follower (when controlling the drive unit 40 according to the teaching control data) in the above-mentioned follow-up teaching process.
  • the control speed set by is memorized and moved according to the movement path (during the reproduction processing or the reproduction correction processing)
  • the autonomous movement device 100 is set so as to move at the memorized control speed when following the recognized follower. You may control it.
  • the teaching speed mode is selected as the speed mode
  • the control unit 10 stores the actual speed when following the following object in the above-mentioned follow-up teaching process, and moves according to the movement path (reproduction).
  • the autonomous moving device 100 may be controlled so as to have the same speed as at the time of teaching.
  • the control unit 10 is set by the speed mode selected by the user or by the user when following the recognized follow-up object (when controlling the drive unit 40 according to the control data for teaching). Even if the drive unit 40 is controlled so as to memorize the control speed and control the movement speed based on the memorized speed mode or the control speed when moving according to the movement path (during the reproduction processing or the reproduction correction processing). good. This makes it possible to operate at a suitable speed during reproduction.
  • the control speed or the speed mode may be stored during the follow-up teaching process, or the teaching data may be edited after the follow-up teaching process is completed. Further, as the control speed, the speed at an arbitrary place on the movement path may be stored.
  • control speed when going straight may store a relatively high speed
  • control speed when turning may store a relatively slow speed
  • a plurality of control speeds may be stored so that different control speeds can be set depending on the conditions.
  • a relatively slow speed may be stored as a control speed when the load is heavier than the reference weight (for example, 10 kg)
  • a relatively high speed may be stored as a control speed when the load is less than the reference weight.
  • the detection unit 31 is above the operation acquisition unit 32, but the installation position of the detection unit 31 is not limited to this.
  • the autonomous mobile device 101 according to the modified example of the first embodiment includes a detection unit 31 below the loading platform 51. As described above, even in the autonomous mobile device 100, the obstacle can be detected only by the detection unit 31, but in the autonomous mobile device 101 according to the modified example, the obstacle can be detected at a lower position, so that the obstacle is relatively small. Even things can be avoided.
  • a dedicated sensor for detecting obstacles may be provided separately from the detection unit 31.
  • a dedicated sensor for detecting an obstacle for example, it is conceivable to install a bumper sensor on the bumper 52. In this case, when the control unit 10 detects that the bumper sensor has come into contact with an obstacle, the control unit 10 can perform processing such as stopping the autonomous moving devices 100 and 101 or retreating a little.
  • each function of the autonomous mobile devices 100 and 101 can also be performed by a computer such as a normal PC (Personal Computer).
  • the programs such as the follow-up teaching process and the reproduction process performed by the autonomous mobile devices 100 and 101 have been described as being stored in the ROM of the storage unit 20 in advance.
  • the program can be a flexible disk, CD-ROM (Compact Disc Read Only Memory), DVD (Digital Versaille Disc), MO (Magnet-Optical Disc), memory card, USB (Universal Serial Computer), etc.
  • a computer capable of realizing the above-mentioned functions may be configured by storing and distributing the program in a recording medium, reading the program into a computer, and installing the program. Further, a computer capable of realizing the above-mentioned functions may be configured by distributing the program via a communication network such as the Internet, reading the program into a computer, and installing the program.
  • Reverse direction data 60ef ... Shaded part, 61 ... people, 62 ... movement paths, 63,64 ... reflective materials, 65,66 ... users, 67,68 ... avoidance paths, 71 ... walls, 72,73,74 ... obstacles, 81,82,83,84 ... Point, 100, 101 ... Autonomous moving device, 311 ... Optical window, 312 ... Laser, 313 ... Rotating axis, 321 ... Lever, 322 ... Touch panel

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)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

自律移動装置（１００）は、周辺の物体を検出する検出部（３１）と、駆動部（４０）と、制御部（１０）と、を備える。制御部（１０）は、教示用制御データを取得し、取得した教示用制御データに従って駆動部（４０）を制御しながら検出部（３１）で検出した点群に基づいて周辺環境の地図データを作成し、作成した地図データ上で移動した移動経路を記憶する。

Description

自律移動装置、自律移動方法及びプログラム
　本発明は、自律移動装置、自律移動方法及びプログラムに関する。
　従来から、工場内の物品搬送や施設内の人の誘導等に移動ロボットが使われている。このような移動ロボットの移動経路を設定する方法として、人が移動ロボットに対して移動経路を教示する方法がある。例えば、特許文献１には、人を検出して、その人を追従して目的地まで到達することにより、スタート地点から目的地までの移動経路を設定している。
特開２００８－８４１３５号公報
　特許文献１に記載の移動ロボットは、人を追従することによって経路を設定することができるが、設定される経路はその時のスタート地点から目的地までの一方通行の経路のみである。この移動ロボットでは、例えば、目的地からスタート地点まで戻るには、再度、人に教示してもらう必要があった。
　本発明は、上記実情に鑑みてなされたものであり、教示された経路を、教示されたときの移動方向の逆の方向でも用いることができる自律移動装置等を提供することを目的とする。
　上記目的を達成するため、本発明の第１の観点に係る自律移動装置は、
　周辺の物体を検出する検出手段と、
　移動手段と、
　制御手段と、
　を備え、
　前記制御手段は、
　教示用制御データを取得し、
　前記取得した教示用制御データに従って前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、
　前記作成した地図データに基づき移動経路を記憶する。
　前記制御手段は、
　前記検出手段で検出した物体の中から追従物を認識し、
　前記認識した追従物を追従するように前記移動手段を制御するためのデータを前記教示用制御データとして取得する、
　ようにしてもよい。
　前記制御手段は、
　前記認識した追従物を追従するように前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、
　前記作成した地図データ上で移動した移動経路を記憶し、
　前記記憶した移動経路に従って移動するように前記移動手段を制御し、
　前記記憶した移動経路には、前記追従物を追従したときの移動方向以外の方向の移動経路が含まれる、
　ようにしてもよい。
　ユーザの操作を取得する操作取得手段をさらに備え、
　前記制御手段は、
　前記操作取得手段で前記教示用制御データを取得する、
　ようにしてもよい。
　前記移動手段は、
　前記取得した教示用制御データに従って前記移動手段を制御する際は、前記自律移動装置を後退させないように制御する、
　ようにしてもよい。
　前記制御手段は、
　教示開始の指示の入力に基づいて第一地点を登録して、前記取得した教示用制御データに従って前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、前記作成した地図データ上で移動した移動経路を記憶し、
　教示終了の指示の入力に基づいて第二地点を登録して教示を終了し、
　前記第一地点から前記第二地点までの移動経路を第一教示ルートとして記録し、
　前記第一教示ルート上に存在する所定の地点から、前記第一地点又は前記第二地点までの移動経路を生成し、
　前記生成した移動経路に従って移動するように前記移動手段を制御する、
　ようにしてもよい。
　前記制御手段は、
　前記第一教示ルートを逆方向に用いることにより、前記第二地点から前記第一地点までの移動経路を生成する、
　ようにしてもよい。
　前記制御手段は、
　前記第一教示ルート上において、教示開始の指示に基づいて第三地点を登録して、前記取得した教示用制御データに従って前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、前記作成した地図データ上で移動した移動経路を記憶し、
　教示終了の指示に基づいて第四地点を登録して教示を終了し、
　前記第三地点から前記第四地点までの移動経路を第二教示ルートとして記録し、
　前記第一教示ルート及び前記第二教示ルートを用いることにより、前記第一教示ルート上又は前記第二教示ルート上に存在する所定の地点から、前記第一地点、前記第二地点、前記第三地点及び前記第四地点から選択された地点までの移動経路を生成する、
　ようにしてもよい。
　前記制御手段は、
　前記教示用制御データに従って前記移動手段を制御したときの移動方向に対して逆方向の移動経路を生成する場合に、
　前記検出手段により検出した物体の位置に関するデータを、当該物体を逆方向から検出した場合のデータに変換し、
　前記変換したデータに基づいて、前記生成した移動経路に従って移動するように前記移動手段を制御する、
　ようにしてもよい。
　前記制御手段は、
　前記検出手段で検出した物体の中から障害物を認識し、
　前記認識した障害物を回避可能であるときは、前記障害物を回避するために前記移動経路から外れ、前記障害物を回避した後に前記移動経路に戻るように前記移動手段を制御する、
　ようにしてもよい。
　前記検出手段は周辺に設置された反射材を検出し、
　前記制御手段は、
　前記教示用制御データに従って前記移動手段を制御している間に前記検出手段で検出した反射材の情報を前記地図データに記録し、
　前記移動経路に従って移動している間に前記検出手段で検出した反射材の情報を前記地図データに記録された反射材の情報と照合することにより前記自律移動装置の位置及び向きを補正する、
　ようにしてもよい。
　前記制御手段は、
　前記移動経路に従って移動している間に前記検出手段で検出した周辺の物体の位置に関するデータを前記地図データと照合して地図データを補正する、
　ようにしてもよい。
　前記制御手段は、
　前記教示用制御データに従って前記移動手段を制御する際に、一時停止する場所と一時停止する時間を記憶して、
　前記記憶した移動経路に従って移動する際に、前記一時停止する場所で前記一時停止する時間だけ停止する、
　ようにしてもよい。
　前記制御手段は、
　前記教示用制御データに従って前記移動手段を制御する際に、所定の機器への制御信号を出力する出力場所を記憶して、
　前記記憶した移動経路に従って移動する際に、前記所定の機器へ前記制御信号を前記出力場所で出力する、
　ようにしてもよい。
　前記制御手段は、
　前記教示用制御データに従って前記移動手段を制御する際に、制御速度もしくは速度モードを記憶して、
　前記記憶した移動経路に従って移動する際に、前記記憶した制御速度もしくは速度モードに基づいて移動速度を制御するように前記移動手段を制御する、
　ようにしてもよい。
　また、本発明の第２の観点に係る自律移動方法は、
　教示用制御データを取得する教示用制御データ取得ステップと、
　前記取得した教示用制御データに従って移動手段を制御しながら検出手段で検出した点群に基づいて周辺環境の地図データを作成する地図作成ステップと、
　前記作成した地図データ上で移動した移動経路を記憶する移動経路記憶ステップと、
　を備える。
　また、本発明の第３の観点に係るプログラムは、
　コンピュータに、
　教示用制御データを取得する教示用制御データ取得ステップ、
　前記取得した教示用制御データに従って移動手段を制御しながら検出手段で検出した点群に基づいて周辺環境の地図データを作成する地図作成ステップ、及び、
　前記作成した地図データ上で移動した移動経路を記憶する移動経路記憶ステップ、
　を実行させる。
　本発明によれば、教示された経路を、教示されたときの移動方向の逆の方向でも用いることができる。
本発明の実施形態１に係る自律移動装置の機能構成を示すブロック図である。 実施形態１に係る自律移動装置の外観を示す図である。 実施形態１に係る自律移動装置が備える検出部の外観及び検出部から照射されるレーザを説明する図である。 実施形態１に係る自律移動装置が備える検出部及び操作取得部を自律移動装置の側面から見た図である。 実施形態１に係る検出部で検出される周辺の環境を説明する図である。 反射材が設置されている例を説明する図である。 正方向の周辺環境データの説明図である。 逆方向の周辺環境データの説明図である。 実施形態１に係る自律移動装置の追従教示処理のフローチャートである。 実施形態１に係る自律移動装置が第１地点から第２地点までの経路や第３地点から第４地点までの経路を教示された場合を説明する図である。 実施形態１に係る自律移動装置の再生処理のフローチャートである。 実施形態１に係る自律移動装置が障害物を回避する様子を説明する図である。 実施形態１に係る自律移動装置の再生補正処理のフローチャートである。 実施形態１の変形例に係る自律移動装置の外観を示す図である。
　以下、本発明の実施形態に係る自律移動装置について、図表を参照して説明する。なお、図中同一又は相当部分には同一符号を付す。
（実施形態１）
　本発明の実施形態に係る自律移動装置は、移動経路について教示を受けて、教示された移動経路に基づいて自律的に移動する装置である。実施形態１に係る自律移動装置１００の機能構成の一例を図１に、外観の一例を図２に示す。
　図１に示すように、自律移動装置１００は、制御部１０と、記憶部２０と、検出部３１と、操作取得部３２と、駆動部４０と、を備える。
　制御部１０は、ＣＰＵ（Ｃｅｎｔｒａｌ　Ｐｒｏｃｅｓｓｉｎｇ　Ｕｎｉｔ）等で構成され、記憶部２０に記憶されたプログラムを実行することにより、後述する各部（周辺情報取得部１１、地図作成部１２、経路生成部１３、周辺情報変換部１４、移動制御部１５）の機能を実現する。また、制御部１０は、時計（図示せず）を備え、現在日時の取得や経過時間のカウントをすることができる。制御部１０は、制御手段として機能する。
　記憶部２０は、ＲＯＭ（Ｒｅａｄ　Ｏｎｌｙ　Ｍｅｍｏｒｙ）、ＲＡＭ（Ｒａｎｄｏｍ　Ａｃｃｅｓｓ　Ｍｅｍｏｒｙ）等で構成され、ＲＯＭの一部又は全部は電気的に書き換え可能なメモリ（フラッシュメモリ等）で構成されている。ＲＯＭには制御部１０のＣＰＵが実行するプログラム及びプログラムを実行する上で予め必要なデータが記憶されている。ＲＡＭには、プログラム実行中に作成されたり変更されたりするデータが記憶される。記憶部２０は、記憶手段として機能する。また、記憶部２０は、機能的構成として、後述する、地点記憶部２１と、地図記憶部２２と、を備える。
　検出部３１は、センシングデバイスとしてのスキャナ式レーザ距離計等で構成され、自律移動装置１００の周辺（本実施形態では左右及び前方）に存在する、人、壁、障害物、反射材等の対象物を点の集まり（点群）として検出する。検出部３１は、図３に示すように、光学窓３１１の内部にある発光部からレーザ３１２を照射し、人、壁、障害物、反射材等の対象物で反射されたレーザを光学窓３１１の内部にある受光部が捉える。また、発光部（及び受光部）は回転軸３１３を中心に２７０度（自律移動装置１００の真正面の方向を０度とすると±１３５度）回転することによってスキャン角度を変えながらレーザ３１２を照射して周囲をスキャンする。反射されたレーザを捉えた受光部からの信号を処理することにより、検出部３１は、スキャン角度毎に、その方向に存在する対象物との距離及び受光強度を計測することができる。なお、上記で発光部の回転角度（スキャン角度）の範囲を「真正面の方向を０度とすると±１３５度」としたのは一例であり、発光部は、例えば±１８０度回転する仕様であってもよいし、±１００度回転する仕様であってもよい。また、スキャン角度は左右対称でなくてもよい。
　検出部３１は、図４に示すように、スキャンの回転軸３１３が鉛直方向に伸びており、レーザ３１２は自律移動装置１００の左右及び前方に存在する対象物（人、壁、障害物、反射材等）を３次元的にスキャンするようになっている。検出部３１は、対象物で反射されたレーザを受光部で受光できれば当該対象物を検出でき、検出部３１から例えば２００ｍ離れた場所にある対象物であっても検出可能である。また、検出部３１で３次元的にスキャンすることにより、対象物の３次元的な形状を検出することができる。検出部３１は、検出手段として機能する。なお、検出部３１の構成はスキャナ式レーザ距離計に限るわけではなく、カメラで構成されてもよいし、距離及び受光強度を計測できるその他のデバイスで構成されてもよい。
　検出部３１は、例えば、図５に示すように、自律移動装置１００の左側に壁７１と反射材６３が、正面に人６１が、右側に障害物７２と反射材６４が、それぞれどのくらいの距離の位置に存在するかを検出する。なお、点線６０は、検出部３１から照射されるレーザの照射範囲の角度（２７０度）を示すものであり、照射距離を示すものではない。レーザは距離的には点線６０を超えた範囲まで照射されており、例えば反射材６３も検出される。ただし、レーザは、点線６０に示すように、自律移動装置１００の後方９０度の角度範囲には照射されていない。
　また、制御部１０は、検出部３１から取得した情報（対象物までの距離、受光強度等）に基づき、検出部３１が検出した対象物を認識する。例えば、制御部１０は、受光強度が所定の基準強度よりも高い等、反射材と認識する条件を満たした場合に対象物が反射材（いわゆる再帰反射材）であると認識する。また、制御部１０は、対象物の幅が人の横幅（例えば３０ｃｍから１ｍ）程度である等、人と認識する条件を満たした場合に対象物が人であると認識する。また、制御部１０は、対象物の幅が所定の基準値よりも長い等、壁と認識する条件を満たした場合に対象物が壁であると認識する。また、制御部１０は、反射材、人、壁等と認識する条件をいずれも満たさない場合は、当該対象物を障害物であると認識する。制御部１０は、検出部３１から取得した情報をもとに初期検出を行い、検出した対象物をトラッキングすることや、検出した対象物を見失った場合に、復帰（ロスト復帰）することで、より多様な対象を安定して検出できる。なお、以上説明した対象物の認識手法は一例であり、他の認識手法を用いてもよい。
　また、検出部３１が検出する対象物の一つである反射材は、再帰反射素材からなり、レーザ光が当たると、そのレーザ光を入射した方向に反射させる。したがって、検出部３１が検出した受光強度が所定の基準強度よりも高い場合に、制御部１０は、そのときの検出部３１でのスキャン角度の方向に反射材が存在することを認識することができる。例えば長い廊下のような特徴量が少ない場所では、廊下を長手方向に移動しても、検出部３１で検出される情報にあまり変化が生じず、長手方向にどれくらい移動したかを制御部１０が認識しにくくなる。このような場合でも、図６に示すように、壁７１に反射材６３を設置することにより、検出される反射材の個数や配置に基づいて、制御部１０は廊下を長手方向にどれくらい移動したかを認識できるようになり、より正確な地図の構築と安定した走行を可能にする。
　なお、反射材６３は、検出部３１から照射されるレーザ光が当たる位置（本実施形態では検出部３１の高度と同程度の高度の位置）に設置される。また、反射材は、再帰反射素材を含む塗料を壁等に塗布したり、再帰反射素材を含む粘着テープを壁等に貼り付けたり、再帰反射素材を含むロープ等（通常のロープ等に再帰反射素材を含む塗料を塗布したり、再帰反射素材を含む粘着テープを巻いたりして作成してもよい）を空中にぶら下げたりして設置することができる。
　図１に戻り、操作取得部３２は、入力デバイスとしてのジョイスティック等で構成され、ユーザの操作を取得する。操作取得部３２は、操作取得手段として機能する。図４に示すように、操作取得部３２は、レバー３２１と、表示パネルと一体化したタッチパネル３２２と、を備える。そしてユーザは、レバー３２１を倒す方向で進行方向を、倒す量（倒し角）で移動速度を、それぞれ自律移動装置１００に指示することができる。また、タッチパネル３２２には、ユーザの指示を受け付けるＵＩ（Ｕｓｅｒ　Ｉｎｔｅｒｆａｃｅ）としての操作メニュー（最大速度、加速度等の設定や当該設定値の選択、目的地の指定、移動停止指示、教示、再生、再生補正、逆再生、自動判定再生、ループ再生等の開始及び終了の指示、動作モード（自律移動モード、マニュアル移動モード等）の選択等を行うメニュー）が表示され、ユーザはそれらにタッチすることによって、自律移動装置１００に各指示を与えることができる。操作取得部３２は、操作取得手段として機能する。
　なお、操作取得部３２は、タッチパネルではなく、物理ボタンで教示開始、教示終了、再生開始／終了、再生補正開始／終了、逆再生開始／終了、もしくは自動判定再生開始／終了、ループ再生開始／終了などを指示可能な操作取得部にしても良い。物理ボタンは、屋外の作業現場などでは視認性が高く、利便性が向上する。なお、逆再生とは、教示されて最終的に得られた教示データを逆向きに用いて再生することにより、自律移動装置１００を教示終了地点から教示開始地点に戻すような移動をさせる再生処理である。また、自動判定再生とは、自己位置を認識させるために行う再生処理である。また、ループ再生とは、教示されたデータを繰り返し再生することにより、教示開始地点から教示終了地点までの移動を繰り返し行う再生処理である（ループ再生を正常に行うには教示終了地点が教示開始地点になるように教示する必要がある）。
　また、教示には、追従物を追従させることによって教示する追従教示だけでなく、操作取得部３２のジョイスティック等で自律移動装置１００を手動操縦することによって教示する操縦教示がある。ユーザは、追従教示と操縦教示のどちらの教示を行うかについても、操作取得部３２で指示することができる。以降では、主に追従教示の処理について説明するが、追従教示と操縦教示とは、教示用制御データを追従物の追従によって取得するのか、操作取得部３２で取得するのかが異なるだけであるため、本発明は、追従教示だけでなく、操縦教示を含むその他の任意の動作による教示（手押し、外部システムからの入力等）にも適用可能である。
　図１に戻り、駆動部４０は、制御部１０からの指示（制御）により自律移動装置１００を移動させる。駆動部４０は、移動手段として機能する。図２に示すように、駆動部４０は、独立２輪駆動の車輪４１とモータ４２とキャスター４３とを備える。自律移動装置１００は、２つの車輪４１の同一方向駆動により前後の平行移動（並進移動）を、２つの車輪４１の逆方向駆動によりその場での回転（向き変更）を、２つの車輪４１のそれぞれ速度を変えた駆動により旋回移動（並進＋回転（向き変更）移動）を、行うことができる。また、各々の車輪４１にはロータリエンコーダが備えられており、制御部１０は、ロータリエンコーダで計測した車輪４１の回転数と、車輪４１の直径や車輪４１間の距離等とを用いることによって並進移動量及び回転量を計算できる。
　例えば、車輪４１の直径をＤ、回転数をＣとすると、その車輪４１の接地部分での並進移動量はπ・Ｄ・Ｃとなる。また、車輪４１の直径をＤ、車輪４１間の距離をＩ、右の車輪４１の回転数をＣＲ、左の車輪４１の回転数をＣＬとすると、向き変更の回転量は（右回転を正とすると）３６０°×Ｄ×（ＣＬ－ＣＲ）／（２×Ｉ）となる。この並進移動量及び回転量をそれぞれ逐次足し合わせていくことで、駆動部４０はメカオドメトリとしても機能し、制御部１０は、自律移動装置１００の位置（移動開始時の位置及び向きを基準とした位置及び向き）を把握することができる。
　なお、車輪４１の代わりにクローラを備えるようにしても良いし、複数（例えば二本）の足を備えて足で歩行することによって移動を行うようにしても良い。これらの場合も、二つのクローラの動き、足の動き等に基づいて、車輪４１の場合と同様に自律移動装置１００の位置及び向きの計測が可能である。
　また、図２に示すように、自律移動装置１００は、荷台５１を備え、搬送物品等を荷台５１に搭載して目的地に運ぶことができる。また、自律移動装置１００は、バンパー５２を備え、他の物体に衝突した時に停止し、衝撃を和らげることができる。
　次に、自律移動装置１００の制御部１０の機能的構成について説明する。図１に示すように、制御部１０は、周辺情報取得部１１、地図作成部１２、経路生成部１３、周辺情報変換部１４、移動制御部１５、としてそれぞれ機能し、自律移動装置１００の移動制御等を行う。
　周辺情報取得部１１は、検出部３１が検出した物体を認識し、当該物体の情報として、種類（人、障害物、反射材等の種別）、距離、方向等を取得する。また、操作取得部３２に教示開始の指示が入力されると、前方に存在する人を追従物として認識する。
　地図作成部１２は、検出部３１で検出した点群のデータ（例えば、周辺の物体（壁、障害物、反射材等）の位置（距離、方向等）等の存在状況を示す周辺環境データ）に基づいて自律移動装置１００の周辺環境の地図データを作成する。地図データのデータ形式は任意である。地図作成部１２は、検出部３１で検出したデータを用いて、例えば、ＳＬＡＭ（Ｓｉｍｕｌｔａｎｅｏｕｓ　Ｌｏｃａｌｉｚａｔｉｏｎ　Ａｎｄ　Ｍａｐｐｉｎｇ）により地図データを作成してもよい。また、地図作成部１２は、自律移動装置１００が所定の距離（例えば１０ｃｍ）移動するたびに、検出部３１で検出したデータ（周辺の物体の存在状況を示す周辺環境データ）を、自律移動装置１００の現在の位置（自己位置）の情報と共に後述する地図記憶部２２に記録していくことによって、地図データを構成してもよい。また、地図作成部１２は、自律移動装置１００の現在の位置（自己位置）の情報については、駆動部４０から得られるメカオドメトリの値を用いて取得してもよい。
　経路生成部１３は、目的地が与えられると、地図記憶部２２に記録されている地図データに基づき、自律移動装置１００の現在の位置から与えられた目的地までの移動経路を生成する。この移動経路の生成手法は任意である。例えば、自律移動装置１００の現在の位置が過去の追従教示処理において教示開始を指示された位置であり、目的地がその過去に教示終了を指示された位置であるなら、経路生成部１３は、その過去に追従物を追従したときの経路（教示ルート）を移動経路として生成してもよい。この場合、経路生成部１３は、地図記憶部２２に記録されている地図データ上で移動した経路を移動経路として記憶することになる。また、教示ルートは追従物を追従した時の経路に限られず、例えば、操作取得部３２により手動操縦することによって移動した経路を、教示ルートとしても良い。
　周辺情報変換部１４は、地図記憶部２２に記録されている周辺の物体の情報（周辺環境データ）を、逆方向からのデータに変換する。周辺情報変換部１４によるデータの変換について図７Ａ及び図７Ｂを用いて説明する。地図記憶部２２には、まず図７Ａに示すような正方向の周辺環境データが記録される。そして、逆方向からのデータとは、自律移動装置１００の向きを、当該周辺の物体を検出部３１で検出したときの向きとは逆にしたときに、検出部３１で検出されるはずの周辺環境データである（図７Ｂに示す周辺環境データ）。このデータは元のデータ（図７Ａに示す周辺環境データ）の前後左右を逆にする（前方に観測された物体が後方に観測されるように、また、左側に観測された物体が右側に観測されるようにする）ことによって得られる。
　移動制御部１５は、駆動部４０を制御して、自律移動装置１００を移動させる。例えば、操作取得部３２に教示開始の指示が入力されてから教示終了の指示が入力されるまでの間は、移動制御部１５は、追従物を追従するように駆動部４０を制御する。また、操作取得部３２に再生開始の指示が入力されると、移動制御部１５は、経路生成部１３が生成した移動経路にしたがって移動するように、駆動部４０を制御する。また、移動制御部１５は、動作モードがマニュアル移動モードの場合は、操作取得部３２で取得されるユーザからの指示に基づいて駆動部４０を制御する。
　次に、記憶部２０の機能的構成について説明する。記憶部２０は、地点記憶部２１と、地図記憶部２２と、を備える。
　地点記憶部２１には、操作取得部３２で取得されたユーザの操作に基づいて、自律移動装置１００の位置（例えば、移動開始位置や移動終了位置（目的地）等）を判定するためのデータが登録される。例えば、操作取得部３２に教示開始の指示が入力されると、自律移動装置１００のその時点での位置及び方向で検出部３１から検出される周辺環境データが、教示開始地点（第一地点）における地点データ（第一地点データ）として地点記憶部２１に登録される。
　地図記憶部２２には、検出部３１で検出された周辺環境データに基づいて地図作成部１２で作成された地図データが記録される。また、後述する追従教示処理において、追従物を追従した時の経路（教示ルート）も、地図記憶部２２に記憶される。
　次に、自律移動装置１００の追従教示処理について、図８を参照して説明する。なお、自律移動装置１００が起動すると、この追従教示処理、後述する再生処理及び再生補正処理等が、それぞれ並列に開始され、操作取得部３２からユーザの指示が入力されるのを待機している状態になる。
　まず、制御部１０は、操作取得部３２から、教示開始の指示が入力されたか否かを判定する（ステップＳ１０１）。教示開始の指示が入力されなければ（ステップＳ１０１；Ｎｏ）、ステップＳ１０１に戻る。教示開始の指示が入力されたら（ステップＳ１０１；Ｙｅｓ）、制御部１０は、検出部３１で検出された周辺環境データを教示開始地点（第一地点）における地点データ（第一地点データ）として地点記憶部２１に登録する（ステップＳ１０２）。なお、既に地図記憶部２２に地図データが記録されていた場合には、制御部１０は、教示開始地点が地図データ上のどの位置に対応するかを把握する。
　そして、周辺情報取得部１１は、検出部３１により、自律移動装置１００の前方に存在するユーザを追従物として認識する（ステップＳ１０３）。ステップＳ１０３は、追従物認識ステップとも呼ばれる。なお、ステップＳ１０２とステップＳ１０３は、この順番に実行しなければいけないわけではなく、例えば、ステップＳ１０３を実行してからステップＳ１０２を実行してもよい。また、操縦教示を行う場合には、ステップＳ１０３の処理は不要である。
　次に、制御部１０は周辺情報取得部１１に認識された追従物を追従するように駆動部４０を制御するためのデータを教示用制御データとして取得し、移動制御部１５が当該教示用制御データに従って駆動部４０を制御しながら、地図作成部１２が自律移動装置１００の周辺環境の地図データを作成し（ステップＳ１０４）、地図データを地図記憶部２２に記録する。なお、操縦教示の場合は、制御部１０は、駆動部４０を制御するための教示用制御データを操作取得部３２から取得する。ステップＳ１０４の処理のうち、制御部１０が教示用制御データを取得する処理は教示用制御データ取得ステップと呼ばれ、地図作成部１２が地図データを作成する処理は地図作成ステップと呼ばれる。なお、周辺情報取得部１１で反射材が認識された場合は、地図作成部１２は、当該反射材の位置や個数の情報も地図データに含めて地図記憶部２２に記録する。
　長い廊下等のように、特徴量が少ない場所においても、反射材をところどころに設置（壁に貼る等）することにより、地図記憶部２２に反射材の存在する場所や個数の情報が記録される。これにより、後述する再生処理の際に、制御部１０は、反射材の位置や個数の情報とのマッチングを取り、自律移動装置１００の自己位置をより正確に把握することができる。
　また、ステップＳ１０４では、経路生成部１３は、追従物を追従したときの経路自体を教示ルートとして地図記憶部２２に記録する。この処理は移動経路記憶ステップと呼ばれる。そして、ステップＳ１０４では、移動制御部１５は、追従物が後退しても自律移動装置１００は後退しない（例えば停止する）ように駆動部４０を制御する。すなわち、追従物を追従している間は、移動制御部１５は、駆動部４０に対して後退を指示しないようにする。後述する再生処理の際、移動経路として用いた教示ルートに後退処理が含まれていると、移動処理が複雑になる可能性があるからである。したがって、追従教示の場合だけでなく、操縦教示の場合においても、移動制御部１５は、自律移動装置１００を後退させないように駆動部４０を制御してもよい。
　そして、制御部１０は、操作取得部３２から、教示終了の指示が入力されたか否かを判定する（ステップＳ１０５）。教示終了の指示が入力されなければ（ステップＳ１０５；Ｎｏ）、ステップＳ１０４に戻る。教示終了の指示が入力されたら（ステップＳ１０５；Ｙｅｓ）、制御部１０は、検出部３１で検出された周辺環境データを教示終了地点（第二地点）における地点データ（第二地点データ）として地点記憶部２１に登録し（ステップＳ１０６）、ステップＳ１０１に戻る。
　以上、追従教示処理について説明した。この追従教示処理によって最終的な教示データ（教示ルートに従って教示開始地点から教示終了地点まで移動するように自律移動装置１００を制御するためのデータ）が、作成される。なお、上では教示開始地点を第一地点、教示終了地点を第二地点と記載したが、これは、地点記憶部２１にこれらの地点が最初に登録された場合の話である。例えば、地点記憶部２１に第一地点及び第二地点が登録された後にステップＳ１０１に戻り、さらに教示開始の指示が入力された場合は、教示開始地点は第三地点として、教示終了地点は第四地点として、それぞれ地点記憶部２１に登録される。このように、教示開始の指示が入力された地点と教示終了の指示が入力された地点とは、累積的に地点記憶部２１に登録されていく。
　追従教示処理の一例について、図９を参照して説明する。最初に自律移動装置１００が第一地点８１の位置で、ユーザ６５から教示開始の指示を受けたものとする（ステップＳ１０１）。すると、制御部１０は、検出部３１で検出された周辺環境データ６０ａを第一地点データとして、地点記憶部２１に登録する（ステップＳ１０２）。そして、周辺情報取得部１１は、ユーザ６５を追従物として認識する（ステップＳ１０３）。
　その後ユーザ６５が第二地点８２まで歩いていくと、自律移動装置１００もユーザ６５に追従して第二地点８２まで移動するが、移動中に地図作成部１２は、検出部３１で検出されたデータ（例えば、周辺環境データ６０ｂ、６０ｃ、６０ｄ）に基づいて周辺環境の地図データを作成し（ステップＳ１０４）、作成した地図データを地図記憶部２２に記録する。
　そして、ユーザ６５が第二地点８２で教示終了の指示を操作取得部３２に入力すると（ステップＳ１０５）、制御部１０は、検出部３１で検出された周辺環境データ６０ｅを第二地点データとして、地点記憶部２１に登録する（ステップＳ１０５）。また、制御部１０は、第一地点８１から第二地点８２までの経路（第一教示ルート）も地図記憶部２２に記録する。
　その後、自律移動装置１００が第三地点８３の位置で第四地点８４の方向を向いている状態で、ユーザ６６から教示開始の指示を受けたものとする（ステップＳ１０１）。すると、制御部１０は、検出部３１で検出された周辺環境データ６０ｈを第三地点データとして、地点記憶部２１に登録する（ステップＳ１０２）。そして、周辺情報取得部１１は、ユーザ６６を追従物として認識する（ステップＳ１０３）。
　その後ユーザ６６が第四地点８４まで歩いていくと、自律移動装置１００もユーザ６６に追従して第四地点８４まで移動するが、移動中に地図作成部１２は、検出部３１で検出されたデータ（例えば、周辺環境データ６０ｉ）に基づいて周辺環境の地図データを作成し（ステップＳ１０４）、作成した地図データを地図記憶部２２に記録する。
　そして、ユーザ６６が第四地点８４で教示終了の指示を操作取得部３２に入力すると（ステップＳ１０５）、制御部１０は、検出部３１で検出された周辺環境データ６０ｊを第四地点データとして、地点記憶部２１に登録する（ステップＳ１０５）。また、制御部１０は、第三地点８３から第四地点８４までの経路（第二教示ルート）も地図記憶部２２に記録する。
　このようにして、地点記憶部２１には各地点の地点データが登録され、地図記憶部２２には地図データや教示ルートが記録されていく。
　次に、自律移動装置１００の再生処理について、図１０を参照して説明する。上述したように、この再生処理も、自律移動装置１００が起動すると実行が開始され、操作取得部３２からユーザの指示が入力されるのを待機している状態になる。
　まず、制御部１０は、操作取得部３２から、再生開始の指示が入力されたか否かを判定する（ステップＳ２０１）。再生開始の指示が入力されなければ（ステップS２０１；Ｎｏ）、ステップＳ２０１に戻る。再生開始の指示が入力されたら（ステップＳ２０１；Ｙｅｓ）、制御部１０は、自律移動装置１００の現在地を取得可能か判定する（ステップＳ２０２）。
　ここで、現在地の取得方法は任意である。例えば、制御部１０は、ＳＬＡＭを用いて自律移動装置１００の現在地を取得してもよい。また、制御部１０は、検出部３１で取得されるデータを地点記憶部２１に登録されている各地点のデータと照合することによって現在地を取得してもよい。検出部３１で取得されるデータを地点記憶部２１に登録されている各地点のデータと照合することによって現在地を取得する方法について、以下に補足説明する。
　検出部３１で取得されるデータの角度範囲は、自律移動装置１００がどの方向を向いていても、ある程度の重複が生じるので、重複する部分についてマッチングを行うことにより、現在地が地点記憶部２１に登録されている地点であるか否か、及び、登録されている地点であるなら、そのうちのどの地点なのかを判定できる。例えば、検出部３１が角度範囲２７０度のデータを取得しており、自律移動装置１００の現在位置が第二地点８２である場合を想定する。
　この場合、図９に示すように、第二地点８２に位置する自律移動装置１００が、第一地点８１とは反対の方向を向いている時に検出部３１で検出されるデータは周辺環境データ６０ｅであり、第一地点の方向を向いている時に検出部３１で検出されるデータは周辺環境データ６０ｆであり、両者の間には網掛け部分６０ｅｆに示すように重複部分がある。したがって、周辺環境データ同士を照合する際には、例えば一方の周辺環境データを少しずつ回転させながら照合させていき、半分以上（１８０度分以上）がマッチングしたら、同一の地点から得られた周辺環境データであると推定することができる。
　このようにして、制御部１０は、検出部３１で検出された周辺環境データを地点記憶部２１に登録されている各地点のデータと照合することによって、現在地が地点記憶部２１に登録されている地点のうちのどの地点なのかを取得することができる。なお、もし地点記憶部２１に登録されているどの地点ともマッチングしない場合には、現在地の取得は不可能となり、ステップＳ２０２での判定はＮｏとなる。
　図１０のステップＳ２０２に戻り、制御部１０が自律移動装置１００の現在地を取得可能でなければ（ステップＳ２０２；Ｎｏ）、ステップＳ２０１に戻る。現在地を取得可能なら（ステップＳ２０２；Ｙｅｓ）、制御部１０は現在地を取得する（ステップＳ２０３）。
　そして、経路生成部１３は自律移動装置１００の現在地から目的地までの移動経路を生成する（ステップＳ２０４）。ステップＳ２０４は、移動経路生成ステップとも呼ばれる。ここで、目的地としては、地点記憶部２１に登録されている任意の地点を選択可能である。もし、地点記憶部２１に２つの地点しか登録されておらず、その２つの地点のうちの一方が現在地であるなら、目的地は現在地ではないもう一方の地点となる。それ以外の場合は、登録されている地点（ただし現在地を除く）の中のどの地点を目的地とするかをユーザに操作取得部３２から入力してもらうことになる。
　そして、経路生成部１３は、地図記憶部２２に記録されている地図データに基づき、現在地から目的地までの移動経路を生成する。この移動経路の生成手法は任意である。経路生成部１３は、地図データから得られる自律移動装置１００が移動可能なパスを用いて現在地から目的地までの最短経路を生成してもよいし、追従教示処理の際に記録した教示ルートに基づいて移動経路を生成してもよい。また、例えば、現在地が教示終了地点で目的地が教示開始地点である場合は、経路生成部１３は、追従教示処理の際に記録した教示ルートを逆向きに辿るルートを移動経路として生成してもよい。以下では、経路生成部１３が、教示ルート及び教示ルートを逆向きに辿るルートを用いて移動経路を生成するものとして説明する。
　そして、経路生成部１３が追従教示処理の際に記録した教示ルートを逆向きに辿るルートを移動経路として生成する場合、周辺情報変換部１４は、地図記憶部２２に記憶されている教示ルートに関係した地図データのうち、検出部３１で検出された周辺環境データを、当該周辺環境を逆方向から検出した場合のデータ（逆方向データ）に変換して地図記憶部２２に記録する。この逆方向データにより、自律移動装置１００は容易に教示ルートを逆向きに辿ることができるようになる。
　ステップＳ２０４で経路生成部１３により移動経路が生成されたら、移動制御部１５は、その移動経路に従って移動するように駆動部４０を制御する（ステップＳ２０５）。ステップＳ２０５は、経路移動ステップとも呼ばれる。この移動中、制御部１０は検出部３１で検出された周辺環境データと地図記憶部２２に記録されている地図データとを用いて、自律移動装置１００の現在の位置及び向きを把握する。
　なお、地図データに反射材の配置や個数の情報が記録されている場合は、制御部１０は、自律移動装置１００の現在の位置及び向きを把握する際に、周辺情報取得部１１で認識された反射材の情報（反射材の位置や個数）を優先して地図データとマッチングさせる。もし、反射材の情報がマッチングしない（例えば反射材の個数が異なる）状態が所定の時間（例えば１０秒間）や所定の移動距離（例えば１０ｍ）続いた場合には、制御部１０は、自律移動装置１００を停止させてもよい。反射材は、他の通常の物体と比較して、検出部３１でその位置や個数を精度良く認識でき、マッチングしない状態が所定の時間や移動距離の間続いたということは、自律移動装置１００が本来の経路から外れている可能性が高いことを意味するからである。
　そして制御部１０は、検出部３１で検出された周辺環境データを用いて進行方向に障害物があるか否かを判定する（ステップＳ２０６）。進行方向に障害物がないと判定したら（ステップＳ２０６；Ｎｏ）、制御部１０は、検出部３１で検出された周辺環境データを地点記憶部２１に登録されている地点データと照合することによって、自律移動装置１００が目的地に到着したか否かを判定する（ステップＳ２０７）。この判定は、上述したステップＳ２０３での現在地取得と同様にして取得した現在地が目的地と同一かどうかを判定することによって行うことができる。
　目的地に到着していなければ（ステップＳ２０７；Ｎｏ）、ステップＳ２０５に戻る。目的地に到着したら（ステップＳ２０７；Ｙｅｓ）、移動制御部１５は駆動部４０を停止させ（ステップＳ２０８）、ステップＳ２０１に戻る。
　一方、ステップＳ２０６において、進行方向に障害物が存在すると判定したら（ステップＳ２０６；Ｙｅｓ）、制御部１０は、その障害物を回避可能か否かを判定する（ステップＳ２０９）。本実施形態では、次の２つの条件を満たせば、制御部１０は、障害物を回避可能と判定する。
（１）制御部１０が自律移動装置１００の現在の位置（自己位置）を見失わない（例えば検出部３１で検出される周辺環境データを地図記憶部２２に記録されている地図データと照合することにより自己位置を把握できる）範囲で障害物を回避できる。
（２）障害物と障害物又は壁との間に自律移動装置１００が通り抜けられるだけの幅が存在する。
　制御部１０が障害物を回避可能と判定したら（ステップＳ２０９；Ｙｅｓ）、移動制御部１５が当該障害物を回避するように駆動部４０を制御することにより、障害物を回避して移動する（ステップＳ２１０）。そして、再度、制御部１０は検出部３１で検出されるデータを用いて、進行方向に障害物があるか否かを判定する（ステップＳ２１１）。障害物があるなら（ステップＳ２１１；Ｙｅｓ）、ステップＳ２０９に戻る。
　障害物がないなら（ステップＳ２１１；Ｎｏ）、元の移動経路に戻るように移動制御部１５が駆動部４０を制御することにより、元の移動経路に復帰し（ステップＳ２１２）、ステップＳ２０５に戻る。上述したように、障害物の回避は自律移動装置１００の現在の位置を見失わない範囲で行われるため、移動制御部１５が現在の位置と元の移動経路との位置のずれを小さくするように駆動部４０を制御して移動することにより、自律移動装置１００は元の移動経路に復帰することができる。
　一方、ステップＳ２０９で、制御部１０が障害物を回避不可能と判定したら（ステップＳ２０９；Ｎｏ）、移動制御部１５は駆動部４０を停止させる（ステップＳ２１３）。そして、制御部１０は、操作取得部３２からユーザの指示が入力されたか否かを判定する（ステップＳ２１４）。ユーザの指示が入力されていなければ（ステップＳ２１４；Ｎｏ）、ステップＳ２１１に進む。時間の経過により、障害物が取り払われている可能性があるからである。
　ユーザの指示が入力されたら（ステップＳ２１４；Ｙｅｓ）、制御部１０は、ユーザの指示に従い（ステップＳ２１５）、ステップＳ２１１に進む。ステップＳ２１５では、例えば、ユーザの指示により、自律移動装置１００が障害物のない場所や障害物を回避可能な場所に移動することが想定される。
　上述の再生処理における障害物回避について図１１を参照して補足説明する。例えば、自律移動装置１００が第一地点８１から第二地点８２に移動中に、障害物７３及び障害物７４を検出した場合を想定する。この場合、図１１に示すように、これらの障害物を回避するには進行方向を少し右にずらす（元々の移動経路６２の代わりに回避経路６７を移動する）必要がある。そして、元々の移動経路６２を移動する際に検出部３１で検出される周辺環境データ６０ｂ，６０ｃと、回避経路６７を移動する際に検出部３１で検出される周辺環境データ６０ｍとの間での差異は小さく、制御部１０が自律移動装置１００の自己位置を見失うことはないと考えられる。また、図１１に示すように、障害物７３と障害物７４との間には、自律移動装置１００が通り抜けられるだけの幅が存在する。したがって、この場合は、制御部１０は障害物を回避可能と判定する。
　次の例として、障害物７３が図１１に示す回避経路６７よりも右までせり出している等、回避経路６８を移動しないと障害物７３を回避できない場合を想定する。この場合、元々の移動経路６２を移動する際に検出部３１で検出される周辺環境データ６０ｂ，６０ｃと、回避経路６８を移動する際に検出部３１で検出される周辺環境データ６０ｎとの間での差異が大きく、制御部１０が自律移動装置１００の自己位置を見失う可能性が高いので、制御部１０は、障害物を回避不可能と判定する。
　また、制御部１０が自律移動装置１００の自己位置を見失わない範囲で障害物７３を回避できる場合でも、障害物７４がもっと障害物７３に近い場所にある等、障害物７３と障害物７４との間に自律移動装置１００が通り抜けられるだけの幅が存在しない場合は、制御部１０は、障害物を回避不可能と判定する。
　以上、再生処理について説明した。再生処理の一例について、図９を参照して説明する。まず、事前に上述の追従教示処理によって、自律移動装置１００が第一地点８１から第二地点８２までユーザを追従して、教示が行われているものとする。そしてこの追従教示処理の結果、第一地点データと第二地点データが地点記憶部２１に登録され、第一地点８１から第二地点８２までの経路（第一教示ルート）やその間の周辺環境データが地図記憶部２２に記録されているものとする。
　そして、自律移動装置１００が、第一地点８１の方向を向いた状態で第二地点８２に位置している状態で、ユーザから再生開始の指示を受けたものとする（ステップＳ２０１）。すると、制御部１０は、自律移動装置１００の現在地を取得可能か判定する（ステップＳ２０２）。この例では、制御部１０は、検出部３１で検出された周辺環境データ６０ｆを、地点記憶部２１に登録されている第一地点データ（周辺環境データ６０ａ）及び第二地点データ（周辺環境データ６０ｅ）と照合する。
　すると、周辺環境データ６０ｆと周辺環境データ６０ｅとは、上述したように図９の網掛け部分６０ｅｆに示す部分においてマッチングが取れるため、制御部１０は、現在地が第二地点８２であると判定できる。したがって、ステップＳ２０２での判定はＹｅｓとなり、制御部１０は現在地が第二地点８２であることを取得する（ステップＳ２０３）。
　そして、経路生成部１３は現在地から目的地までの移動経路を生成する（ステップＳ２０４）。この例では、地点記憶部２１には第一地点データと第二地点データしか登録されておらず、現在地は第二地点８２なので、目的地として第一地点８１が設定される。そして、経路生成部１３は、第二地点８２から第一地点８１までの移動経路として、追従教示処理の際に地図記憶部２２に記録した第一教示ルートを逆向きに辿るルートを生成する。
　そして、周辺情報変換部１４は、地図記憶部２２に記憶されているデータのうち、ユーザを追従した際に検出部３１で検出された周辺環境データ６０ａ，６０ｂ，６０ｃ，６０ｄを、当該周辺環境を逆方向から検出した場合のデータに変換して逆方向データ（逆方向データ６０ａ’，６０ｂ’，６０ｃ’，６０ｄ’）を生成し、地図記憶部２２に記録する。
　なお、本実施形態では検出部３１は２７０度の角度範囲で周辺環境を検出するので、後方の９０度の角度範囲のデータは検出できない。したがって、図９に示すように、周辺環境を逆方向から検出した場合のデータに変換すると、前方の９０度の範囲のデータは生成できず、逆方向データ６０ａ’，６０ｂ’，６０ｃ’，６０ｄ’は、左右それぞれ９０度の角度範囲のデータとなる。このようなデータでも、上述したステップＳ２０３での現在地取得で説明したように、検出部３１で検出した周辺環境データとマッチングを取ることが可能である。もちろん、検出部３１として３６０度の角度範囲で周辺環境を検出できるデバイスを用いれば、追従時の周辺環境データを、３６０度の角度範囲の逆方向データに変換可能である。
　また、自律移動装置１００は移動することにより、様々な場所及び方向から検出部３１で周辺環境を検出することができる。このため、検出部３１が検出可能な角度範囲が（例えば１８０度以下に）限定されていても、複数を用いる等することで、様々な場所及び方向から検出した周辺環境を統合することによって、図７Ａに示すような正方向の周辺環境データを取得することができ、周辺情報変換部１４は、この正方向の周辺環境データを逆方向の周辺環境データに変換することができる。なお、検出部３１が、３Ｄデータを取得可能なデバイスであった場合でも同様に変換可能である。
　そして、制御部１０は検出部３１で検出される周辺環境データと周辺情報変換部１４で生成した逆方向データ（例えば逆方向データ６０ａ’，６０ｂ’，６０ｃ’，６０ｄ’）とを照合して自律移動装置１００の現在の位置及び向きを把握しつつ、移動制御部１５は移動経路に従って移動するように駆動部４０を制御する（ステップＳ２０５）。図９の例では障害物はないのでステップＳ２０６での判定はＮｏとなり、自律移動装置１００が目的地（第一地点８１）に到着するまで移動経路に従って移動を続け、目的地（第一地点８１）に到着したら（ステップＳ２０７；Ｙｅｓ）、停止する（ステップＳ２０８）。
　このようにして、自律移動装置１００は、教示された経路を、教示されたときの移動方向以外の方向（上述の例では逆方向）で用いて移動することができる。これにより、自律移動装置１００は、より柔軟な経路生成と運用を可能にする。
　なお、自律移動装置１００が、第一地点８１とは反対方向を向いた状態で第二地点８２に位置している状態で、ユーザから再生開始の指示を受けた場合は、制御部１０は、検出部３１で検出された周辺環境データ６０ｅを、地点記憶部２１に登録されている第一地点データ（周辺環境データ６０ａ）及び第二地点データ（周辺環境データ６０ｅ）と照合することにより、自律移動装置１００の現在の位置が第二地点８２であり、自律移動装置１００が第一地点８１とは反対方向を向いていることを把握する。この場合は、移動制御部１５は自律移動装置１００の向きを反対方向にするように駆動部４０を制御してから、上述のようにして、第一地点８１に移動することになる。
　また、その後、上述の追従教示処理によって、自律移動装置１００が第三地点８３から第四地点８４までユーザを追従して、教示が行われたものとする。すると、この追従教示処理の結果、地点記憶部２１には、第一地点データと第二地点データ以外に第三地点データと第四地点データも登録される。そして、第三地点８３から第四地点８４までの経路（第二教示ルート）やその間の周辺環境データも地図記憶部２２に記録される。また、第三地点８３は、最初に教示を受けた第一地点８１から第二地点８２までの経路（第一教示ルート）上に存在するので、制御部１０は、第三地点８３が地図記憶部２２に記録されている第一教示ルート上に存在する地点であることを把握する。
　そして、自律移動装置１００が、第三地点８３の方向を向いた状態で第四地点８４に位置している状態で、ユーザから再生開始の指示を受けたものとする（ステップＳ２０１）。すると、上述の第二地点８２から再生を開始した時と同様に、制御部１０は、検出部３１で検出された周辺環境データ６０ｋを、地点記憶部２１に登録されている第一地点データ（周辺環境データ６０ａ）、第二地点データ（周辺環境データ６０ｅ）、第三地点データ（周辺環境データ６０ｈ）及び第四地点データ（周辺環境データ６０ｊ）と照合する。
　すると、周辺環境データ６０ｋと周辺環境データ６０ｊとは、上述したように左右それぞれ９０度の角度範囲においてマッチングが取れるため、制御部１０は、現在地が第四地点８４であると判定できる。したがって、ステップＳ２０２での判定はＹｅｓとなり、制御部１０は現在地が第四地点８４であることを取得する（ステップＳ２０３）。
　そして、経路生成部１３は現在地から目的地までの移動経路を生成する（ステップＳ２０４）。この例では、地点記憶部２１には第一地点データ、第二地点データ、第三地点データ及び第四地点データが登録されており、現在地は第四地点８４なので、目的地を第一地点８１、第二地点８２、第三地点８３のいずれにするか、ユーザに指示を求め、ユーザに操作取得部３２から目的地を入力してもらう。ここでは、ユーザが目的地として第二地点８２を指定したものとする。
　すると、経路生成部１３は、第四地点８４から第二地点８２までの移動経路として、追従教示処理の際に地図記憶部２２に記録された第二教示ルートを逆向きに辿って第三地点８３に到達した後に、地図記憶部２２に記録された第一教示ルートの途中から追従した時の方向に第二地点８２まで辿るルートを生成する。なお、上述の教示再生処理で第三地点８３が地点記憶部２１に登録される際に、制御部１０は第三地点８３が第一教示ルート上の地点であることを把握しているため、第二教示ルートが第三地点８３で第一教示ルートと接続していることを認識できる。このようにして、経路生成部１３は、それまでに記録した教示ルートを任意に接続した移動経路を生成することができる。
　そして、周辺情報変換部１４は、地図記憶部２２に記憶されている地図データのうち、第二教示ルートでユーザを追従した際に検出部３１で検出された周辺環境データ６０ｈ，６０ｉを、当該周辺環境を逆方向から検出した場合のデータに変換して逆方向データ（逆方向データ６０ｈ’，６０ｉ’）を生成し、地図記憶部２２に記録する。
　そして、制御部１０は自律移動装置１００の現在の位置及び向きを把握しつつ、移動制御部１５は自律移動装置１００が移動経路に従って移動するように駆動部４０を制御する（ステップＳ２０５）。図９の例では障害物はないのでステップＳ２０６での判定はＮｏとなり、自律移動装置１００が目的地（第二地点８２）に到着するまで移動経路に従って移動を続け、目的地（第二地点８２）に到着したら（ステップＳ２０７；Ｙｅｓ）、停止する（ステップＳ２０８）。
　なお、ステップＳ２０５では、第四地点８４から第三地点８３までの間は、第二教示ルートを逆方向に辿るので、検出部３１で検出される周辺環境データと周辺情報変換部１４で生成した逆方向データ（例えば逆方向データ６０ｈ’，６０ｉ’）とを照合して制御部１０は自律移動装置１００の現在の位置及び向きを把握する。また、第三地点８３から第二地点８２までの間は、第一教示ルートを順方向に辿るので、検出部３１で検出される周辺環境データを地図記憶部２２に記憶されている周辺環境データ（例えば周辺環境データ６０ｃ，６０ｄ，６０ｅ）と照合して制御部１０は自律移動装置１００の現在の位置及び向きを把握する。
　このようにして、自律移動装置１００は、教示された経路を、教示されたときの移動方向以外の方向（上述の例では逆方向）で用いて移動することができるだけでなく、教示された複数のルートを組み合わせた経路を移動することもできる。
　次に、自律移動装置１００の再生補正処理について、図１２を参照して説明する。上述したように、この再生補正処理も、自律移動装置１００が起動すると実行が開始され、操作取得部３２からユーザの指示が入力されるのを待機している状態になる。
　また、再生補正処理は、上述の再生処理（図１０）と比較すると、異なる点は、ステップＳ２０５とステップＳ２０６の間でステップＳ２２１が実行される点のみである。したがって、ステップＳ２２１を中心に説明する。
　上述したように、ステップＳ２０５で自律移動装置１００が移動中に、制御部１０は検出部３１で検出された周辺環境データと地図記憶部２２に記録されている地図データとを用いて、自律移動装置１００の現在の位置及び向きを把握する。その際、上述の再生処理では、特に反射材の情報がマッチングしなかった場合には、制御部１０は、自律移動装置１００が本来の経路から外れている可能性が高いと判断した。
　これに対し、再生補正処理では、制御部１０は、検出部３１で検出された周辺環境データと地図記憶部２２に記録されている地図データとがマッチングしなかった場合には、検出部３１で検出された周辺環境データの方を正しいデータとみなして、地図記憶部２２に記録されている地図データを補正する（ステップＳ２２１）。
　この補正を常に行うと、自律移動装置１００の移動がかえって不安定になるおそれもあるため、補正に用いる対象は、反射材に限定してもよい。すなわち、周辺環境データと地図データとがマッチングしなかった場合、周辺環境データに含まれる反射材の情報については地図データの補正に用い、周辺環境データに含まれる反射材以外の情報は地図データと照合して自律移動装置１００の現在の位置及び向きの補正に用いるようにしてもよい。
　このように再生補正処理では、周辺環境の一部が変化した場合（例えば物流倉庫において、パレットに山積みされた荷物が、昨日までは存在していたが、本日はなくなっていた場合等）にも、地図データを補正することができる。また、廊下の壁等に設置されている反射材を追加する等して、その後の再生処理の精度を向上させることができる。
　また、制御部１０は、上述の追従教示処理において、認識した追従物を追従する際（教示用制御データに従って駆動部４０を制御する際）に、一時停止する場所Ｐ１と一時停止する時間Ｔ１を記憶して、記憶した移動経路に従って移動する際（再生処理や再生補正処理の際）に一時停止する場所Ｐ１で一時停止する時間Ｔ１だけ停止するように自律移動装置１００を制御してもよい。例えば、自律移動装置１００が記憶した移動経路上に、自動シャッターがある場合に、自動シャッターの場所を記憶し、扉が全て開くまで、自動シャッターの手前で自律移動装置１００を一時停止させることで、より柔軟に動作させることが可能であるためである。一時停止する場所Ｐ１や一時停止する時間Ｔ１の記憶は、追従教示処理の最中に行えるようにしてもよいし、追従教示処理の終了後に教示データを編集する形で行えるようにしてもよい。
　また、制御部１０は、上述の追従教示処理において、認識した追従物を追従する際（教示用制御データに従って駆動部４０を制御する際）に、所定の機器への制御信号Ｓを出力する出力場所Ｐ２（と必要な場合は一時停止する時間Ｔ２）を記憶して、記憶した移動経路に従って移動する際（再生処理や再生補正処理の際）に所定の機器への信号を出力する出力場所Ｐ２で制御信号Ｓを出力し、所定の機器を作動させる（又は作動させない）ように制御してもよい。例えば、制御部１０で、００００～１１１１の４ｂｉｔの出力パターンを記憶することができる場合に、自律移動装置１００に接続されている牽引パレット等との接続機構を切り離す制御信号Ｓ１の出力パターンとして０００１、接続機構を切り離さない制御信号Ｓ２の出力パターンとして００００が定義されているものとする。すると、所定の出力場所Ｐ２で、０００１の出力パターンの制御信号Ｓ１を出力することにより、自律移動装置１００に接続されている牽引パレット等との接続機構を切り離す（さらに切り離しに必要な時間Ｔ２だけ一時停止する）、００００の出力パターンの制御信号Ｓ２を出力することにより、自律移動装置１００に接続されている牽引パレット等との接続機構を切り離さない等の設定を記憶することができる。これにより、自律移動装置１００が記憶した移動経路上の所定の場所で、自律移動装置１００に接続されている牽引パレット等との接続機構を切り離して荷物を置いてくるか否かを選択し、より柔軟に動作させることが可能となる。制御信号Ｓ、制御信号を出力する出力場所Ｐ２、一時停止する時間Ｔ２の記憶は、追従教示処理の最中に行えるようにしてもよいし、追従教示処理の終了後に教示データを編集する形で行えるようにしてもよい。なお、自律移動装置１００は、所定の機器として、紫外線照射ランプを備えても良い。すると、同様に、「所定の機器への制御信号の出力」を紫外線照射ランプのオンオフ制御に使うことができる。例えば、出力場所Ｐ２で制御信号Ｓを出力し、紫外線照射ランプを作動させる（又は停止する）ように制御することができる。
　また、自律移動装置１００は、出力場所Ｐ２の代わりに制御信号Ｓを出力する条件Ｃを記憶できるようにしてもよい。すなわち、上述の追従教示処理において、認識した追従物を追従する際（教示用制御データに従って駆動部４０を制御する際）に、所定の機器への制御信号Ｓを出力する条件Ｃを記憶して、記憶した移動経路に従って移動する際（再生処理や再生補正処理の際）に、条件Ｃが満たされたら所定の機器へ制御信号Ｓを出力し、所定の機器を作動させる（又は作動させない）ように制御してもよい。例えば「検出部３１で人が近づいたことを検知」という条件Ｃを記憶させることで、検出部３１で人が近づいてくることを検知すると、紫外線照射を止めるように制御することができる。また、教示時と再生時とで、所定の機器を変更可能にしてもよい。例えば、再生時においては紫外線照射を行いたいが、教示時には紫外線を照射したくない（ただし、紫外線照射がどのように行われるかをパイロットランプ等で確認したい）場合には、所定の機器を「教示時：パイロットランプ、再生時：紫外線照射ランプ」というような形式で設定可能にしてもよい。このようにすると、自律移動装置１００は、教示中においては、紫外線照射を止めて、別のパイロットランプ等により出力信号を確認でき、再生中においては紫外線照射するように構成可能である。これにより、特定の箇所にだけ紫外線の照射を行うことができ、また人が付近にいた際には紫外線の照射を止めることができる。
　さらに、自律移動装置１００は、速度モードを選択できるようにしてもよい。速度モードとしては、例えば、教示速度モード（追従教示や操縦教示が行われた時の実際の速度を記憶して、再生時には教示時と同じ速度で移動するモード）や、設定速度モード（ユーザが再生時の速度として、任意の制御速度を記憶させることができ、再生時には記憶された制御速度で移動するモード）を存在する。そして、制御部１０は、上述の追従教示処理において、速度モードを選択することができ、選択した速度モードを地図データと合わせて記憶する。
　速度モードとして設定速度モードが選択された場合には、制御部１０は、上述の追従教示処理において、認識した追従物を追従する際（教示用制御データに従って駆動部４０を制御する際）にユーザが設定した制御速度を記憶し、移動経路に従って移動する際（再生処理や再生補正処理の際）は、認識した追従物を追従する際に記憶した制御速度で移動するように自律移動装置１００を制御してもよい。または、速度モードとして教示速度モードが選択された場合には、制御部１０は、上述の追従教示処理において、追従物を追従した際の実際の速度を記憶し、移動経路に従って移動する際（再生処理や再生補正処理の際）には、教示時と同じ速度になるように自律移動装置１００を制御してもよい。
　このように、制御部１０は、上述の追従教示処理において、認識した追従物を追従する際（教示用制御データに従って駆動部４０を制御する際）にユーザが選択した速度モードやユーザが設定した制御速度を記憶して、移動経路に従って移動する際（再生処理や再生補正処理の際）に、記憶した速度モード又は制御速度に基づいて移動速度を制御するように駆動部４０を制御してもよい。これにより、再生する際に好適な速度で動作させることが可能になる。制御速度もしくは速度モードの記憶は、追従教示処理の最中に行えるようにしてもよいし、追従教示処理の終了後に教示データを編集する形で行えるようにしてもよい。また、制御速度としては、移動経路上の任意の場所における速度を記憶できるようにしてもよい。例えば直進する際の制御速度は比較的速い速度を記憶し、曲がる際の制御速度は比較的遅い速度を記憶してもよい。また、条件によって異なる制御速度を設定できるように複数の制御速度を記憶できるようにしてもよい。例えば、積み荷が基準重量（例えば１０ｋｇ）よりも重い場合の制御速度として比較的遅い速度を記憶し、積み荷が基準重量以下の場合の制御速度として比較的速い速度を記憶するようにしてもよい。　
　なお、上述したような様々なデータ（一時停止する場所Ｐ１、時間Ｔ１、制御信号Ｓ、出力場所Ｐ２、条件Ｃ、速度モード、制御速度等）を教示データに追加記憶させることについては、追従物を認識させて追従させることによって教示する追従教示の場合に限られず、ジョイスティック等の操作取得部３２を用いて教示させる操縦教示の場合であっても適用できる。
（変形例）
　自律移動装置１００は、図２に示すように、検出部３１が操作取得部３２の上方にあるが、検出部３１の設置位置はこれに限定されない。例えば、図１３に示すように、実施形態１の変形例に係る自律移動装置１０１は、検出部３１を荷台５１の下方に備える。自律移動装置１００でも、検出部３１のみで障害物を検出できることは上述したとおりであるが、変形例に係る自律移動装置１０１においては、より低い位置で障害物を検出できるため、比較的小さい障害物であっても回避可能になる。
　なお、障害物に関しては、検出部３１とは別に、障害物を検出するための専用のセンサを設けてもよい。障害物を検出するための専用のセンサとしては、例えば、バンパー５２に、バンパーセンサを設置することが考えられる。この場合、制御部１０は、バンパーセンサで障害物に接触したことを検出したら、自律移動装置１００，１０１を停止させたり、少し後退させたり等の処理を行うことができる。
　なお、自律移動装置１００，１０１の各機能は、通常のＰＣ（Ｐｅｒｓｏｎａｌ　Ｃｏｍｐｕｔｅｒ）等のコンピュータによっても実施することができる。具体的には、上記実施形態では、自律移動装置１００，１０１が行う追従教示処理、再生処理等のプログラムが、記憶部２０のＲＯＭに予め記憶されているものとして説明した。しかし、プログラムを、フレキシブルディスク、ＣＤ－ＲＯＭ（Ｃｏｍｐａｃｔ　Ｄｉｓｃ　Ｒｅａｄ　Ｏｎｌｙ　Ｍｅｍｏｒｙ）、ＤＶＤ（Ｄｉｇｉｔａｌ　Ｖｅｒｓａｔｉｌｅ　Ｄｉｓｃ）、ＭＯ（Ｍａｇｎｅｔｏ－Ｏｐｔｉｃａｌ　Ｄｉｓｃ）、メモリカード、ＵＳＢ（Ｕｎｉｖｅｒｓａｌ　Ｓｅｒｉａｌ　Ｂｕｓ）メモリ等のコンピュータ読み取り可能な記録媒体に格納して配布し、そのプログラムをコンピュータに読み込んでインストールすることにより、上述の機能を実現することができるコンピュータを構成してもよい。また、プログラムをインターネット等の通信ネットワークを介して配布し、そのプログラムをコンピュータに読み込んでインストールすることにより、上述の機能を実現することができるコンピュータを構成してもよい。
　以上、本発明の好ましい実施形態について説明したが、本発明は、本発明の広義の精神と範囲を逸脱することなく、様々な実施の形態及び変形が可能とされるものである。また、上述した実施の形態は、この発明を説明するためのものであり、本発明の範囲を限定するものではない。すなわち、本発明の範囲は、実施の形態ではなく、請求の範囲によって示される。そして、請求の範囲内及びそれと同等の発明の意義の範囲内で施される様々な変形が、この発明の範囲内とみなされる。
　１０…制御部、１１…周辺情報取得部、１２…地図作成部、１３…経路生成部、１４…周辺情報変換部、１５…移動制御部、２０…記憶部、２１…地点記憶部、２２…地図記憶部、３１…検出部、３２…操作取得部、４０…駆動部、４１…車輪、４２…モータ、４３…キャスター、５１…荷台、５２…バンパー、６０…点線、６０ａ，６０ｂ，６０ｃ，６０ｄ，６０ｅ，６０ｆ，６０ｈ，６０ｉ，６０ｊ，６０ｋ，６０ｍ，６０ｎ…周辺環境データ、６０ａ’，６０ｂ’，６０ｃ’，６０ｄ’，６０ｈ’，６０ｉ’…逆方向データ、６０ｅｆ…網掛け部分、６１…人、６２…移動経路、６３，６４…反射材、６５，６６…ユーザ、６７，６８…回避経路、７１…壁、７２，７３，７４…障害物、８１，８２，８３，８４…地点、１００，１０１…自律移動装置、３１１…光学窓、３１２…レーザ、３１３…回転軸、３２１…レバー、３２２…タッチパネル

Claims (17)

  1. 　周辺の物体を検出する検出手段と、
    　移動手段と、
    　制御手段と、
    　を備え、
    　前記制御手段は、
    　教示用制御データを取得し、
    　前記取得した教示用制御データに従って前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、
    　前記作成した地図データ上で移動した移動経路を記憶する、
    　自律移動装置。
  2. 　前記制御手段は、
    　前記検出手段で検出した物体の中から追従物を認識し、
    　前記認識した追従物を追従するように前記移動手段を制御するためのデータを前記教示用制御データとして取得する、
    　請求項１に記載の自律移動装置。
  3. 　前記制御手段は、
    　前記認識した追従物を追従するように前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、
    　前記作成した地図データ上で移動した移動経路を記憶し、
    　前記記憶した移動経路に従って移動するように前記移動手段を制御し、
    　前記記憶した移動経路には、前記追従物を追従したときの移動方向以外の方向の移動経路が含まれる、
    　請求項２に記載の自律移動装置。
  4. 　ユーザの操作を取得する操作取得手段をさらに備え、
    　前記制御手段は、
    　前記操作取得手段で前記教示用制御データを取得する、
    　請求項１に記載の自律移動装置。
  5. 　前記移動手段は、
    　前記取得した教示用制御データに従って前記移動手段を制御する際は、前記自律移動装置を後退させないように制御する、
    　請求項１から４のいずれか１項に記載の自律移動装置。
  6. 　前記制御手段は、
    　教示開始の指示の入力に基づいて第一地点を登録して、前記取得した教示用制御データに従って前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、前記作成した地図データ上で移動した移動経路を記憶し、
    　教示終了の指示の入力に基づいて第二地点を登録して教示を終了し、
    　前記第一地点から前記第二地点までの移動経路を第一教示ルートとして記録し、
    　前記第一教示ルート上に存在する所定の地点から、前記第一地点又は前記第二地点までの移動経路を生成し、
    　前記生成した移動経路に従って移動するように前記移動手段を制御する、
    　請求項１から５のいずれか１項に記載の自律移動装置。
  7. 　前記制御手段は、
    　前記第一教示ルートを逆方向に用いることにより、前記第二地点から前記第一地点までの移動経路を生成する、
    　請求項６に記載の自律移動装置。
  8. 　前記制御手段は、
    　前記第一教示ルート上において、教示開始の指示に基づいて第三地点を登録して、前記取得した教示用制御データに従って前記移動手段を制御しながら、前記検出手段で検出した点群に基づいて周辺環境の地図データを作成し、前記作成した地図データ上で移動した移動経路を記憶し、
    　教示終了の指示に基づいて第四地点を登録して教示を終了し、
    　前記第三地点から前記第四地点までの移動経路を第二教示ルートとして記録し、
    　前記第一教示ルート及び前記第二教示ルートを用いることにより、前記第一教示ルート上又は前記第二教示ルート上に存在する所定の地点から、前記第一地点、前記第二地点、前記第三地点及び前記第四地点から選択された地点までの移動経路を生成する、
    　請求項６又は７に記載の自律移動装置。
  9. 　前記制御手段は、
    　前記教示用制御データに従って前記移動手段を制御したときの移動方向に対して逆方向の移動経路を生成する場合に、
    　前記検出手段により検出した周辺の物体の位置に関するデータを、当該物体を逆方向から検出した場合のデータに変換し、
    　前記変換したデータに基づいて、前記生成した移動経路に従って移動するように前記移動手段を制御する、
    　請求項６から８のいずれか１項に記載の自律移動装置。
  10. 　前記制御手段は、
    　前記検出手段で検出した物体の中から障害物を認識し、
    　前記認識した障害物を回避可能であるときは、前記障害物を回避するために前記移動経路から外れ、前記障害物を回避した後に前記移動経路に戻るように前記移動手段を制御する、
    　請求項１から９のいずれか１項に記載の自律移動装置。
  11. 　前記検出手段は周辺に設置された反射材を検出し、
    　前記制御手段は、
    　前記教示用制御データに従って前記移動手段を制御している間に前記検出手段で検出した反射材の情報を前記地図データに記録し、
    　前記移動経路に従って移動している間に前記検出手段で検出した反射材の情報を前記地図データに記録された反射材の情報と照合することにより前記自律移動装置の位置及び向きを補正する、
    　請求項１から１０のいずれか１項に記載の自律移動装置。
  12. 　前記制御手段は、
    　前記移動経路に従って移動している間に前記検出手段で検出した周辺の物体の位置に関するデータを前記地図データと照合して前記地図データを補正する、
    　請求項１から１１のいずれか１項に記載の自律移動装置。
  13. 　前記制御手段は、
    　前記教示用制御データに従って前記移動手段を制御する際に、一時停止する場所と一時停止する時間を記憶して、
    　前記記憶した移動経路に従って移動する際に、前記一時停止する場所で前記一時停止する時間だけ停止する、
    　請求項１から１２のいずれか１項に記載の自律移動装置。
  14. 　前記制御手段は、
    　前記教示用制御データに従って前記移動手段を制御する際に、所定の機器への制御信号を出力する出力場所を記憶して、
    　前記記憶した移動経路に従って移動する際に、前記所定の機器へ前記制御信号を前記出力場所で出力する、
    　請求項１から１３のいずれか１項に記載の自律移動装置。
  15. 　前記制御手段は、
    　前記教示用制御データに従って前記移動手段を制御する際に、制御速度もしくは速度モードを記憶して、
    　前記記憶した移動経路に従って移動する際に、前記記憶した制御速度もしくは速度モードに基づいて移動速度を制御するように前記移動手段を制御する、
    　請求項１から１４のいずれか１項に記載の自律移動装置。
  16. 　教示用制御データを取得する教示用制御データ取得ステップと、
    　前記取得した教示用制御データに従って移動手段を制御しながら検出手段で検出した点群に基づいて周辺環境の地図データを作成する地図作成ステップと、
    　前記作成した地図データ上で移動した移動経路を記憶する移動経路記憶ステップと、
    　を備える、
    　自律移動方法。
  17. 　コンピュータに、
    　教示用制御データを取得する教示用制御データ取得ステップ、
    　前記取得した教示用制御データに従って移動手段を制御しながら検出手段で検出した点群に基づいて周辺環境の地図データを作成する地図作成ステップ、及び、
    　前記作成した地図データ上で移動した移動経路を記憶する移動経路記憶ステップ、
    　を実行させるプログラム。
PCT/JP2020/023468 2020-06-15 2020-06-15 自律移動装置、自律移動方法及びプログラム Ceased WO2021255797A1 (ja)

Priority Applications (7)

Application Number Priority Date Filing Date Title
EP20941126.3A EP4167043A4 (en) 2020-06-15 2020-06-15 AUTONOMOUS MOVEMENT DEVICE, AUTONOMOUS MOVEMENT METHOD AND PROGRAM
JP2022531118A JP7495154B2 (ja) 2020-06-15 2020-06-15 自律移動装置、自律移動方法及びプログラム
PCT/JP2020/023468 WO2021255797A1 (ja) 2020-06-15 2020-06-15 自律移動装置、自律移動方法及びプログラム
US18/002,025 US20230341862A1 (en) 2020-06-15 2020-06-15 Autonomous Movement Device, Autonomous Movement Method, And Program
PCT/JP2021/015009 WO2021256062A1 (ja) 2020-06-15 2021-04-09 自律移動装置、自律移動方法及びプログラム
US18/002,029 US20230266762A1 (en) 2020-06-15 2021-04-09 Autonomous Movement Device, Autonomous Movement Method, And Program
JP2022532332A JP7576343B2 (ja) 2020-06-15 2021-04-09 自律移動装置、自律移動方法及びプログラム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/023468 WO2021255797A1 (ja) 2020-06-15 2020-06-15 自律移動装置、自律移動方法及びプログラム

Publications (1)

Publication Number Publication Date
WO2021255797A1 true WO2021255797A1 (ja) 2021-12-23

Family

ID=79267715

Family Applications (2)

Application Number Title Priority Date Filing Date
PCT/JP2020/023468 Ceased WO2021255797A1 (ja) 2020-06-15 2020-06-15 自律移動装置、自律移動方法及びプログラム
PCT/JP2021/015009 Ceased WO2021256062A1 (ja) 2020-06-15 2021-04-09 自律移動装置、自律移動方法及びプログラム

Family Applications After (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/015009 Ceased WO2021256062A1 (ja) 2020-06-15 2021-04-09 自律移動装置、自律移動方法及びプログラム

Country Status (4)

Country Link
US (2) US20230341862A1 (ja)
EP (1) EP4167043A4 (ja)
JP (2) JP7495154B2 (ja)
WO (2) WO2021255797A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023235622A3 (en) * 2022-06-03 2024-01-04 Seegrid Corporation Lane grid setup for autonomous mobile robot
WO2025263621A1 (ja) * 2024-06-21 2025-12-26 株式会社Doog 自律移動装置、台車、自律移動装置の制御方法、プログラム及び群運用制御システム

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3230142B1 (en) * 2014-12-12 2022-03-16 Sony Group Corporation Method for switching modes for operating a vehicle
US11418950B1 (en) * 2019-12-12 2022-08-16 Amazon Technologies, Inc. System for establishing a secure data connection with an autonomous mobile device
EP4202368A1 (en) * 2021-12-24 2023-06-28 Ricoh Company, Ltd. Information processing apparatus, route generation system, route generating method, and carrier means
JP7800194B2 (ja) * 2022-02-21 2026-01-16 沖電気工業株式会社 制御装置、制御方法、及びプログラム
EP4532283A4 (en) * 2022-06-03 2026-03-18 Seegrid Corp SYSTEM AND METHOD FOR GENERATING COMPLEX EXECUTION PATH NETWORKS FROM AN INCOMPLETE DEMONSTRATION OF TRAINED ACTIVITIES
JP2024101150A (ja) * 2023-01-17 2024-07-29 トヨタ自動車株式会社 制御システム、操作装置、制御方法、及びプログラム
JP7768184B2 (ja) * 2023-04-19 2025-11-12 トヨタ自動車株式会社 操作装置及び移動ロボット
JP7615263B1 (ja) * 2023-09-29 2025-01-16 本田技研工業株式会社 移動体の制御装置、移動体の制御方法、およびプログラム
JP2026005859A (ja) * 2024-06-27 2026-01-16 株式会社クボタ 走行制御システム、作業車両および走行制御方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62272307A (ja) * 1986-05-21 1987-11-26 Komatsu Ltd 無人移動体の誘導位置補正装置
JP2000305625A (ja) * 1999-04-16 2000-11-02 Honda Motor Co Ltd 自動走行車
JP2004240698A (ja) * 2003-02-06 2004-08-26 Matsushita Electric Ind Co Ltd ロボット移動経路教示方法と移動経路教示機能付きロボット
JP2004264182A (ja) * 2003-03-03 2004-09-24 Kawasaki Heavy Ind Ltd 移動体の位置計測方法及び装置
JP2008084135A (ja) 2006-09-28 2008-04-10 Toshiba Corp 移動制御方法、移動ロボットおよび移動制御プログラム
JP2010250469A (ja) * 2009-04-14 2010-11-04 Yaskawa Electric Corp 移動体及び移動体の教示方法
JP2018112917A (ja) * 2017-01-12 2018-07-19 国立大学法人豊橋技術科学大学 自律走行作業装置およびデータ管理方法
JP2019008431A (ja) * 2017-06-22 2019-01-17 株式会社日立製作所 経路探索装置および経路探索方法
JP2019061452A (ja) * 2017-09-26 2019-04-18 株式会社豊田自動織機 地図情報更新方法
WO2019097626A1 (ja) * 2017-11-16 2019-05-23 学校法人 千葉工業大学 自走式掃除機

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA1247743A (en) * 1985-01-24 1988-12-28 Izuru Morita Operation data recording system
JP4464912B2 (ja) * 2004-12-03 2010-05-19 パナソニック株式会社 ロボット制御装置及び自律移動ロボット
US8744664B2 (en) * 2009-09-07 2014-06-03 Bae Systems Plc Path determination
JP5792361B1 (ja) * 2014-06-25 2015-10-07 シャープ株式会社 自律移動装置
JP2016168883A (ja) * 2015-03-11 2016-09-23 株式会社クボタ 作業車両
JP6437640B2 (ja) 2015-05-07 2018-12-12 ヤンマー株式会社 自律走行車の誘導制御システム
US9688288B1 (en) * 2016-03-08 2017-06-27 VOLKSWAGEN AG et al. Geofencing for auto drive route planning
US20200397204A1 (en) * 2017-09-05 2020-12-24 Aktiebolaget Electrolux Method of a robotic cleaning device
US20190163176A1 (en) * 2017-11-30 2019-05-30 drive.ai Inc. Method for transferring control of an autonomous vehicle to a remote operator
US10890911B2 (en) * 2018-07-20 2021-01-12 Autox, Inc. System and method for autonomously delivering commodity to the recipient's preferred environment

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62272307A (ja) * 1986-05-21 1987-11-26 Komatsu Ltd 無人移動体の誘導位置補正装置
JP2000305625A (ja) * 1999-04-16 2000-11-02 Honda Motor Co Ltd 自動走行車
JP2004240698A (ja) * 2003-02-06 2004-08-26 Matsushita Electric Ind Co Ltd ロボット移動経路教示方法と移動経路教示機能付きロボット
JP2004264182A (ja) * 2003-03-03 2004-09-24 Kawasaki Heavy Ind Ltd 移動体の位置計測方法及び装置
JP2008084135A (ja) 2006-09-28 2008-04-10 Toshiba Corp 移動制御方法、移動ロボットおよび移動制御プログラム
JP2010250469A (ja) * 2009-04-14 2010-11-04 Yaskawa Electric Corp 移動体及び移動体の教示方法
JP2018112917A (ja) * 2017-01-12 2018-07-19 国立大学法人豊橋技術科学大学 自律走行作業装置およびデータ管理方法
JP2019008431A (ja) * 2017-06-22 2019-01-17 株式会社日立製作所 経路探索装置および経路探索方法
JP2019061452A (ja) * 2017-09-26 2019-04-18 株式会社豊田自動織機 地図情報更新方法
WO2019097626A1 (ja) * 2017-11-16 2019-05-23 学校法人 千葉工業大学 自走式掃除機

Non-Patent Citations (1)

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

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023235622A3 (en) * 2022-06-03 2024-01-04 Seegrid Corporation Lane grid setup for autonomous mobile robot
US20250223142A1 (en) * 2022-06-03 2025-07-10 Seegrid Corporation Lane grid setup for autonomous mobile robot
WO2025263621A1 (ja) * 2024-06-21 2025-12-26 株式会社Doog 自律移動装置、台車、自律移動装置の制御方法、プログラム及び群運用制御システム

Also Published As

Publication number Publication date
JPWO2021255797A1 (ja) 2021-12-23
JP7495154B2 (ja) 2024-06-04
EP4167043A4 (en) 2024-02-21
EP4167043A1 (en) 2023-04-19
US20230266762A1 (en) 2023-08-24
JP7576343B2 (ja) 2024-10-31
WO2021256062A1 (ja) 2021-12-23
JPWO2021256062A1 (ja) 2021-12-23
US20230341862A1 (en) 2023-10-26

Similar Documents

Publication Publication Date Title
WO2021255797A1 (ja) 自律移動装置、自律移動方法及びプログラム
JP7081881B2 (ja) 移動体および移動体システム
US11537140B2 (en) Mobile body, location estimation device, and computer program
US20200363212A1 (en) Mobile body, location estimation device, and computer program
WO2019026761A1 (ja) 移動体およびコンピュータプログラム
CN108369418A (zh) 用于自主车辆的虚拟线路跟随和改进方法
JP7460328B2 (ja) 移動ロボット、移動ロボットの制御システム、移動ロボットの制御方法
JP2020166702A (ja) 移動体システム、地図作成システム、経路作成プログラムおよび地図作成プログラム
WO2019054209A1 (ja) 地図作成システムおよび地図作成装置
US7996126B2 (en) Apparatus and method for navigation based on illumination intensity
KR102341703B1 (ko) 최적경로주행을 위한 이동로봇 및 이의 동작방법
CN112578789A (zh) 移动体
JP2020140594A (ja) Ｓｌａｍ誘導方式の無人作業車および無人作業システム
Zobel Trajectory segmentation for the autonomous control of backward motion for truck and trailer
JP2003316439A (ja) 移動台車の制御装置
Garibott et al. Robolift: a vision guided autonomous fork-lift for pallet handling
JPWO2019069921A1 (ja) 移動体
JP2001347478A (ja) ロボットに対する操作対象の教示方法およびその装置ならびにロボット
EP1804149B1 (en) Mobile robot
JP2019067001A (ja) 移動体
JP7590802B1 (ja) 搬送車の走行制御システム及び搬送車の走行制御方法
JP7513338B2 (ja) 搬送システム、及び搬送制御方法
JP2660534B2 (ja) 移動体の誘導走行制御装置
JP6687313B1 (ja) 搬送システム
JP2023061692A (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: 20941126

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022531118

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2020941126

Country of ref document: EP

Effective date: 20230116

WWW Wipo information: withdrawn in national office

Ref document number: 2020941126

Country of ref document: EP