WO2014156502A1 - 位置同定装置、及びそれを備えた移動ロボット - Google Patents

位置同定装置、及びそれを備えた移動ロボット Download PDF

Info

Publication number
WO2014156502A1
WO2014156502A1 PCT/JP2014/055386 JP2014055386W WO2014156502A1 WO 2014156502 A1 WO2014156502 A1 WO 2014156502A1 JP 2014055386 W JP2014055386 W JP 2014055386W WO 2014156502 A1 WO2014156502 A1 WO 2014156502A1
Authority
WO
WIPO (PCT)
Prior art keywords
mobile robot
distance
identification device
position identification
travel
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/JP2014/055386
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.)
Hitachi Industrial Equipment Systems Co Ltd
Original Assignee
Hitachi Industrial Equipment Systems Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hitachi Industrial Equipment Systems Co Ltd filed Critical Hitachi Industrial Equipment Systems Co Ltd
Priority to CN201480019286.6A priority Critical patent/CN105074602B/zh
Priority to US14/778,145 priority patent/US9804605B2/en
Publication of WO2014156502A1 publication Critical patent/WO2014156502A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles

Definitions

  • the present invention relates to a position identification device that estimates a position and an angle of a moving body on a map based on distance data of the surrounding environment measured by a distance sensor and map data of the surrounding environment, and a moving body including the position identification device. is there.
  • the term “moving body” and the term “mobile robot” are used together, but “mobile robot” is used as an embodiment of “moving body”. There is no significant difference.
  • Patent Document 1 Japanese Patent Application Laid-Open No. 2009-109200
  • Patent Document 1 Japanese Patent Application Laid-Open No. 2009-109200
  • Japanese Patent Application Laid-Open No. 2009-109200 relates to a technique for recognizing the position and orientation of a user in an actual environment, which is used in autonomous movement control of a mobile robot.
  • a two-dimensional environment that shows the position and orientation of the mobile robot, the sensing data from the distance sensor mounted on the mobile robot, and the geometric state of the environment, with the goal of automatically reaching the destination without human intervention.
  • a technique for calculating using a map is disclosed.
  • Patent Document 1 describes a method for estimating the position and orientation of a mobile robot by matching sensing data measured by a distance sensor with an environmental map.
  • the processing amount of data becomes enormous and the calculation time becomes long, it has been desired to reduce the processing amount. For this reason, no proposal has been made to perform processing using a map other than estimating the position and orientation.
  • the present invention has been made in view of the above problems, and moves by matching distance data and map data within a predetermined area (specific area such as a running area and a specified area) set in advance.
  • a position identification device that classifies the type of object irradiated by the laser distance sensor by estimating the position and orientation of the body and collating the distance data with the map data again using the estimated position and orientation, and the same An object is to provide a mobile robot.
  • a position identification device identifies an object provided in an ambient environment by reflected light of a laser beam to be irradiated, and estimates a position and an angle of a movable body arranged to be movable in the ambient environment
  • map data of the surrounding environment where the moving body travels is stored
  • a distance sensor for measuring a distance from the moving body to an object provided in the surrounding environment
  • the movement measured by the distance sensor Means for discriminating an object provided in the surrounding environment based on distance data from the body to the object and the map data
  • traveling area storage means for storing the traveling area of the moving body, and storing in the traveling area storage means
  • an object determination means for determining whether or not the object is placed in the travel area of the mobile object.
  • a position identification device identifies an object provided in an ambient environment by reflected light of a laser beam to be irradiated, and estimates a position and an angle of a movable body arranged to be movable in the ambient environment
  • map data of the surrounding environment where the moving body travels is stored
  • a distance sensor for measuring a distance from the moving body to an object provided in the surrounding environment, and the movement measured by the distance sensor Means for discriminating an object provided in the surrounding environment from distance data from the body to the object and the map data
  • traveling area storage means for storing a traveling area of the moving object, and a traveling area of the moving object;
  • An object determining means for determining whether the serial object is located, characterized by comprising a.
  • the position identification device uses a distance sensor that measures a distance to a surrounding object, map data of a surrounding environment in which the moving body travels, and distance data measured by the distance sensor, so that the position of the moving body In the position identification device for estimating the angle, whether the object is placed in the specific area using the specific area storage means for storing the specific area of the map data, the map data, and the estimated position and angle And an object determination means for determining whether or not.
  • the position identification device measures the distance from the moving body to the object by the distance sensor a plurality of times, and the object moves based on the plurality of the distance data obtained by the plurality of measurements. It is characterized by classifying whether it is a body or a stationary body.
  • the mobile robot according to the present invention is a mobile robot comprising the position identification device and a control device that automatically controls autonomous traveling, wherein the control device indicates that the mobile robot has approached the object.
  • the travel route is changed based on the determination based on the distance data and based on the determination as to whether or not the object determined by the object determination means is placed in the travel area.
  • the control device when the control device determines from the distance data that the mobile robot has approached the object, the control device changes the travel limit speed of the mobile body according to the classification of the object.
  • the mobile robot according to the present invention is characterized in that the mobile robot includes a communication device that notifies the outside when the object determination means determines that the object is placed in the specific area.
  • the mobile robot according to the present invention collates distance data with map data, so that an object that matches the map, an object on a travel path, an object in a specific area of the map, etc. It is possible to easily classify, and it is possible to construct a control system that travels while avoiding obstacles and improving the convenience of a moving object.
  • FIG. 1 is a block diagram showing the configuration of the mobile robot of this embodiment.
  • FIG. 2 is an explanatory diagram showing the travel route of the mobile robot and the state of the surrounding environment.
  • FIG. 3A is an explanatory diagram showing map data of the surrounding environment.
  • FIG. 3B is an explanatory diagram showing a traveling area and a designated area of the mobile robot in the map data.
  • FIG. 4 is an explanatory diagram illustrating a state in which an object is identified by irradiating an object or the like with a laser from a laser distance sensor configured in the mobile robot.
  • FIG. 5A is an explanatory diagram showing a state in which the distance to the map object seen from the mobile robot 1 is measured in comparison with FIG. 3A.
  • FIG. 5A is an explanatory diagram showing a state in which the distance to the map object seen from the mobile robot 1 is measured in comparison with FIG. 3A.
  • FIG. 5B is an explanatory diagram illustrating a state in which it is determined that the object A is placed in a travel area stored in advance.
  • FIG. 5C is an explanatory diagram showing a state in which it is determined that the carriage B is placed in the designated area A1 stored in advance.
  • FIG. 5D is an explanatory diagram illustrating a state in which it is determined that an object exists in areas other than the travel areas 1, 2, 3 and the designated area.
  • FIG. 1 is a block diagram showing a configuration of a mobile robot 1 as a mobile body according to an example of the present invention. As shown in the figure, the mobile robot 1 is output from the relative position calculation unit 2 and the relative position calculation unit 2 to which the target positions Xg and Yg and the target angle ⁇ g output from the target point commanding device 9 are input.
  • Laser distance sensor for measuring the distance from the left and right motors 5 as the traveling means to which the left motor speed command and the right motor speed command are input, respectively, and the surrounding environment (wall, device, object A, etc.) to be described later 6
  • position identification means 7 that estimates the position and angle of the mobile robot 1 from the surrounding environment map data 10 and the surrounding environment distance data measured by the laser distance sensor 6, and communicates with the outside for notification or the like.
  • the position identification means 7 serving as a position identification device stores map data 10 of the surrounding environment where the mobile robot 1 travels, and position information up to the surrounding environment such as walls, devices, and objects measured by the laser distance sensor 6. And a map collating unit 11 for collating the map data 10 with each other.
  • the position identification means 7 divides the area into a “running area” and a “designated area” as a specific area in advance as shown in FIG. 3B. .
  • the “traveling area” is an area where the mobile robot 1 travels as the name suggests, and the “designated area” is a place for a carriage or an object.
  • the position identification means 7 includes a travel area storage means 12 that stores the travel area of the mobile robot 1 and a specified area storage means that is a specific area storage means that stores a specific area other than the travel area of the mobile robot 1. 13. Then, the presence of the “object” is determined by the object determination means 14 from the information on the surrounding environment such as the wall, device, and object measured by the laser distance sensor 6. Furthermore, referring to each area information from the running area storage means 12 and the designated area storage means 13, whether the “object” determined to exist is a map object, a running obstacle object, or a designated area object. The processing is performed in each processing unit, the map object proximity determination unit 15, the travel obstacle object processing unit 16, and the designated area object processing unit 17.
  • the map object and the traveling obstacle object need to pay attention to the traveling mobile robot 1. Therefore, information is output to the vehicle speed limit calculation unit 18, and information is calculated by the vehicle speed limit calculation unit 18. If it is determined that it is necessary to limit the vehicle speed, a speed limit command is issued to the control command unit 3.
  • the distance data measured by the laser distance sensor 6 is collated with the map data 10 to obtain the position and angle data of the mobile robot 1.
  • the position and angle data of the mobile robot 1 after collation by the data collation unit 11 is input to the object determination unit 14 together with the distance data measured by the laser distance sensor 6 and the map data 10.
  • the object determination means 14 refers to the area information from the travel area storage means 12 and the designated area storage means 13 and the “object” determined to exist is a map object or a travel obstacle object. It is determined whether the object is a specified area object.
  • the map object information is processed by the map object proximity determination unit 15, the travel obstacle object information is processed by the travel obstacle object processing unit 16, and the designated area object information is processed by the designated area object processing unit 17.
  • FIG. 2 is an explanatory diagram showing the travel route of the mobile robot 1 and the state of the surrounding environment.
  • the surrounding environment where the mobile robot 1 can travel there are walls, devices 1 to 5, an object B, a carriage C, and an object C as objects.
  • the object B is placed so as to cover the traveling route of the mobile robot 1 indicated by the dotted line, and the carriage C is placed in the carriage parking place.
  • the mobile robot 1 is intended to travel while avoiding the object B so as not to contact the object B when traveling on the travel route indicated by the dotted line.
  • FIG. 3A shows map data of the surrounding environment.
  • FIG. 3B shows the travel areas 1, 2, 3 and the designated area A1 of the mobile robot 1 in the map data.
  • the map data of the surrounding environment in FIG. 3A is stored in advance.
  • the traveling areas 1, 2, 3 and the designated area A1 in FIG. 3B can be stored in the traveling area storage means 12 and the designated area storage means 13 by a predetermined operation by the user.
  • FIG. 4 shows a state in which an object is discriminated by irradiating a laser from the laser distance sensor 6 configured in the mobile robot 1 to the objects A, B and the like.
  • the laser light emitted from the laser distance sensor 6 of the mobile robot 1 is in the range of 90 degrees to the left and right with respect to the front side of the mobile robot 1, that is, in the range of 180 degrees. Irradiated.
  • the distance to the boundaries of the objects A and B and the surrounding environment can be measured by reflected light.
  • the detection state shown in FIG. 4 is a result of estimating the position and posture of the mobile robot 1 by collating the distance data of the laser distance sensor 6 and the map data 10 by matching processing. That is, the position and orientation of the mobile robot 1 can be estimated from the distance data that matches the map data 10.
  • FIGS. 5A, 5B, 5C, and 5D show that the distance data is classified by a thick line.
  • FIG. 5A shows that the distance data matches the map data 10 by comparing again with the map data 10 shown in FIG. 3A. Since these data are described on the map, they can be regarded as fixed objects or stationary objects.
  • FIG. 5B shows a state in which it is determined that the object A is placed in the travel area stored in advance.
  • the object A existing in the travel area 2 can be an obstacle to travel of the mobile robot 1. That is, since the object A is on the traveling area where the vehicle is scheduled to travel, it is determined that there is a possibility of collision when traveling on the planned traveling route.
  • the approximate size of the object A can be estimated from the distance data, it is not specified any more.
  • the “object” existing in the travel area 2 is extracted from the “object” determined to exist.
  • three travel areas are set.
  • the “object” existing in the travel area may be determined when the mobile robot 1 enters the travel area. That is, the “object” existing in the travel area 1 is determined when entering the area from the entrance, and the “object” present in the travel area 3 is determined from the end of the travel area 2 to the travel area 3. It is possible to do it before entering. In addition, if the vehicle enters the traveling area during traveling, it is necessary to cope with it.
  • FIG. 5C shows a state in which it is determined that the carriage B is placed in the designated area A1 stored in advance.
  • the cart B in the designated area A1 does not become an obstacle to the traveling of the mobile robot 1, but when the designated area A1 is used as a cart parking place, the detected one can be regarded as the cart B.
  • the carriage B can be automatically transported to a designated transport destination by pulling it.
  • the mobile robot 1 when the mobile robot 1 is doing other work or is moving to another place, it can be communicated to the host controller outside by communication that the cart B has been found. . Note that if something different from the cart is placed depending on the size of the object, it can be determined.
  • FIG. 5D shows a state in which it is determined that an object exists in areas other than the travel areas 1, 2, 3 and the designated area. While the presence of the “object” is determined, an object that is neither in the traveling area nor in the designated area and is not a map object is determined as another object and processed.
  • the position identifying means 7 for identifying the object provided in the surrounding environment by the reflected light of the irradiated laser beam and estimating the position and angle of the mobile robot 1 arranged to be movable in the surrounding environment. 2
  • the map data of the surrounding environment where the mobile robot 1 travels is stored, the laser distance sensor 6 that measures the distance from the mobile robot 1 to the object provided in the surrounding environment, and the laser distance sensor 6 measures the distance.
  • Means for discriminating an object provided in the surrounding environment based on the distance data from the mobile robot 1 to the object and map data travel area storage means 12 for storing the travel area of the mobile robot 1,
  • the specified area storage means 13 as a specific area storage means for storing a specific area different from the travel area, and the mobile robot 1 stored in the travel area storage means 12
  • An object determination unit for determining whether or not an object is placed in a designated area that is stored in a row area or in a specified area that is stored in a specified area storage unit that is a specific area storage unit; is there.
  • the distance data and the map data 10 are collated again based on the estimated position and orientation, so that the distance data can be easily matched with the map data 10, the object on the traveling area, or in the specific area.
  • the mobile robot is controlled based on short distance data indicating that it is approaching among the distance data, but the type of the approaching distance data can be provided as information, so that the mobile robot 1 Can determine whether to decelerate and stop, so that the mobile robot 1 can be controlled better.
  • the position identification means 7 of the present embodiment performs the measurement of the distance from the mobile robot 1 to the object by the laser distance sensor 6 a plurality of times, and based on the plurality of distance data obtained by the plurality of measurements, the object is identified. It is possible to classify whether it is a moving body or a stationary body. Further, the control device determines that the mobile robot 1 has approached the object based on the distance data, and determines the travel route based on the determination as to whether or not the object determined by the object determination means 14 is placed in the travel region. change. Further, the control device decelerates the mobile robot 1 when determining that the mobile robot 1 has approached the object based on the distance data, and stops before the mobile robot 1 is collided with the object. When the approaching object matches the map data 10, the object can be regarded as a stationary object or a stationary object, so that the rate of deceleration of the traveling speed can be reduced as long as safe traveling can be guaranteed. It is.

