Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7600649B2 - Transport System - Google Patents
[go: Go Back, main page]

JP7600649B2 - Transport System - Google Patents

Transport System Download PDF

Info

Publication number
JP7600649B2
JP7600649B2 JP2020201284A JP2020201284A JP7600649B2 JP 7600649 B2 JP7600649 B2 JP 7600649B2 JP 2020201284 A JP2020201284 A JP 2020201284A JP 2020201284 A JP2020201284 A JP 2020201284A JP 7600649 B2 JP7600649 B2 JP 7600649B2
Authority
JP
Japan
Prior art keywords
information
transport robot
transport
self
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2020201284A
Other languages
Japanese (ja)
Other versions
JP2022089062A (en
Inventor
祐二 川元
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Omron Corp
Original Assignee
Omron Corp
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 Omron Corp filed Critical Omron Corp
Priority to JP2020201284A priority Critical patent/JP7600649B2/en
Priority to PCT/JP2021/008292 priority patent/WO2022118488A1/en
Publication of JP2022089062A publication Critical patent/JP2022089062A/en
Application granted granted Critical
Publication of JP7600649B2 publication Critical patent/JP7600649B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G1/00Storing articles, individually or in orderly arrangement, in warehouses or magazines
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Warehouses Or Storage Devices (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、搬送ロボットを備えた搬送システムに関する。 The present invention relates to a transport system equipped with a transport robot.

工場や倉庫等において利用される、無人搬送車(AGV:Automated Guided Vehicle)や、無人フォークリフト(AGF:Automated Guided Forklift)等の、自走式の搬送ロボットが提案されている。複数台のこのような搬送ロボットが、無線通信を通じて制御装置により制御されて、工場等における搬送の自動化を実現する搬送システムが構成されている。 Self-propelled transport robots, such as automated guided vehicles (AGVs) and automated guided forklifts (AGFs), have been proposed for use in factories, warehouses, etc. A transport system that realizes the automation of transport in factories, etc., is configured by controlling multiple such transport robots by a control device via wireless communication.

特開2019-48689号公報JP 2019-48689 A

LiDAR(Light Detection And Ranging)やステレオカメラ等の距離センサから得られる、距離情報に基づいて自身の位置を把握する搬送ロボットも検討されている。このような搬送ロボットは、工場や倉庫等の床面にあらかじめ決められた走行ルートを示すガイドを設置することを要せずに、自律的に走行ルートを判断する。 Transport robots that can determine their own position based on distance information obtained from distance sensors such as LiDAR (Light Detection And Ranging) and stereo cameras are also being considered. Such transport robots can autonomously determine their travel route without the need to install guides showing predetermined travel routes on the floor of a factory, warehouse, etc.

よってこのような搬送ロボットを適用すれば、工場や倉庫での多種多様な搬送作業への対応や、ラインの変更に対しての柔軟な対応が可能な、フレキシブルな搬送システムを構築できるメリットがある。しかし、自律的に走行ルートを判断する搬送ロボットが適用された搬送システムでは、ガイドに沿って決められたルートのみを走行する搬送ロボットが適用された搬送システムと比較すると、搬送ロボットの位置の把握の精度を高めることが難しい課題がある。 The application of such transport robots therefore has the advantage of enabling the creation of a flexible transport system that can handle a wide variety of transport tasks in factories and warehouses and can flexibly respond to changes in production lines. However, in transport systems that use transport robots that autonomously determine their travel route, it is difficult to improve the accuracy of determining the transport robot's position compared to transport systems that use transport robots that only travel along predetermined routes following guides.

本発明は、一側面では、このような実情を鑑みてなされたものであり、自律的に走行ルートを判断する搬送ロボットが適用された搬送システムにおいて、搬送ロボットの位置の把握の精度を高めることを目的とする。 In one aspect, the present invention has been made in consideration of the above-mentioned circumstances, and aims to improve the accuracy of determining the position of a transport robot in a transport system that employs a transport robot that autonomously determines its travel route.

本発明は、上述の課題を解決するために、以下の構成を採用する。本発明の一側面に係る搬送システムは、自走式の複数の搬送ロボットと、複数の前記搬送ロボットとの間で通信を行う制御装置とを備え、前記搬送ロボットは、周囲の物体への距離を検知し、距離情報として出力するセンサと、前記距離情報を用いて自己の位置に関する自己位置情報を算出する自己位置算出部と、を有し、前記制御装置は、複数の前記搬送ロボットから、それぞれの前記自己位置情報と、前記距離情報とを取得する固有状態取得部と、前記搬送ロボットから取得した前記自己位置情報と、当該搬送ロボット以外の前記搬送ロボットから取得した前記距離情報に含まれる当該搬送ロボットの位置に関する情報とを用いて、当該搬送ロボットの位置に関する推定位置情報を算出する推定位置算出部と、当該搬送ロボットの推定位置を、当該搬送ロボットに報知する推定位置送信部と、を有する。 The present invention employs the following configuration to solve the above-mentioned problems. A transport system according to one aspect of the present invention includes a plurality of self-propelled transport robots and a control device that communicates with the plurality of transport robots. The transport robot has a sensor that detects the distance to a surrounding object and outputs the distance information, and a self-position calculation unit that calculates self-position information related to its own position using the distance information. The control device has an inherent state acquisition unit that acquires the self-position information and the distance information from each of the plurality of transport robots, an estimated position calculation unit that calculates estimated position information related to the position of the transport robot using the self-position information acquired from the transport robot and information related to the position of the transport robot included in the distance information acquired from the transport robot other than the transport robot, and an estimated position transmission unit that notifies the transport robot of the estimated position of the transport robot.

上記構成によれば、自律的に走行ルートを判断する搬送ロボットが適用された搬送システムにおいて、搬送ロボットの位置の把握の精度を高めることができるようになる。 The above configuration makes it possible to improve the accuracy of determining the position of a transport robot in a transport system that employs a transport robot that autonomously determines its travel route.

上記一側面に係る搬送システムにおいて、前記推定位置算出部は、当該搬送ロボット以外の前記搬送ロボットから取得した前記自己位置情報を併せて用いて、前記推定位置情報を算出してもよい。上記構成によれば、推定位置算出部による推定位置情報の算出方法が、より具体化される。 In the transport system according to the above aspect, the estimated position calculation unit may calculate the estimated position information by also using the self-position information acquired from a transport robot other than the transport robot. According to the above configuration, the method of calculating the estimated position information by the estimated position calculation unit is made more specific.

上記一側面に係る搬送システムにおいて、前記自己位置情報及び前記推定位置情報は、それぞれ前記搬送ロボットが走行する床面上の位置についての情報と、前記搬送ロボットの向きについての情報とを含んでいてもよい。上記構成によれば、自己位置情報及び前記推定位置情報の内容がより具体化される。 In the transport system according to the above aspect, the self-location information and the estimated location information may each include information about the position on the floor surface where the transport robot is traveling and information about the orientation of the transport robot. With the above configuration, the content of the self-location information and the estimated location information is made more specific.

上記一側面に係る搬送システムにおいて、前記搬送ロボットは更に、走行を行うための走行機構部と、前記走行機構部を制御するとともに、前記搬送ロボットのオドメトリデータを算出する走行制御部と、を有し、前記自己位置算出部は、前記オドメトリデータと、前記距離情報とに基づいて、前記自己位置情報を算出する構成を備えていてもよい。上記構成によれば、自己位置算出部による自己位置情報の算出方法が、より具体化される。 In the transport system according to the above aspect, the transport robot may further have a travel mechanism for travelling, and a travel control unit for controlling the travel mechanism and calculating odometry data of the transport robot, and the self-position calculation unit may be configured to calculate the self-position information based on the odometry data and the distance information. According to the above configuration, the method of calculating the self-position information by the self-position calculation unit is more specific.

上記一側面に係る搬送システムにおいて、前記搬送ロボットは更に、当該搬送ロボットの識別情報を保持したスレーブ記憶部と、前記距離情報と、前記自己位置情報とを含む固有情報を、前記識別情報に付して送信する固有状態報知部と、を有し、前記固有状態取得部は、複数の前記搬送ロボットから、更に前記識別情報を取得する構成を備えていてもよい。上記構成によれば、制御装置の各部が搬送ロボットに関する情報を取り扱うに当たり、搬送ロボットの識別が容易にできるようになる。 In the transport system according to one aspect described above, the transport robot may further include a slave storage unit that stores identification information of the transport robot, and a unique state notification unit that transmits unique information including the distance information and the self-position information attached to the identification information, and the unique state acquisition unit may further acquire the identification information from a plurality of the transport robots. With the above configuration, the transport robots can be easily identified when each unit of the control device handles information related to the transport robot.

本発明の各態様に係る制御装置は、コンピュータによって実現してもよく、この場合には、コンピュータを前記制御装置が備える各部(ソフトウェア要素)として動作させることにより前記制御装置をコンピュータにて実現させる制御装置の制御プログラム、およびそれを記録したコンピュータ読み取り可能な記録媒体も、本発明の範疇に入る。 The control device according to each aspect of the present invention may be realized by a computer. In this case, the control program of the control device that causes the computer to operate as each unit (software element) of the control device to realize the control device on the computer, and the computer-readable recording medium on which the control program is recorded, also fall within the scope of the present invention.

本発明の一側面によれば、自律的に走行ルートを判断する搬送ロボットが適用された搬送システムにおいて、搬送ロボットの位置の把握の精度が高められる。 According to one aspect of the present invention, in a transport system using a transport robot that autonomously determines its travel route, the accuracy of determining the position of the transport robot is improved.

本発明の実施形態に係る搬送システムの要部の構成を示すブロック図である。1 is a block diagram showing a configuration of a main part of a transport system according to an embodiment of the present invention. 本発明の実施形態に係る搬送システムの搬送ロボットの外形例を示す図である。1 is a diagram showing an example of an external shape of a transport robot of a transport system according to an embodiment of the present invention; 本発明の実施形態に係る搬送システムが適用される工場の例を模式的に示す、フロアマップである1 is a floor map diagrammatically illustrating an example of a factory to which a conveying system according to an embodiment of the present invention is applied; 搬送ロボットが距離センサを用いて周囲の物体を検知する方法を説明するための図である。1A and 1B are diagrams for explaining a method in which a transport robot detects surrounding objects using a distance sensor. 図4に表された事例において、搬送ロボットの距離センサが出力する距離情報をグラフとして表した図である。FIG. 5 is a graph showing distance information output by a distance sensor of the transport robot in the example shown in FIG. 4 . 搬送ロボットが距離センサを用いて周囲の物体を検知する方法を説明するための図である。障害物が監視エリア内に存在する状況を示す。1 is a diagram for explaining a method for the transport robot to detect surrounding objects using a distance sensor, and shows a situation in which an obstacle exists in a monitoring area. 図4に表された事例について、更に他の搬送ロボットが搬送ロボットの監視レンジ内に存在する場合の状況を示す図である。FIG. 5 is a diagram showing a situation in which another transport robot is present within the monitoring range of the transport robot in the example shown in FIG. 4. 図7に表された事例において、搬送ロボットの距離センサが出力する距離情報をグラフとして表した図である。FIG. 8 is a graph showing distance information output by a distance sensor of the transport robot in the example shown in FIG. 7 . 複数の他の搬送ロボットの監視レンジ内に、特定の搬送ロボットが存在している状況を示す図である。FIG. 13 is a diagram showing a situation in which a specific transport robot is present within the monitoring range of a plurality of other transport robots. 本発明の実施形態に係る搬送システムが実行する特徴的な動作を表すフローチャートである。4 is a flowchart illustrating a characteristic operation executed by the transport system according to the embodiment of the present invention.

〔実施形態〕
以下、本発明の一側面に係る実施の形態が、図面に基づいて説明される。
[Embodiment]
Hereinafter, an embodiment according to one aspect of the present invention will be described with reference to the drawings.

§1 適用例
図1を参照しつつ、本発明が適用される場面の一例が説明される。図1は、実施形態1に係る搬送システム1の構成を示すブロック図である。搬送システム1は、制御装置10と複数の自走式の搬送ロボット30とを備える。制御装置10は、複数の搬送ロボット30との間で通信を行い、それぞれの搬送ロボット30に指示を行う。
§1 Application Example An example of a situation in which the present invention is applied will be described with reference to Fig. 1. Fig. 1 is a block diagram showing the configuration of a transport system 1 according to the first embodiment. The transport system 1 includes a control device 10 and a plurality of self-propelled transport robots 30. The control device 10 communicates with the plurality of transport robots 30 and issues instructions to each of the transport robots 30.

図1において、搬送ロボット30は1台分について、内部構成が詳細に示されているが、他の搬送ロボット30についても同様の内部構成を備える。搬送ロボット30は、周囲の物体への距離を検知し、距離情報として出力する距離センサ36(センサ)と、前記距離情報を用いて自己の位置に関する自己位置情報を算出する自己位置算出部33を有している。 In FIG. 1, the internal configuration of one transport robot 30 is shown in detail, but the other transport robots 30 have a similar internal configuration. The transport robot 30 has a distance sensor 36 (sensor) that detects the distance to surrounding objects and outputs the distance information, and a self-position calculation unit 33 that uses the distance information to calculate self-position information regarding its own position.

制御装置10は、それぞれの搬送ロボット30から、前記自己位置情報と、前記距離情報とを取得する、固有状態取得部13を有している。制御装置10は、それぞれの搬送ロボット30から取得したそれぞれの前記距離情報に含まれる他の搬送ロボットの位置に関する情報と、当該他の搬送ロボットの自己位置情報とを用いて、当該他の搬送ロボットの位置に関する推定位置情報を算出する推定位置算出部を有する。更に制御装置10は当該他の搬送ロボットの推定位置を、当該他の搬送ロボットに報知する推定位置送信部を有する。 The control device 10 has a unique state acquisition unit 13 that acquires the self-position information and the distance information from each transport robot 30. The control device 10 has an estimated position calculation unit that calculates estimated position information regarding the position of the other transport robot using information regarding the position of the other transport robot contained in the distance information acquired from each transport robot 30 and the self-position information of the other transport robot. Furthermore, the control device 10 has an estimated position transmission unit that notifies the other transport robot of the estimated position of the other transport robot.

実施形態1に係る搬送システム1では、自走式の搬送ロボット30の位置に関する情報である推定位置情報が、制御装置10において、当該搬送ロボット30(以下、自機)により算出された自己位置情報のみならず、当該搬送ロボット30以外の搬送ロボット(以下、他機)からの前記距離情報にも基づいて算出される。 In the transport system 1 according to the first embodiment, the estimated position information, which is information relating to the position of the self-propelled transport robot 30, is calculated in the control device 10 based not only on the self-position information calculated by the transport robot 30 (hereinafter, the self-machine) but also on the distance information from transport robots other than the transport robot 30 (hereinafter, the other machines).

そうして、前記推定位置情報が、制御装置10から自機である当該搬送ロボット30に報知される。従って、搬送システム1では、搬送ロボット30についての自機の位置に関する推定が、自己位置情報よりも精度が高められた推定位置情報に基づいて行うことができるようになる。そのため、自走式の搬送ロボットの位置推定の精度が高められた搬送システムを実現することができる。 Then, the estimated position information is reported from the control device 10 to the transport robot 30, which is the transport robot itself. Therefore, in the transport system 1, the transport robot 30 can estimate its own position based on estimated position information that is more accurate than its own position information. This makes it possible to realize a transport system in which the accuracy of position estimation for a self-propelled transport robot is improved.

§2 構成例
<搬送システムの適用場面>
図2は本適用例に係る搬送システム1の搬送ロボット30の外観例を示した図である。図3は、本適用例に係る搬送システム1が適用され得る工場や倉庫等のエリアの一例である、工場100のフロアマップを模式的に示した図である。
§2 Configuration example <Application scene of the conveyor system>
Fig. 2 is a diagram showing an example of the appearance of the transport robot 30 of the transport system 1 according to this application example. Fig. 3 is a diagram showing a schematic floor map of a factory 100, which is an example of an area such as a factory or warehouse to which the transport system 1 according to this application example can be applied.

工場100内には、製品、半製品、部品、原材料、工具、治具、梱包材やそれらを収納するカセット等の、搬送対象物を搬送する自走式の搬送ロボット30が配備されている。更には、台車としての搬送ロボット上に、搬送対象物を把持する、ロボットアーム(マニピュレータ)が設けられた自走式の搬送ロボット30Mが、搬送システム1の一部として配備されていてもよい。 Within the factory 100, a self-propelled transport robot 30 is deployed to transport objects to be transported, such as finished products, semi-finished products, parts, raw materials, tools, jigs, packaging materials, and cassettes for storing them. Furthermore, a self-propelled transport robot 30M having a robot arm (manipulator) for grasping the objects to be transported mounted on the transport robot as a cart may be deployed as part of the transport system 1.

搬送ロボット30Mは搬送ロボット30の一例であり、以降の記述では、搬送ロボット30に包含されるものとする。搬送ロボット30の形態としては、無人搬送台車や、AGF、その他の形態の自走式搬送装置であってもよい。 The transport robot 30M is an example of the transport robot 30, and in the following description, it is included in the transport robot 30. The transport robot 30 may take the form of an unmanned transport vehicle, an AGF, or other self-propelled transport device.

工場100内には搬送対象物を載置し得る棚110が設置されている。また、工場100内には、搬送対象物に対して、あるいは搬送対象物を利用して、加工、組み立て、処理、検査等を実行するための生産設備も設置されている。搬送システム1の搬送ロボット30は、これらの設備間で、搬送対象物を搬送し得る。 In the factory 100, shelves 110 are installed on which the objects to be transported can be placed. In addition, in the factory 100, production equipment is also installed for performing processing, assembly, treatment, inspection, etc. on the objects to be transported or using the objects to be transported. The transport robot 30 of the transport system 1 can transport the objects to be transported between these facilities.

図3中に示されるように、それぞれの搬送ロボット30の位置は、工場100のフロア上に定義されたX-Y座標で表される。またそれぞれの搬送ロボット30の向きは、X-Y座標に対して定義された、角度θで表される。このようにそれぞれの搬送ロボット30の位置と向きが(X、Y、θ)のようにして表され得る。以下、本明細書において、搬送ロボットの位置に関する情報とは、このような搬送ロボットの位置と向き(X、Y、θ)に関する情報をいう。 As shown in FIG. 3, the position of each transport robot 30 is represented by XY coordinates defined on the floor of the factory 100. The orientation of each transport robot 30 is represented by an angle θ defined relative to the XY coordinates. In this way, the position and orientation of each transport robot 30 can be represented as (X, Y, θ). Hereinafter, in this specification, information relating to the position of the transport robot refers to information relating to the position and orientation (X, Y, θ) of such a transport robot.

<搬送システムの構成概要>
以下に、搬送システム1のより具体的な構成例と動作が説明される。図1に示されるように、搬送システム1は、制御装置10と複数の自走式の搬送ロボット30とを備える。制御装置10は、搬送システムサーバ(AMHSサーバ:Automated Material Handling System Server)等の名称で呼ばれることもある、搬送についての管理を担う情報処理システムである。
<Conveyor system configuration overview>
The following describes a more specific configuration example and operation of the transport system 1. As shown in Fig. 1, the transport system 1 includes a control device 10 and a plurality of self-propelled transport robots 30. The control device 10 is an information processing system that is responsible for managing transport and may also be called a transport system server (AMHS server: Automated Material Handling System Server) or the like.

制御装置10は、上位情報処理システム等からの指令に基づいて、搬送システム1中の搬送ロボット30に、より具体的に搬送の指示を送信する。制御装置10は、このような処理を実行し得る情報処理システムであればよく、物理的に一筐体に納められた装置である必要は無い。 The control device 10 transmits more specific transport instructions to the transport robot 30 in the transport system 1 based on commands from a higher-level information processing system, etc. The control device 10 need only be an information processing system capable of executing such processing, and does not need to be a device physically contained in a single housing.

搬送システム1が適用される場面が生産工場である場合、生産工場における製品の生産を管理する上位情報処理システムは、製造実行システムサーバ(MESサーバ:Manufacturing Execution System Server)と呼称されることがある。搬送システム1が適用される場面が物流倉庫である場合には、物流倉庫における保管品の入庫・出庫を管理する上位情報処理システムは、倉庫管理システムサーバ(WMSサーバ:Warehouse Management System Server)と呼称されることがある。 When the transport system 1 is applied to a production factory, the upper information processing system that manages the production of products in the production factory is sometimes called a manufacturing execution system server (MES server). When the transport system 1 is applied to a logistics warehouse, the upper information processing system that manages the entry and exit of stored items in the logistics warehouse is sometimes called a warehouse management system server (WMS server).

<搬送ロボットの構成>
図1に示されるように、搬送ロボット30は、指示受付部31、走行制御部32、自己位置算出部33、固有状態報知部34、推定位置取得部35の各機能ブロックを有する。また搬送ロボット30は、距離センサ36、スレーブ記憶部37、走行機構部38、スレーブ通信部39を有する。
<Configuration of the transport robot>
1 , the transport robot 30 has the following functional blocks: an instruction receiving unit 31, a travel control unit 32, a self-position calculation unit 33, a specific state notification unit 34, and an estimated position acquisition unit 35. The transport robot 30 also has a distance sensor 36, a slave storage unit 37, a travel mechanism unit 38, and a slave communication unit 39.

距離センサ36は、搬送ロボット30の前方側に配置されており、搬送ロボット30の走行方向前方を監視する。図2に示されるように、実施形態1の具体例において距離センサ36は、2台のLiDARからなり、その監視エリア内に存在する物体への距離を示す距離情報を取得できる。 The distance sensor 36 is disposed on the front side of the transport robot 30 and monitors the forward traveling direction of the transport robot 30. As shown in FIG. 2, in the specific example of embodiment 1, the distance sensor 36 is composed of two LiDARs and can obtain distance information indicating the distance to an object present within the monitoring area.

監視する領域は、例示として、搬送ロボット30の走行方向前方の正面から左右それぞれに120°程度までの範囲を含むものとすることができる。このような距離情報の事例は後述される。なお、距離情報は一般に距離画像と呼称されることもある。 The area to be monitored can, for example, include a range of approximately 120° to the left and right from the front in the direction of travel of the transport robot 30. Examples of such distance information will be described later. Note that distance information is also generally referred to as a distance image.

搬送ロボット30に配置されるLiDARの個数は、単数でも複数であってもよく、複数である場合に後方をも監視できるように配置されていてもよい。また、距離センサの種類は、LiDARに限られず、ステレオカメラあるいはToF(Time-of-Flight)カメラ等の距離画像を取得するセンサや、その他の手法によるものであってもよい。 The number of LiDARs placed on the transport robot 30 may be one or more, and if there are multiple LiDARs, they may be placed so that they can monitor the rear as well. In addition, the type of distance sensor is not limited to LiDAR, and may be a sensor that acquires distance images such as a stereo camera or a ToF (Time-of-Flight) camera, or one that uses other methods.

スレーブ記憶部37は、搬送ロボット30に設けられた記録装置である。スレーブ記憶部37は、搬送ロボット30の識別情報、工場100のフロア内のマップ情報を保持する他、搬送ロボット30が走行を実行するために必要な各種情報や走行履歴、搬送ロボット30の制御プログラム等を適宜保持する。 The slave memory unit 37 is a recording device provided in the transport robot 30. The slave memory unit 37 stores identification information for the transport robot 30 and map information for the floor of the factory 100, as well as various information and driving history necessary for the transport robot 30 to perform driving, the control program for the transport robot 30, etc., as appropriate.

走行機構部38は、走行制御部32の制御により動作する、搬送ロボット30が床面上を走行するための機構部である。図2の搬送ロボット30の外観図において、走行機構部38の一部である車輪38Aが示されている。 The travel mechanism 38 is a mechanism that operates under the control of the travel control unit 32 and allows the transport robot 30 to travel on the floor surface. In the external view of the transport robot 30 in Figure 2, wheels 38A, which are part of the travel mechanism 38, are shown.

スレーブ通信部39は、搬送ロボット30が制御装置10との間で通信を行うための通信インターフェースである。スレーブ通信部39を通じて行う搬送ロボット30との通信には、リアルタイムの距離情報が含まれるため、高速低遅延かつ多接続であることが好ましい。そのため、スレーブ通信部39は、制御装置10のマスタ通信部19との間で、5G(5th Generation)通信、あるいはWi-Fi6通信を行うものであることが好ましい(Wi Fi:登録商標)。図2の搬送ロボット30の外観図において、スレーブ通信部39の一部であるアンテナ39Aが示されている。 The slave communication unit 39 is a communication interface through which the transport robot 30 communicates with the control device 10. Since real-time distance information is included in the communication with the transport robot 30 via the slave communication unit 39, it is preferable that the communication is high speed, has low latency, and has multiple connections. Therefore, it is preferable that the slave communication unit 39 communicates with the master communication unit 19 of the control device 10 using 5G (5th Generation) communication or Wi-Fi 6 (Wi-Fi: registered trademark). In the external view of the transport robot 30 in Figure 2, an antenna 39A that is part of the slave communication unit 39 is shown.

指示受付部31は、スレーブ通信部39を介して制御装置10からの指示を受け付ける機能ブロックである。走行制御部32は、走行機構部38を制御し、搬送ロボット30を走行させる機能ブロックである。走行制御部32はまた、走行機構部38からの各機構の動作情報、具体的にはモータのロータリエンコーダ出力等に基づいて、オドメトリデータを算出する。オドメトリデータとは、ある時点の搬送ロボット30の位置に対する、走行時あるいは走行後の位置を相対的に示す情報である。 The instruction receiving unit 31 is a functional block that receives instructions from the control device 10 via the slave communication unit 39. The driving control unit 32 is a functional block that controls the driving mechanism unit 38 and drives the transport robot 30. The driving control unit 32 also calculates odometry data based on operation information of each mechanism from the driving mechanism unit 38, specifically, the rotary encoder output of the motor, etc. The odometry data is information that indicates the position of the transport robot 30 during or after driving relative to the position of the transport robot 30 at a certain point in time.

自己位置算出部33は、搬送ロボット30の概略位置をオドメトリデータにより算出し、更に距離情報と、概略位置付近のマップ情報との比較から搬送ロボット30の自己位置に関する自己位置情報を算出する機能ブロックである。固有状態報知部34は搬送ロボット30の固有情報を、スレーブ通信部39を介して制御装置10に報知する機能ブロックである。推定位置取得部35は、制御装置10からスレーブ通信部39を介して推定位置情報を取得する機能ブロックである。推定位置情報については後述される。 The self-position calculation unit 33 is a functional block that calculates the approximate position of the transport robot 30 using odometry data, and further calculates self-position information regarding the self-position of the transport robot 30 by comparing the distance information with map information near the approximate position. The unique state notification unit 34 is a functional block that notifies the control device 10 of the unique information of the transport robot 30 via the slave communication unit 39. The estimated position acquisition unit 35 is a functional block that acquires estimated position information from the control device 10 via the slave communication unit 39. The estimated position information will be described later.

ここで、固有情報とは、個別の搬送ロボット30自身に関わる固有状態についての情報をいい、距離情報と、自己位置情報とを含む。更には、例えば、搬送ロボット30の動作の状態、搬送対象物の積載の状態、バッテリー残量等、搬送ロボット30の動作や、その他の内部状態に関する情報を含んでいてもよい。 The unique information here refers to information about the unique state of each individual transport robot 30 itself, and includes distance information and self-position information. Furthermore, it may include information about the operation of the transport robot 30 and other internal states, such as the operating state of the transport robot 30, the loading state of the transport object, and the remaining battery level.

搬送ロボット30は、基本的な動作として、制御装置10からの指示に従い、以下のようにして所要の搬送を実行する。指示受付部31が、スレーブ通信部39を介して制御装置10からの搬送の指示を受け付ける。走行制御部32が、自己位置に関する情報と、搬送の指示に含まれる搬送先の位置情報に基づいて、走行機構部38を制御し、搬送ロボット30を搬送先へと走行させる。その際、走行制御部32からのオドメトリデータ及び距離センサ36からの距離情報に基づいて、自己位置算出部33は、自己位置情報を更新し続ける。 As a basic operation, the transport robot 30 performs the required transport in accordance with instructions from the control device 10 as follows. The instruction receiving unit 31 receives a transport instruction from the control device 10 via the slave communication unit 39. The travel control unit 32 controls the travel mechanism unit 38 based on information related to the self-position and the destination position information included in the transport instruction, and causes the transport robot 30 to travel to the destination. At that time, the self-position calculation unit 33 continues to update the self-position information based on the odometry data from the travel control unit 32 and the distance information from the distance sensor 36.

<制御装置の構成>
図1に示されるように、制御装置10は、上位指令受付部11、指示発行部12、固有状態取得部13、位置関係算出部14、推定位置算出部15、推定位置送信部16の各機能ブロックを有する。また制御装置10は、マスタ記憶部17、上位通信部18、マスタ通信部19を有する。
<Configuration of the control device>
1 , the control device 10 has functional blocks of a higher-level command receiving unit 11, an instruction issuing unit 12, an inherent state acquiring unit 13, a positional relationship calculating unit 14, an estimated position calculating unit 15, and an estimated position transmitting unit 16. The control device 10 also has a master storage unit 17, a higher-level communication unit 18, and a master communication unit 19.

マスタ記憶部17は、制御装置10に設けられた記録装置である。マスタ記憶部17は、工場100のフロア内のマップ情報、制御装置10の制御プログラムを保持する他、それぞれの搬送ロボット30の固有情報、動作ログ等を適宜保持する。上位通信部18は、制御装置10が上位情報処理システムとの間で通信を行うための通信インターフェースである。マスタ通信部19は、制御装置10が搬送ロボット30との間で通信を行うための通信インターフェースである。 The master memory unit 17 is a recording device provided in the control device 10. The master memory unit 17 stores map information of the floor of the factory 100 and the control program of the control device 10, as well as the unique information and operation logs of each transport robot 30 as appropriate. The upper communication unit 18 is a communication interface that allows the control device 10 to communicate with a higher-level information processing system. The master communication unit 19 is a communication interface that allows the control device 10 to communicate with the transport robots 30.

上位指令受付部11は、上位通信部18を介して上位情報処理システムからの指令を受け付ける機能ブロックである。指示発行部12は、上位情報処理システムからの指令に基づいて、個々の搬送ロボット30への指示を発行し、マスタ通信部19を通じて個々の搬送ロボット30への指示を送信する。 The upper command reception unit 11 is a functional block that receives commands from a higher-level information processing system via the upper communication unit 18. The command issuing unit 12 issues commands to each transport robot 30 based on the commands from the higher-level information processing system, and transmits the commands to each transport robot 30 via the master communication unit 19.

その際、指示発行部12は、固有状態取得部13が取得したそれぞれの搬送ロボット30の固有状態を参照して、上位情報処理システムからの指令を実行するために適切な個々の搬送ロボット30への指示を発行する。位置関係算出部14、推定位置算出部15、推定位置送信部16の各機能は後述される。 At that time, the instruction issuing unit 12 refers to the unique state of each transport robot 30 acquired by the unique state acquiring unit 13, and issues an appropriate instruction to each transport robot 30 to execute a command from the higher-level information processing system. The functions of the positional relationship calculating unit 14, the estimated position calculating unit 15, and the estimated position transmitting unit 16 will be described later.

<推定位置算出の原理>
以下に、図4~図9を参照して、構成例に係る搬送システム1において、搬送ロボット30の推定位置が算出される原理が説明される。図4は工場100のフロア上において、搬送ロボット30が距離センサ36を用いて、周囲の物体との距離を測定する状況を示す図である。図5は、その際に距離センサ36が出力する距離情報をグラフにして表した図である。
<Principle of Estimated Position Calculation>
The principle of calculating the estimated position of the transport robot 30 in the transport system 1 according to the configuration example will be described below with reference to Figures 4 to 9. Figure 4 is a diagram showing a situation in which the transport robot 30 measures the distance to surrounding objects using the distance sensor 36 on the floor of the factory 100. Figure 5 is a diagram showing the distance information output by the distance sensor 36 at that time in the form of a graph.

マップ情報には、工場100のフロア上に載置されている棚や、生産設備の位置に関する情報が含まれている。図4に示される生産設備120aについて、筐体の四隅の角部の位置に関する情報が、点ランドマークMC1~MC4として、マップ情報に登録されている。 The map information includes information about the locations of the shelves and production equipment placed on the floor of the factory 100. For the production equipment 120a shown in FIG. 4, information about the locations of the four corners of the casing is registered in the map information as point landmarks MC1 to MC4.

また、生産設備120aの角部と角部とを結ぶ線(辺)の位置に関する情報が、線ランドマークML1~ML4としてマップ情報に登録されている。生産設備120bについても同様に、点ランドマークMC5~MC8、線ランドマークML5~ML8がマップ情報に登録されている。 In addition, information regarding the positions of the lines (sides) connecting the corners of production facility 120a is registered in the map information as line landmarks ML1 to ML4. Similarly, point landmarks MC5 to MC8 and line landmarks ML5 to ML8 are registered in the map information for production facility 120b.

図4において、搬送ロボット30の距離センサ36の監視レンジRが点線で示されている。図5は、横軸を搬送ロボット30正面からの角度、すなわち搬送ロボット30に対する方位を、縦軸を搬送ロボット30の基準点からの距離として、距離情報をグラフ化して表した図である。図5においても監視レンジRが示されている。図5に示されるように、距離センサ36が出力する距離情報には、監視レンジR内に位置する物体までの距離についての情報が含まれる。 In Figure 4, the monitoring range R of the distance sensor 36 of the transport robot 30 is shown by a dotted line. Figure 5 is a diagram showing distance information in a graph, with the horizontal axis representing the angle from the front of the transport robot 30, i.e., the orientation relative to the transport robot 30, and the vertical axis representing the distance from the reference point of the transport robot 30. The monitoring range R is also shown in Figure 5. As shown in Figure 5, the distance information output by the distance sensor 36 includes information about the distance to objects located within the monitoring range R.

自己位置算出部33は、搬送ロボット30の向きも含めた概略位置を、過去の自己位置に関する情報と、オドメトリデータにより算出し、そこから想定される監視レンジRが配置される領域付近のマップ情報と、距離情報とをマッチングする。オドメトリデータにより算出した概略位置には誤差が含まれるため、当該マップ情報と距離情報とにはずれが生じる。自己位置算出部33は、概略位置からそのずれを補正することで、搬送ロボット30の自己の位置に関する情報である自己位置情報を算出する。 The self-position calculation unit 33 calculates the approximate position of the transport robot 30, including its orientation, from information about its past self-position and odometry data, and matches the distance information with map information near the area where the estimated monitoring range R is located. Since the approximate position calculated from the odometry data contains an error, a discrepancy occurs between the map information and the distance information. The self-position calculation unit 33 calculates self-position information, which is information about the transport robot 30's own position, by correcting the discrepancy from the approximate position.

図6は、搬送ロボット30の距離センサ36の監視レンジR内に、作業者Wが立ち入っており、また、一時置きの物品Obが置かれている状況を示す。作業者W及び一時置きの物品Obによるオクルージョンの発生により、距離センサ36がマップ情報に登録された物体までの距離を把握できない、遮蔽エリアDaが生じている。 Figure 6 shows a situation in which a worker W is standing within the monitoring range R of the distance sensor 36 of the transport robot 30, and a temporarily placed item Ob is also placed there. Due to occlusion caused by the worker W and the temporarily placed item Ob, an obstructed area Da is created in which the distance sensor 36 cannot determine the distance to the object registered in the map information.

このような場合に、自己位置算出部33が算出する自己位置情報の精度が低下することは、容易に理解される。従って、自己位置算出部33は、マップ情報と、距離情報とのマッチングの状況、例えば、いくつの点ランドマーク、線ランドマークにマッチングできたか等に応じ、自己位置情報の確からしさについての確度情報を合わせて算出する。 In such a case, it is easy to understand that the accuracy of the self-location information calculated by the self-location calculation unit 33 decreases. Therefore, the self-location calculation unit 33 also calculates accuracy information about the reliability of the self-location information depending on the matching situation between the map information and the distance information, for example, how many point landmarks and line landmarks have been matched.

図7は、図4の状況において、搬送ロボット30aの距離センサ36の監視レンジR内に、更に他の搬送ロボット30bが存在するようになった状況を示す。図8は、その際の図5に相応するグラフである。図示されるように、搬送ロボット30aが取得した距離情報には、他の搬送ロボット30bの位置に関する情報が含まれる。 Figure 7 shows the situation in Figure 4 where another transport robot 30b is now within the monitoring range R of the distance sensor 36 of the transport robot 30a. Figure 8 is a graph corresponding to Figure 5 at this time. As shown in the figure, the distance information acquired by the transport robot 30a includes information regarding the position of the other transport robot 30b.

すなわち搬送ロボット30aが取得した距離情報を分析することで、他の搬送ロボット30bの搬送ロボット30aからの距離と方位、また、搬送ロボット30bの向きに関する情報を得ることができる。よって、搬送ロボット30aの自己位置情報と搬送ロボット30aが取得した距離情報とから、搬送ロボット30bの向きを含む位置について、算出し得ることが理解される。 In other words, by analyzing the distance information acquired by the transport robot 30a, it is possible to obtain information regarding the distance and direction of the other transport robot 30b from the transport robot 30a, as well as the orientation of the transport robot 30b. Therefore, it can be understood that the position, including the orientation, of the transport robot 30b can be calculated from the self-position information of the transport robot 30a and the distance information acquired by the transport robot 30a.

図9は、搬送ロボット30aが、搬送ロボット30bの監視レンジRb内及び搬送ロボット30cの監視レンジRc内に存在している状況を示す。搬送ロボット30aの位置に関する情報は、以下の3通り存在する。(i)搬送ロボット30aが算出する自身の自己位置情報。(ii)搬送ロボット30bが算出する自身の自己位置情報と、搬送ロボット30bの距離情報とから導かれる搬送ロボット30aの位置に関する情報。(iii)搬送ロボット30cが算出する自身の自己位置情報と、搬送ロボット30cの距離情報とから導かれる搬送ロボット30aの位置に関する情報。 Figure 9 shows a situation where the transport robot 30a is within the monitoring range Rb of the transport robot 30b and within the monitoring range Rc of the transport robot 30c. There are three types of information regarding the position of the transport robot 30a: (i) Its own position information calculated by the transport robot 30a. (ii) Information regarding the position of the transport robot 30a derived from its own position information calculated by the transport robot 30b and distance information of the transport robot 30b. (iii) Information regarding the position of the transport robot 30a derived from its own position information calculated by the transport robot 30c and distance information of the transport robot 30c.

これらの情報を統合して、搬送ロボット30aの位置に関する情報を算出することにより、(i)搬送ロボット30aが算出する自身の自己位置情報のみに依拠するよりも更に精度を高めることができるようになる。より具体的には、以下のようにして、これらの情報を統合し位置の推定値を得ることができる。 By integrating these pieces of information to calculate information regarding the position of the transport robot 30a, (i) it becomes possible to achieve even higher accuracy than if the information were solely based on the self-position information calculated by the transport robot 30a. More specifically, it is possible to integrate these pieces of information and obtain an estimated position value as follows.

例えば座標Xについて、上記(i)~(iii)によって、それぞれ推定値X1~X3が得られたとする。推定値X1~X3の単純平均を、統合された位置の推定値とすることができる。あるいは、推定値X1~X3についてのそれぞれの確度情報に応じて定められる重み付け係数を用いた加重平均を、統合された位置の推定値とすることができる。 For example, for coordinate X, assume that estimates X1 to X3 have been obtained by the above (i) to (iii). The simple average of estimates X1 to X3 can be used as the integrated position estimate. Alternatively, the weighted average using weighting coefficients determined according to the respective accuracy information for estimates X1 to X3 can be used as the integrated position estimate.

またあるいは、推定値X1~X3毎に、それぞれの確度情報に応じて定められる分散を有し各推定値をピークとする正規分布等の確率分布関数を算出し、これらの確率分布関数を足し合わせた分布関数のピークを統合された位置の推定値とすることができる。座標Y、向きθについても同様である。 Alternatively, for each of the estimated values X1 to X3, a probability distribution function such as a normal distribution with a variance determined according to the respective accuracy information and a peak at each estimated value can be calculated, and the peak of the distribution function obtained by adding up these probability distribution functions can be used as the integrated position estimate. The same applies to the coordinate Y and the direction θ.

図9に表された事例においては、搬送ロボット30bが、搬送ロボット30aの監視レンジRa内及び搬送ロボット30cの監視レンジRc内に存在している。そのため、搬送ロボット30bの位置に関する情報についても、同様にして他の搬送ロボット30a、搬送ロボット30cからの情報に基づいて、精度を高めた情報を算出することができる。このようにして、搬送ロボットの相互の情報に基づいて、精度をより高めた搬送ロボットの位置に関する情報を得ることができるようになる。 In the example shown in FIG. 9, the transport robot 30b is present within the monitoring range Ra of the transport robot 30a and within the monitoring range Rc of the transport robot 30c. Therefore, information with improved accuracy regarding the position of the transport robot 30b can also be calculated in a similar manner based on information from the other transport robots 30a and 30c. In this way, it becomes possible to obtain information with improved accuracy regarding the position of the transport robot based on mutual information between the transport robots.

<制御装置の動作>
以下に、上記推定位置算出の原理に基づいた、搬送システム1の特徴的な動作が図10のフローチャットに沿って説明される。搬送システム1では、搬送ロボット30に搬送の動作を実行させている際に、図10に示されるフローがリアルタイムで繰り返し実行される。
<Operation of the control device>
A characteristic operation of the transport system 1 based on the above-mentioned principle of the estimated position calculation will be described below with reference to the flowchart in Fig. 10. In the transport system 1, when the transport robot 30 is executing the transport operation, the flow shown in Fig. 10 is repeatedly executed in real time.

ステップS1:搬送システム1のそれぞれの搬送ロボット30において、距離センサ36により距離情報が取得される。また、走行制御部32において、オドメトリデータが算出される。 Step S1: In each transport robot 30 of the transport system 1, distance information is acquired by the distance sensor 36. In addition, odometry data is calculated in the travel control unit 32.

ステップS2:搬送システム1のそれぞれの搬送ロボット30において、自己位置算出部33が、距離情報とオドメトリデータとに基づいて、自己位置情報を算出する。 Step S2: In each transport robot 30 of the transport system 1, the self-position calculation unit 33 calculates self-position information based on the distance information and odometry data.

ステップS3:搬送システム1のそれぞれの搬送ロボット30において、固有状態報知部が、距離情報と自己位置情報とを含む固有情報を、スレーブ記憶部37に記憶された搬送ロボット30自身の識別情報とともに、スレーブ通信部39を介して、制御装置10に送信する。 Step S3: In each transport robot 30 of the transport system 1, the unique state notification unit transmits unique information including distance information and self-position information to the control device 10 via the slave communication unit 39, together with the identification information of the transport robot 30 itself stored in the slave memory unit 37.

ステップS4:制御装置10の固有状態取得部13は、マスタ通信部19を通じて、それぞれの搬送ロボット30から、識別情報が付された固有情報を取得する。 Step S4: The unique state acquisition unit 13 of the control device 10 acquires unique information with identification information from each transport robot 30 via the master communication unit 19.

ステップS5:制御装置10の位置関係算出部14は、固有情報に含まれたそれぞれの搬送ロボット30の自己位置情報から、それぞれの搬送ロボット30の監視レンジRを算出する。その際、固有情報に付された搬送ロボット30の識別情報に基づいて、それぞれの搬送ロボット30を識別する。更に位置関係算出部14は、各自己位置情報と算出した各監視レンジRに基づいて、それぞれの搬送ロボット30が、どの他の搬送ロボット30の監視レンジR内にあるかを算出する。 Step S5: The positional relationship calculation unit 14 of the control device 10 calculates the monitoring range R of each transport robot 30 from the self-position information of each transport robot 30 included in the unique information. At that time, each transport robot 30 is identified based on the identification information of the transport robot 30 attached to the unique information. Furthermore, the positional relationship calculation unit 14 calculates which other transport robot 30 each transport robot 30 is within its monitoring range R based on each self-position information and each calculated monitoring range R.

ステップS6:制御装置10の推定位置算出部15は、それぞれの搬送ロボット30について、当該搬送ロボットの位置に関する推定位置情報を算出する。その際、推定位置算出部15は、搬送ロボット30から取得した自己位置情報と、当該搬送ロボット30以外の搬送ロボット30から取得した距離情報に含まれる当該搬送ロボットの位置に関する情報に併せ、当該搬送ロボット30以外の搬送ロボット30から取得した自己位置情報と、を用いる。推定位置情報の算出は、上記の推定位置算出の原理で説明された「統合された位置の推定値」を算出する方法に基づいて実行される。 Step S6: The estimated position calculation unit 15 of the control device 10 calculates estimated position information regarding the position of each transport robot 30. In this case, the estimated position calculation unit 15 uses the self-position information acquired from the transport robot 30, information regarding the position of the transport robot contained in the distance information acquired from the other transport robots 30, and the self-position information acquired from the other transport robots 30. The calculation of the estimated position information is performed based on the method of calculating the "integrated position estimate" described in the principle of estimated position calculation above.

ステップS7:制御装置10の推定位置送信部16は、推定位置算出部15が算出したそれぞれの搬送ロボット30の推定位置情報を、マスタ通信部19を介して、それぞれの搬送ロボット30に対して送信する。その際、推定位置送信部16は、取得した搬送ロボット30の識別情報に基づいて、それぞれの搬送ロボット30を識別する。 Step S7: The estimated position transmission unit 16 of the control device 10 transmits the estimated position information of each transport robot 30 calculated by the estimated position calculation unit 15 to each transport robot 30 via the master communication unit 19. At that time, the estimated position transmission unit 16 identifies each transport robot 30 based on the acquired identification information of the transport robot 30.

ステップS8:搬送システム1のそれぞれの搬送ロボット30において、推定位置取得部35が、スレーブ通信部39を通じて、制御装置10から、自機の推定位置情報を取得する。推定位置取得部35は、自機の位置に関する情報を、取得した推定位置情報に基づいて更新する。 Step S8: In each transport robot 30 of the transport system 1, the estimated position acquisition unit 35 acquires the estimated position information of the own robot from the control device 10 via the slave communication unit 39. The estimated position acquisition unit 35 updates the information regarding the position of the own robot based on the acquired estimated position information.

構成例に係る搬送システム1によれば、搬送ロボット30の位置推定が、自機の距離センサ36からの距離情報からのみならず、他機の距離センサ36からの距離情報にも依拠して実行される。そのため、自機の距離センサ36からの距離情報のみによって位置推定が実行される場合と比較して、搬送ロボット30の位置推定の精度をより高めることができる。 According to the transport system 1 of the configuration example, the position estimation of the transport robot 30 is performed not only based on the distance information from its own distance sensor 36, but also on the distance information from the distance sensors 36 of other devices. Therefore, the accuracy of the position estimation of the transport robot 30 can be improved compared to when the position estimation is performed only based on the distance information from its own distance sensor 36.

〔ソフトウェアによる実現例〕
制御装置10の各機能ブロック(特に、上位指令受付部11、指示発行部12、固有状態取得部13、位置関係算出部14、推定位置算出部15、推定位置送信部16)あるいは、搬送ロボット30の機能ブロック(特に、指示受付部31、走行制御部32、自己位置算出部33、固有状態報知部34、推定位置取得部35)は、集積回路(ICチップ)等に形成された論理回路(ハードウェア)によって実現されてもよいし、ソフトウェアによって実現されてもよい。
[Software implementation example]
Each functional block of the control device 10 (particularly, the higher-level command receiving unit 11, the instruction issuing unit 12, the inherent state acquisition unit 13, the positional relationship calculation unit 14, the estimated position calculation unit 15, and the estimated position transmission unit 16) or the functional blocks of the transport robot 30 (particularly, the instruction receiving unit 31, the driving control unit 32, the self-position calculation unit 33, the inherent state notification unit 34, and the estimated position acquisition unit 35) may be realized by a logic circuit (hardware) formed in an integrated circuit (IC chip) or the like, or may be realized by software.

後者の場合、制御装置10あるいは搬送ロボット30は、各機能を実現するソフトウェアであるプログラムの命令を実行するコンピュータを備えている。このコンピュータは、例えば1つ以上のプロセッサを備えていると共に、上記プログラムを記憶したコンピュータ読み取り可能な記録媒体を備えている。そして、上記コンピュータにおいて、上記プロセッサが上記プログラムを上記記録媒体から読み取って実行することにより、本発明の目的が達成される。 In the latter case, the control device 10 or the transport robot 30 is equipped with a computer that executes the instructions of a program, which is software that realizes each function. This computer is equipped with, for example, one or more processors, and a computer-readable recording medium that stores the program. The object of the present invention is achieved by having the processor in the computer read and execute the program from the recording medium.

上記プロセッサとしては、例えばCPU(Central Processing Unit)を用いることができる。上記記録媒体としては、「一時的でない有形の媒体」、例えば、ROM(Read Only Memory)等の他、テープ、ディスク、カード、半導体メモリ、プログラマブルな論理回路などを用いることができる。また、上記プログラムを展開するRAM(Random Access Memory)などを更に備えていてもよい。 The processor may be, for example, a CPU (Central Processing Unit). The recording medium may be a "non-transitory tangible medium" such as a ROM (Read Only Memory), as well as a tape, a disk, a card, a semiconductor memory, or a programmable logic circuit. The device may further include a RAM (Random Access Memory) for expanding the program.

また、上記プログラムは、該プログラムを伝送可能な任意の伝送媒体(通信ネットワークや放送波等)を介して上記コンピュータに供給されてもよい。なお、本発明の一態様は、上記プログラムが電子的な伝送によって具現化された、搬送波に埋め込まれたデータ信号の形態でも実現され得る。 The program may be supplied to the computer via any transmission medium capable of transmitting the program (such as a communication network or broadcast waves). One aspect of the present invention may also be realized in the form of a data signal embedded in a carrier wave, in which the program is embodied by electronic transmission.

本発明は上述した各実施形態に限定されるものではなく、請求項に示した範囲で種々の変更が可能であり、開示された技術的手段を適宜組み合わせて得られる実施形態についても本発明の技術的範囲に含まれる。 The present invention is not limited to the above-described embodiments, and various modifications are possible within the scope of the claims. The technical scope of the present invention also includes embodiments obtained by appropriately combining the disclosed technical means.

1 搬送システム
10 制御装置
11 上位指令受付部
12 指示発行部
13 固有状態取得部
14 位置関係算出部
15 推定位置算出部
16 推定位置送信部
17 マスタ記憶部
18 上位通信部
19 マスタ通信部
30、30a~30c、30M 搬送ロボット
31 指示受付部
32 走行制御部
33 自己位置算出部
34 固有状態報知部
35 推定位置取得部
36 距離センサ
37 スレーブ記憶部
38 走行機構部
39 スレーブ通信部
R、Ra~Rc 監視レンジ
REFERENCE SIGNS LIST 1 Transport system 10 Control device 11 Upper command reception unit 12 Instruction issuing unit 13 Unique state acquisition unit 14 Positional relationship calculation unit 15 Estimated position calculation unit 16 Estimated position transmission unit 17 Master memory unit 18 Upper communication unit 19 Master communication unit 30, 30a to 30c, 30M Transport robot 31 Instruction reception unit 32 Travel control unit 33 Self-position calculation unit 34 Unique state notification unit 35 Estimated position acquisition unit 36 Distance sensor 37 Slave memory unit 38 Travel mechanism unit 39 Slave communication unit R, Ra to Rc Monitoring range

Claims (5)

自走式の複数の搬送ロボットと、
複数の前記搬送ロボットとの間で通信を行う制御装置とを備え、
前記搬送ロボットは、周囲の物体への距離を検知し、距離情報として出力するセンサと、前記距離情報を用いて自己の位置に関する自己位置情報を算出する自己位置算出部と、を有し、
前記制御装置は、
複数の前記搬送ロボットから、それぞれの前記自己位置情報と、前記距離情報とを取得する固有状態取得部と、
前記搬送ロボットから取得した前記自己位置情報と、当該搬送ロボット以外の前記搬送ロボットから取得した前記距離情報に含まれる当該搬送ロボットの位置に関する情報とを用いて、当該搬送ロボットの位置に関する推定位置情報を算出する推定位置算出部と、
当該搬送ロボットの推定位置を、当該搬送ロボットに報知する推定位置送信部と、を有する、搬送システム。
A plurality of self-propelled transport robots;
a control device that communicates with the plurality of transport robots;
the transport robot has a sensor that detects a distance to a surrounding object and outputs the distance information, and a self-position calculation unit that calculates self-position information regarding its own position using the distance information;
The control device includes:
an inherent state acquisition unit that acquires the self-position information and the distance information from each of the plurality of transport robots;
an estimated position calculation unit that calculates estimated position information regarding the position of the transport robot using the self-position information acquired from the transport robot and information regarding the position of the transport robot included in the distance information acquired from the transport robot other than the transport robot;
and an estimated position transmitting unit that notifies the transport robot of the estimated position of the transport robot.
前記推定位置算出部は、
当該搬送ロボット以外の前記搬送ロボットから取得した前記自己位置情報を併せて用いて、前記推定位置情報を算出する、請求項1に記載の搬送システム。
The estimated position calculation unit
The transport system according to claim 1 , wherein the estimated position information is calculated by also using the self-position information acquired from transport robots other than the transport robot in question.
前記自己位置情報及び前記推定位置情報は、それぞれ前記搬送ロボットが走行する床面上の位置についての情報と、前記搬送ロボットの向きについての情報とを含む、請求項1または2に記載の搬送システム。 The transport system according to claim 1 or 2, wherein the self-position information and the estimated position information each include information about the position on the floor surface where the transport robot is traveling and information about the orientation of the transport robot. 前記搬送ロボットは更に、
走行を行うための走行機構部と、
前記走行機構部を制御するとともに、前記搬送ロボットのオドメトリデータを算出する走行制御部と、を有し、
前記自己位置算出部は、
前記オドメトリデータと、前記距離情報とに基づいて、前記自己位置情報を算出する、請求項1から3のいずれか1項に記載の搬送システム。
The transport robot further comprises:
A traveling mechanism for performing traveling;
a travel control unit that controls the travel mechanism unit and calculates odometry data of the transport robot,
The self-position calculation unit is
The transportation system according to claim 1 , wherein the self-position information is calculated based on the odometry data and the distance information.
前記搬送ロボットは更に、
当該搬送ロボットの識別情報を保持したスレーブ記憶部と、
前記距離情報と、前記自己位置情報とを含む固有情報を、前記識別情報に付して送信する固有状態報知部と、を有し、
前記固有状態取得部は、複数の前記搬送ロボットから、更に前記識別情報を取得する、請求項1から3のいずれか1項に記載の搬送システム。
The transport robot further comprises:
A slave storage unit that stores identification information of the transport robot;
a unique state notification unit that transmits unique information including the distance information and the self-location information by attaching the unique information to the identification information,
The transport system according to claim 1 , wherein the specific state acquisition unit further acquires the identification information from a plurality of the transport robots.
JP2020201284A 2020-12-03 2020-12-03 Transport System Active JP7600649B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2020201284A JP7600649B2 (en) 2020-12-03 2020-12-03 Transport System
PCT/JP2021/008292 WO2022118488A1 (en) 2020-12-03 2021-03-03 Conveyance system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020201284A JP7600649B2 (en) 2020-12-03 2020-12-03 Transport System

Publications (2)

Publication Number Publication Date
JP2022089062A JP2022089062A (en) 2022-06-15
JP7600649B2 true JP7600649B2 (en) 2024-12-17

Family

ID=81854091

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020201284A Active JP7600649B2 (en) 2020-12-03 2020-12-03 Transport System

Country Status (2)

Country Link
JP (1) JP7600649B2 (en)
WO (1) WO2022118488A1 (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011150443A (en) 2010-01-20 2011-08-04 Hitachi Plant Technologies Ltd Robot and robot system
US20190094876A1 (en) 2017-09-22 2019-03-28 Locus Robotics Corporation Multi-resolution scan matching with exclusion zones

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090062974A1 (en) * 2007-09-03 2009-03-05 Junichi Tamamoto Autonomous Mobile Robot System
JP2009093308A (en) * 2007-10-05 2009-04-30 Hitachi Industrial Equipment Systems Co Ltd Robot system

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011150443A (en) 2010-01-20 2011-08-04 Hitachi Plant Technologies Ltd Robot and robot system
US20190094876A1 (en) 2017-09-22 2019-03-28 Locus Robotics Corporation Multi-resolution scan matching with exclusion zones

Also Published As

Publication number Publication date
JP2022089062A (en) 2022-06-15
WO2022118488A1 (en) 2022-06-09

Similar Documents

Publication Publication Date Title
US11613017B2 (en) Safety-rated multi-cell workspace mapping and monitoring
JP6816830B2 (en) A position estimation system and a mobile body equipped with the position estimation system.
EP3888306B1 (en) Safety-rated multi-cell workspace mapping and monitoring
US11537140B2 (en) Mobile body, location estimation device, and computer program
US20200363212A1 (en) Mobile body, location estimation device, and computer program
JP6025289B2 (en) Linked system of automated guided vehicle and inventory management system
CN111052026A (en) Moving bodies and moving body systems
EP3862839B1 (en) Transport system and transport method
JP2019053391A (en) Moving body
CN111717843A (en) A logistics handling robot
CN111065981A (en) Moving bodies and moving body systems
JP2019175137A (en) Mobile body and mobile body system
JP2019079171A (en) Movable body
WO2019194079A1 (en) Position estimation system, moving body comprising said position estimation system, and computer program
KR102183830B1 (en) The route control apparatus of automatic guided vehicle and route controlling method of thereof
Yang et al. Two-stage multi-sensor fusion positioning system with seamless switching for cooperative mobile robot and manipulator system: M. Yang, E. Yang
KR20240003367A (en) Logistics management system using autonomous mobile robot equipped with rfid reader and method thereof
US20250059011A1 (en) A hybrid, context-aware localization system for ground vehicles
JP2019175136A (en) Mobile body
JP7600649B2 (en) Transport System
JP7559542B2 (en) TRANSPORT SYSTEM AND TRANSPORT METHOD
WO2022190514A1 (en) Conveyance system
US20250230023A1 (en) Validating the pose of a robotic vehicle that allows it to interact with an object on fixed infrastructure
KR102912188B1 (en) Autonomous driving system generating path for AMR
US20250271854A1 (en) Network communication devices and methods for robotic operations

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20231010

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20241105

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20241118

R150 Certificate of patent or registration of utility model

Ref document number: 7600649

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150