Landscapes

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

Abstract

 移動ロボット(1)の位置を推定する位置同定手段(7)において、移動ロボット(1)から物体までの距離を測定するレーザ距離センサ(6)と、測定された移動ロボット(1)から物体までの距離データと地図データとにより物体を判別する手段と、移動ロボット(1)の走行領域を記憶する走行領域記憶手段(12)と、移動ロボット(1)の走行領域とは別の指定領域を記憶する指定領域記憶手段(13)と、走行領域記憶手段(12)に記憶された移動ロボット(1)の走行領域内に物体が置かれているのか否かの判定をする物体判定手段(14)とを備える。

Description

位置同定装置、及びそれを備えた移動ロボット
 本発明は、距離センサで測定された周辺環境の距離データと周辺環境の地図データとにより、地図上の移動体の位置及び角度を推定する位置同定装置、及びそれを備えた移動体に関するものである。本明細書においては、「移動体」という用語と「移動ロボット」という用語を併用しているが、「移動ロボット」は「移動体」の一実施形態として用いているが、発明思想として実質的な相違はない。
 従来、レーザ距離センサで測定された距離データと地図データを用いて移動体の位置と角度を推定する位置姿勢推定装置が知られている。例えば、特許文献1(日本国特開2009-109200号公報)には、移動ロボットの自律移動制御等において利用される、実環境内における自己の位置姿勢を認識する技術に関し、特に、移動ロボットが目的地まで人の操作なしに自動的に到達することを目的とし、移動ロボットの位置姿勢を、移動ロボットに搭載された距離センサからのセンシングデータと、環境の幾何状況を示した二次元の環境地図とを用いて算出する技術が開示されている。
日本国特開2009-109200号公報
 上記特許文献1に記載されている技術では、距離センサによって測定されたセンシングデータと環境地図とをマッチングさせ、移動ロボットの位置姿勢を推定する方法が記載されているが、一般的なマッチング方法においては、データの処理量が膨大になり計算時間が長くなるといった問題があるため処理量の削減が望まれていた。そのため、位置姿勢を推定すること以外については、地図を利用した処理を行う提案はされてこなかった。
 本発明は、上記課題に鑑みてなされたものであり、予め設定させた所定領域(走行領域、指定領域等の特定領域)の範囲で、距離データと地図データとのマッチングを行うことにより、移動体の位置姿勢を推定するとともに、推定した位置姿勢を用いて、再度、距離データと地図データを照合することで、レーザ距離センサが照射した物体の種類を分類する位置同定装置及びそれを備えた移動ロボットを提供することを目的とする。
 本発明に係る位置同定装置は、照射するレーザ光の反射光により周囲環境に設けられた物体を識別し、周辺環境内で移動可能に配置された移動体の位置と角度を推定する位置同定装置において、前記移動体が走行する周辺環境の地図データを記憶しており、前記移動体から前記周囲環境に設けられた物体までの距離を測定する距離センサと、該距離センサにより測定された前記移動体から前記物体までの距離データと前記地図データとにより前記周囲環境に設けられた物体を判別する手段と、前記移動体の走行領域を記憶する走行領域記憶手段と、該走行領域記憶手段に記憶された前記移動体の走行領域内に前記物体が置かれているか否かを判定する物体判定手段と、を備えたことを特徴とする。
 本発明に係る位置同定装置は、照射するレーザ光の反射光により周囲環境に設けられた物体を識別し、周辺環境内で移動可能に配置された移動体の位置と角度を推定する位置同定装置において、前記移動体が走行する周辺環境の地図データを記憶しており、前記移動体から前記周囲環境に設けられた物体までの距離を測定する距離センサと、該距離センサにより測定された前記移動体から前記物体までの距離データと前記地図データとにより前記周囲環境に設けられた物体を判別する手段と、前記移動体の走行領域を記憶する走行領域記憶手段と、前記移動体の走行領域とは別の特定領域を記憶する特定領域記憶手段と、前記走行領域記憶手段に記憶された前記移動体の走行領域内又は前記特定領域記憶手段に記憶された前記特定領域内に前記物体が置かれているのか否かを判定する物体判定手段と、を備えたことを特徴とする。
 本発明に係る位置同定装置は、周囲の物体までの距離を測定する距離センサと、移動体が走行する周辺環境の地図データと前記距離センサで測定した距離データとを用いて前記移動体の位置と角度を推定する位置同定装置において、前記地図データの特定領域を記憶する特定領域記憶手段と、前記地図データと前記推定した位置と角度とを用いて、前記特定領域に物体が置かれているか否かを判定する物体判定手段と、を備えたことを特徴とする。
 本発明に係る位置同定装置は、前記距離センサによる前記移動体から前記物体までの距離の測定を複数回行い、該複数回の測定により得られた複数の前記距離データに基づき、前記物体が移動体であるのか静止体であるのかを分類することを特徴とする。
 本発明に係る移動ロボットは、前記位置同定装置と、自律走行を自動的に制御する制御装置と、を備えた移動ロボットにおいて、前記制御装置は、前記移動ロボットが前記物体に接近したことを前記距離データにより判断し、前記物体判定手段により判定された前記物体が前記走行領域内に置かれているか否かの判定に基づき、走行経路を変更することを特徴とする。
 本発明に係る移動ロボットにおいては、前記制御装置は、前記移動ロボットが前記物体に接近したことを前記距離データにより判断したときに、当該物体の分類により前記移動体の走行制限速度を変えることを特徴とする。
 本発明に係る移動ロボットにおいては、前記物体判定手段が前記特定領域内に前記物体が置かれているとして判定したとき、外部に通報する通信装置を備えたことを特徴とする。
 本発明に係る移動ロボットは、推定した位置、角度を基に、距離データを地図データと照合することにより、地図と一致する物体、走行通路上にある物体、地図の特定領域にある物体などに容易に分類することができ、障害物を避けながら、移動体を安全に且つ利便性を高めながら走行する制御システムを構築することができる。
図1は、本実施形態の移動ロボットの構成を示すブロック図である。 図2は、移動ロボットの走行経路と周囲環境の状態を示す説明図である。 図3Aは、周辺環境の地図データを示す説明図である。 図3Bは、地図データにおける移動ロボットの走行領域、指定領域を示す説明図である。 図4は、移動ロボットに構成されたレーザ距離センサから物体等に対しレーザを照射して物体を判別している状態を示す説明図である。 図5Aは、図3Aとの比較において移動ロボット1から見える地図物体までの距離の測定を行っている状態を示す説明図である。 図5Bは、予め記憶された走行領域内に物体Aが置かれていると判定された状態を示す説明図である。 図5Cは、予め記憶された指定領域A1内に台車Bが置かれていると判定された状態を示す説明図である。 図5Dは、走行領域1、2、3及び指定領域以外に物体が存在すると判定された状態を示す説明図である。
 図1は、本発明の一例に係る移動体としての移動ロボット1の構成を示すブロック図である。同図に示すように、移動ロボット1は、目標点指令装置9から出力された目標位置Xg,Yg、目標角度Θgが入力される相対位置演算部2と、相対位置演算部2から出力された制御指令dx,dy,dθが入力される制御指令部3と、制御指令部3から出力された走行速度指令、及び旋回速度指令が入力される走行制御部4と、走行制御部4から出力された左モータ速度指令、及び右モータ速度指令が夫々入力される走行手段たる左右モータ5と、移動ロボット1から後述する周辺環境(壁、装置、物体A等)までの距離を測定するレーザ距離センサ6と、周辺環境の地図データ10とレーザ距離センサ6で測定された周辺環境の距離データとから移動ロボット1の位置と角度を推定する位置同定手段7と、通報等のため外部と通信を行うための通信装置8とから構成されている。
 位置同定装置たる位置同定手段7には、移動ロボット1が走行する周辺環境の地図データ10を記憶しており、レーザ距離センサ6で測定された壁、装置、物体等の周辺環境までの位置情報と地図データ10とを照合するデータ照合部11を備えている。この位置同定手段7は、移動ロボット1と周囲環境との位置関係を推定するために、図3Bに示すように、「走行領域」と特定領域たる「指定領域」とに予め区域を分けている。「走行領域」とは、その名のとおり移動ロボット1が走行する領域であり、「指定領域」とは、台車や物体等の置き場である。そのために、位置同定手段7は、移動ロボット1の走行領域を記憶する走行領域記憶手段12と、移動ロボット1の走行領域以外の特定領域たる指定領域を記憶する特定領域記憶手段たる指定領域記憶手段13とを備えている。そして、レーザ距離センサ6で測定された壁、装置、物体等の周辺環境の情報から、物体判定手段14により「物体」の存在を判定する。さらに、走行領域記憶手段12及び指定領域記憶手段13からの各領域情報を参考にして、存在すると判定した「物体」が、地図物体であるか走行障害物体であるか指定領域物体であるかの処理を各処理部、地図物体近接判断部15、走行障害物体処理部16、指定領域物体処理部17において処理する。地図物体及び走行障害物体は、走行する移動ロボット1としては注意を払う必要があるので、車両速度制限演算部18に対して情報を出力し、車両速度制限演算部18での情報の演算に基づいて車両速度の制限を加える必要があると判断した場合には、制御指令部3に対して制限速度指令を出す。
 レーザ距離センサ6で測定された距離データは、地図データ10と照合されて移動ロボット1の位置及び角度のデータが求められる。データ照合部11で照合された後の移動ロボット1の位置及び角度のデータは、レーザ距離センサ6で測定された距離データ及び地図データ10と共に物体判定手段14に入力される。物体判定手段14では、前述のように、走行領域記憶手段12及び指定領域記憶手段13からの各領域情報を参考にして、存在すると判定した「物体」が、地図物体であるか走行障害物体であるか指定領域物体であるかを判定する。地図物体情報は地図物体近接判断部15で処理され、走行障害物体情報は走行障害物体処理部16で処理され、指定領域物体情報は指定領域物体処理部17において処理される。
 図2は、移動ロボット1の走行経路と周囲環境の状態を示す説明図である。同図に示すように、移動ロボット1が走行可能な周辺環境には、物体としての、壁、装置1~5、物体B、台車C、物体Cが存在する。ここで、物体Bは、点線で示した、移動ロボット1の走行経路にかかるように置かれており、台車Cは台車置場内に置かれている。すると、移動ロボット1は、点線で示した走行経路を走行する際に、物体Bに接触しないように物体Bを回避して走行することを目的としている。
 図3Aは周辺環境の地図データを示している。図3Bは地図データにおける移動ロボット1の走行領域1,2,3、及び指定領域A1を示している。図3Aの周辺環境の地図データは、予め記憶されているものである。図3Bの走行領域1,2,3及び指定領域A1は、ユーザの所定の操作により、走行領域記憶手段12及び指定領域記憶手段13に記憶することができる。
 図4は、移動ロボット1に構成されたレーザ距離センサ6から物体A,Bなどに対しレーザを照射して物体を判別している状態を示している。図4において矢印で表しているように、移動ロボット1のレーザ距離センサ6から照射されるレーザ光は、移動ロボット1の正面側を基準として、左右に90度の範囲、すなわち180度の範囲で照射される。そして、太い黒線で表しているように、反射光により物体A,Bや周辺環境の境界までの距離を測定することができる。図4に示されている検出状態は、レーザ距離センサ6の距離データと地図データ10をマッチング処理により照合して、移動ロボット1の位置と姿勢を推定した結果である。つまり、地図データ10と一致している距離データにより移動ロボット1の位置と姿勢を推定することができる。
 図4の位置推定結果を分類すると、図5A、図5B、図5C、図5Dのようになる。図5A、図5B、図5C、図5Dでは、距離データのうち、それぞれ太線で分類分けをしたことを示している。
 図5Aは図3Aに示す地図データ10と再度比較することにより、地図データ10と一致した距離データであることを示している。これらのデータは地図に記載されたものであることから、固定物あるいは静止物と見なすことができる。
 図5Bは予め記憶された走行領域内に物体Aが置かれていると判定された状態を示している。走行領域2内に存在する物体Aは、移動ロボット1の走行の障害となり得る。つまり、これから走行する予定の走行領域上に物体Aがあるため、予定している走行経路で走行すると、衝突する可能性があると判断される。なお、物体Aの概略の大きさは距離データにより推定することはできるが、それ以上の特定をするものではない。
 ここにおいて、走行領域記憶手段12に走行領域2が記憶されている場合においては、図4で示すように、存在が判定された「物体」から、走行領域2内に存在する「物体」を抽出する。実施例においては、走行領域が3箇所設定されているが、走行領域内に存在する「物体」の判別は、移動ロボット1が当該走行領域内に侵入する際に行えばよい。つまり、走行領域1内に存在する「物体」の判別は、入り口からこのエリア内に入る際に行い、走行領域3内に存在する「物体」の判別は、走行領域2の終端から走行領域3に入るまでに行うことも可能である。また、走行中に、走行領域に侵入してくる場合には、それにも対応する必要がある。
 図5Cは予め記憶された指定領域A1内に台車Bが置かれていると判定された状態を示している。指定領域A1内の台車Bは、移動ロボット1の走行の障害とはならないが、この指定領域A1を台車置場として運用する場合には、検出されたものを台車Bと見なすことができる。これにより、台車置場である指定領域A1に台車があれば、移動ロボット1で台車を搬送することを要求していることを意味している。従って、検出した移動ロボット1が他の作業をしていない場合には、それを牽引して指定される搬送先まで台車Bを自動的に搬送することができる。また、移動ロボット1が他の仕事をしている場合、あるいは、他の場所に移動中である場合には、台車Bを発見したことを通信により外部にある上位制御装置に連絡することもできる。なお、物体の大きさにより、台車と異なるものが置かれた場合には、それを判断することも可能である。
 図5Dは走行領域1、2、3及び指定領域以外に物体が存在すると判定された状態を示している。「物体」の存在が判別されながら、走行領域内にも指定領域内にも存在しなく、地図物体でもない物体は、他の物として判断され、処理される。
 以上の構成によれば、照射するレーザ光の反射光により周囲環境に設けられた物体を識別し、周辺環境内で移動可能に配置された移動ロボット1の位置と角度を推定する位置同定手段7において、移動ロボット1が走行する周辺環境の地図データを記憶しており、移動ロボット1から前記周辺環境に設けられた物体までの距離を測定するレーザ距離センサ6と、該レーザ距離センサ6により測定された移動ロボット1から物体までの距離データと地図データとにより前記周辺環境に設けられた物体を判別する手段と、移動ロボット1の走行領域を記憶する走行領域記憶手段12と、移動ロボット1の走行領域とは別の特定領域を記憶する特定領域記憶手段たる指定領域記憶手段13と、走行領域記憶手段12に記憶された移動ロボット1の走行領域内又は特定領域記憶手段たる指定領域記憶手段13に記憶された特定領域内たる指定領域内に、物体が置かれているのか否かの判定をする物体判定手段14とを備えたものである。これにより、推定した位置と姿勢を基に、距離データと地図データ10を再度照合することで、簡単に、距離データを地図データ10と一致する物体、走行領域上にある物体、特定領域にある物体、その他の領域にある物体に分類することができる。従来、距離データのうち、接近していることを示す短い距離データを基に移動ロボットの制御を行っていたことに対して、その接近した距離データの種類を情報として提供できるので、移動ロボット1は減速・停止するべきかを判断できるため、より優れた移動ロボット1の制御を行うことができる。
 また、本実施形態の位置同定手段7は、レーザ距離センサ6による移動ロボット1から物体までの距離の測定を複数回行い、該複数回の測定により得られた複数の距離データに基づき、物体が移動体であるのか静止体であるのかを分類することができる。さらに、制御装置は、移動ロボット1が物体に接近したことを距離データにより判断し、物体判定手段14により判定された物体が走行領域内に置かれているか否かの判定に基づき、走行経路を変更する。さらに、制御装置は、移動ロボット1が物体に接近したことを距離データにより判断しときに移動ロボット1を減速させ、該移動ロボット1が物体に衝突される前に停止する。なお、接近した物体が地図データ10と一致する場合には、その物体は静止物、あるいは、停止物と見なせるので、安全走行が保証できる範囲で、走行速度の減速する割合を少なくすることも可能である。
 1 移動ロボット
 2 相対位置演算部
 3 制御指令部
 4 走行制御部
 5 左右モータ
 6 レーザ距離センサ(距離センサ)
 7 位置同定手段(位置同定装置)
 8 通信装置
 9 目標点指令装置
 10 地図データ
 11 データ照合部
 12 走行領域記憶手段
 13 指定領域記憶手段(特定領域記憶手段)
 14 物体判定手段
 15 地図物体近接判断部
 16 走行障害物体処理部
 17 指定領域物体処理部
 18 車両速度制限演算部

Claims (10)

  1.  照射するレーザ光の反射光により周囲環境に設けられた物体を識別し、周辺環境内で移動可能に配置された移動体の位置と角度を推定する位置同定装置において、前記移動体が走行する周辺環境の地図データを記憶しており、前記移動体から前記周囲環境に設けられた物体までの距離を測定する距離センサと、該距離センサにより測定された前記移動体から前記物体までの距離データと前記地図データとにより前記周囲環境に設けられた物体を判別する手段と、前記移動体の走行領域を記憶する走行領域記憶手段と、該走行領域記憶手段に記憶された前記移動体の走行領域内に前記物体が置かれているか否かを判定する物体判定手段と、を備えたことを特徴とする位置同定装置。
  2.  照射するレーザ光の反射光により周囲環境に設けられた物体を識別し、周辺環境内で移動可能に配置された移動体の位置と角度を推定する位置同定装置において、前記移動体が走行する周辺環境の地図データを記憶しており、前記移動体から前記周囲環境に設けられた物体までの距離を測定する距離センサと、該距離センサにより測定された前記移動体から前記物体までの距離データと前記地図データとにより前記周囲環境に設けられた物体を判別する手段と、前記移動体の走行領域を記憶する走行領域記憶手段と、前記移動体の走行領域とは別の特定領域を記憶する特定領域記憶手段と、前記走行領域記憶手段に記憶された前記移動体の走行領域内又は前記特定領域記憶手段に記憶された前記特定領域内に前記物体が置かれているのか否かを判定する物体判定手段と、を備えたことを特徴とする位置同定装置。
  3.  周囲の物体までの距離を測定する距離センサと、移動体が走行する周辺環境の地図データと前記距離センサで測定した距離データとを用いて前記移動体の位置と角度を推定する位置同定装置において、前記地図データの特定領域を記憶する特定領域記憶手段と、前記地図データと前記推定した位置と角度とを用いて、前記特定領域に物体が置かれているか否かを判定する物体判定手段と、を備えたことを特徴とする位置同定装置。
  4.  請求項1に記載の位置同定装置において、前記距離センサによる前記移動体から前記物体までの距離の測定を複数回行い、該複数回の測定により得られた複数の前記距離データに基づき、前記物体が移動体であるのか静止体であるのかを分類することを特徴とする位置同定装置。
  5.  請求項2に記載の位置同定装置において、前記距離センサによる前記移動体から前記物体までの距離の測定を複数回行い、該複数回の測定により得られた複数の前記距離データに基づき、前記物体が移動体であるのか静止体であるのかを分類することを特徴とする位置同定装置。
  6.  請求項3に記載の位置同定装置において、前記距離センサによる前記移動体から前記物体までの距離の測定を複数回行い、該複数回の測定により得られた複数の前記距離データに基づき、前記物体が移動体であるのか静止体であるのかを分類することを特徴とする位置同定装置。
  7.  請求項1乃至3の何れか1項に記載の位置同定装置と、自律走行を自動的に制御する制御装置と、を備えた移動ロボットにおいて、前記制御装置は、前記移動ロボットが前記物体に接近したことを前記距離データにより判断し、前記物体判定手段により判定された前記物体が前記走行領域内に置かれているか否かの判定に基づき、走行経路を変更することを特徴とする移動ロボット。
  8.  請求項7に記載の移動ロボットにおいて、前記制御装置は、前記移動ロボットが前記物体に接近したことを前記距離データにより判断したときに、当該物体の分類により前記移動体の走行制限速度を変えることを特徴とする移動ロボット。
  9.  請求項5において、前記物体判定手段が前記特定領域内に前記物体が置かれているとして判定したとき、外部に通報する通信装置を備えたことを特徴とする移動ロボット。
  10.  請求項6において、前記物体判定手段が前記特定領域内に前記物体が置かれているとして判定したとき、外部に通報する通信装置を備えたことを特徴とする移動ロボット。
PCT/JP2014/055386 2013-03-29 2014-03-04 位置同定装置、及びそれを備えた移動ロボット Ceased WO2014156502A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201480019286.6A CN105074602B (zh) 2013-03-29 2014-03-04 位置识别装置和具有该位置识别装置的移动机器人
US14/778,145 US9804605B2 (en) 2013-03-29 2014-03-04 Position identification device and mobile robot provided with same

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2013072203A JP2014197294A (ja) 2013-03-29 2013-03-29 位置同定装置、及びそれを備えた移動ロボット
JP2013-072203 2013-03-29

Publications (1)

Publication Number Publication Date
WO2014156502A1 true WO2014156502A1 (ja) 2014-10-02

Family

ID=51623492

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2014/055386 Ceased WO2014156502A1 (ja) 2013-03-29 2014-03-04 位置同定装置、及びそれを備えた移動ロボット

Country Status (4)

Country Link
US (1) US9804605B2 (ja)
JP (1) JP2014197294A (ja)
CN (1) CN105074602B (ja)
WO (1) WO2014156502A1 (ja)

Families Citing this family (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104331078B (zh) * 2014-10-31 2017-01-11 东北大学 一种基于位置映射算法的多机器人协作定位方法
JP6636260B2 (ja) * 2015-04-21 2020-01-29 Cyberdyne株式会社 自律移動体の走行経路教示システムおよび走行経路教示方法
DE102015109775B3 (de) 2015-06-18 2016-09-22 RobArt GmbH Optischer Triangulationssensor zur Entfernungsmessung
DE102015114883A1 (de) 2015-09-04 2017-03-09 RobArt GmbH Identifizierung und Lokalisierung einer Basisstation eines autonomen mobilen Roboters
DE102015119501A1 (de) 2015-11-11 2017-05-11 RobArt GmbH Unterteilung von Karten für die Roboternavigation
DE102015119865B4 (de) 2015-11-17 2023-12-21 RobArt GmbH Robotergestützte Bearbeitung einer Oberfläche mittels eines Roboters
JP2017111790A (ja) * 2015-12-10 2017-06-22 パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカPanasonic Intellectual Property Corporation of America 移動制御方法、自律移動ロボット及びプログラム
DE102015121666B3 (de) 2015-12-11 2017-05-24 RobArt GmbH Fernsteuerung eines mobilen, autonomen Roboters
CN108475060B (zh) * 2016-02-05 2021-04-09 株式会社日立产机系统 位置检测装置、控制装置和移动体
DE102016102644A1 (de) 2016-02-15 2017-08-17 RobArt GmbH Verfahren zur Steuerung eines autonomen mobilen Roboters
JP6711138B2 (ja) * 2016-05-25 2020-06-17 村田機械株式会社 自己位置推定装置、及び、自己位置推定方法
JP6801243B2 (ja) * 2016-06-13 2020-12-16 村田機械株式会社 移動目標決定装置、及び、移動目標決定方法
CN106227204B (zh) * 2016-07-08 2020-03-10 百度在线网络技术(北京)有限公司 车载装置及用于控制无人驾驶车辆的系统、方法和装置
WO2018024897A1 (de) 2016-08-05 2018-02-08 RobArt GmbH Verfahren zur steuerung eines autonomen mobilen roboters
WO2018098659A1 (zh) * 2016-11-30 2018-06-07 深圳前海达闼云端智能科技有限公司 控制机器人的方法、装置、服务器及机器人
JP2020509500A (ja) 2017-03-02 2020-03-26 ロブアート ゲーエムベーハーROBART GmbH 自律移動ロボットの制御方法
JP6767567B2 (ja) * 2017-03-28 2020-10-14 株式会社日立産機システム 地図作成システム及びロボットシステム
DE102017109219A1 (de) 2017-04-28 2018-10-31 RobArt GmbH Verfahren für die Roboternavigation
CN106983454B (zh) * 2017-05-12 2020-11-20 北京小米移动软件有限公司 扫地机器人清扫方法及扫地机器人
JP2019086812A (ja) * 2017-11-01 2019-06-06 株式会社日立産機システム 移動体システム
WO2019119222A1 (zh) * 2017-12-18 2019-06-27 深圳市大疆创新科技有限公司 障碍物信息提示方法、系统、设备、装置及记录介质
CN108344414A (zh) * 2017-12-29 2018-07-31 中兴通讯股份有限公司 一种地图构建、导航方法及装置、系统
CN108303986B (zh) * 2018-03-09 2021-02-26 哈工大机器人(昆山)有限公司 一种激光slam导航的临时障碍物处理方法
GB2609381B (en) * 2018-03-27 2024-04-17 Roberto Molina Cabrera Pablo Safety systems for semi-autonomous devices and methods of using the same
JP7176241B2 (ja) * 2018-06-15 2022-11-22 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
US11409306B2 (en) * 2018-08-14 2022-08-09 Chiba Institute Of Technology Movement robot
JP7221549B2 (ja) * 2018-12-17 2023-02-14 学校法人千葉工業大学 情報処理装置および移動ロボット
JP7107278B2 (ja) * 2019-05-13 2022-07-27 トヨタ自動車株式会社 自律移動装置制御システム
JP7221839B2 (ja) * 2019-10-08 2023-02-14 国立大学法人静岡大学 自律移動ロボットおよび自律移動ロボットの制御プログラム
CN111079607A (zh) * 2019-12-05 2020-04-28 灵动科技(北京)有限公司 具有追踪功能的自动驾驶系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05205198A (ja) * 1992-01-29 1993-08-13 Mazda Motor Corp 車両の障害物検出装置
JP2004280451A (ja) * 2003-03-14 2004-10-07 Matsushita Electric Works Ltd 自律移動装置
JP2007200070A (ja) * 2006-01-27 2007-08-09 Secom Co Ltd 移動ロボット
JP2008200770A (ja) * 2007-02-16 2008-09-04 Toshiba Corp ロボットおよびその制御方法
JP2012256344A (ja) * 2012-08-06 2012-12-27 Hitachi Industrial Equipment Systems Co Ltd ロボットシステム

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5461357A (en) 1992-01-29 1995-10-24 Mazda Motor Corporation Obstacle detection device for vehicle
DE19950033B4 (de) * 1999-10-16 2005-03-03 Bayerische Motoren Werke Ag Kameravorrichtung für Fahrzeuge
DE10231362A1 (de) * 2002-07-11 2004-01-22 Robert Bosch Gmbh Vorrichtung zur Umfeldüberwachung in einem Fahrzeug
JP5056468B2 (ja) * 2007-02-22 2012-10-24 富士通株式会社 巡回ロボット及び巡回ロボットの自律走行方法
JP2009109200A (ja) 2007-10-26 2009-05-21 Hitachi Ltd 位置姿勢推定システム、位置姿勢推定装置、および位置姿勢推定方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05205198A (ja) * 1992-01-29 1993-08-13 Mazda Motor Corp 車両の障害物検出装置
JP2004280451A (ja) * 2003-03-14 2004-10-07 Matsushita Electric Works Ltd 自律移動装置
JP2007200070A (ja) * 2006-01-27 2007-08-09 Secom Co Ltd 移動ロボット
JP2008200770A (ja) * 2007-02-16 2008-09-04 Toshiba Corp ロボットおよびその制御方法
JP2012256344A (ja) * 2012-08-06 2012-12-27 Hitachi Industrial Equipment Systems Co Ltd ロボットシステム

Also Published As

Publication number Publication date
CN105074602A (zh) 2015-11-18
CN105074602B (zh) 2018-10-26
US20160282873A1 (en) 2016-09-29
JP2014197294A (ja) 2014-10-16
US9804605B2 (en) 2017-10-31

Similar Documents

Publication Publication Date Title
WO2014156502A1 (ja) 位置同定装置、及びそれを備えた移動ロボット
CN102782600B (zh) 自动移动体及其控制方法
JP6072934B2 (ja) 移動ロボットシステム
CN116872921A (zh) 一种车辆规避风险方法、系统、车辆及存储介质
CN102385383B (zh) 行驶车以及行驶车的控制方法
EP4001042B1 (en) System and method for predicting road collisions with a host vehicle
CN111095384A (zh) 信息处理设备、自主移动设备、方法和程序
CN111095382B (zh) 用于为车辆识别碰撞的方法和设备
KR20200084938A (ko) 차량 동작 계획방법 및 그를 위한 장치
CN113544538A (zh) 使用速度和位置信息识别雷达反射
US10388164B2 (en) Method and system for detecting an unoccupied region within a parking facility
US20230022637A1 (en) Information processing apparatus, information processing method, and program
JP7411185B2 (ja) 通行人追従型の移動ロボットの誘導
JP7040673B2 (ja) 移動体の誘導制御装置および誘導制御システム
JPWO2016009585A1 (ja) 自律移動体とその制御方法
JP6412207B2 (ja) 位置同定装置
KR102324989B1 (ko) 이동체, 관리 서버 및 그 동작 방법
JP2012168990A (ja) 自律移動装置
CN115893125B (zh) 机器人进电梯的控制方法、控制装置和机器人
KR20210037955A (ko) 이동 객체 추적 장치 및 방법
KR102171934B1 (ko) 양방향 선도 추미 대차
JP2022045003A (ja) 自己位置推定システム
Halldén et al. Obstacle circumvention by automated guided vehicles in industrial environments
JP6687313B1 (ja) 搬送システム
JP2015056123A (ja) 移動体の環境地図生成制御装置、移動体、及び移動体の環境地図生成方法

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 201480019286.6

Country of ref document: CN

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

Ref document number: 14774952

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 14778145

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 14774952

Country of ref document: EP

Kind code of ref document: A1