JP7264839B2 - Installation control device and installation control method - Google Patents

Installation control device and installation control method Download PDF

Info

Publication number
JP7264839B2
JP7264839B2 JP2020015942A JP2020015942A JP7264839B2 JP 7264839 B2 JP7264839 B2 JP 7264839B2 JP 2020015942 A JP2020015942 A JP 2020015942A JP 2020015942 A JP2020015942 A JP 2020015942A JP 7264839 B2 JP7264839 B2 JP 7264839B2
Authority
JP
Japan
Prior art keywords
installation
component
control device
conveyed
work space
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
JP2020015942A
Other languages
Japanese (ja)
Other versions
JP2021123433A (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.)
Hitachi Ltd
Original Assignee
Hitachi 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 Ltd filed Critical Hitachi Ltd
Priority to JP2020015942A priority Critical patent/JP7264839B2/en
Priority to PCT/JP2020/033857 priority patent/WO2021157114A1/en
Publication of JP2021123433A publication Critical patent/JP2021123433A/en
Application granted granted Critical
Publication of JP7264839B2 publication Critical patent/JP7264839B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C13/00Other constructional features or details
    • B66C13/18Control systems or devices
    • B66C13/22Control systems or devices for electric drives
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C13/00Other constructional features or details
    • B66C13/18Control systems or devices
    • B66C13/48Automatic control of crane drives for producing a single or repeated working cycle; Programme control

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Control And Safety Of Cranes (AREA)

Description

本発明は、据付制御装置、及び据付制御方法に関する。 The present invention relates to an installation control device and an installation control method.

工場等において大型の製品を組み立てる場合、クレーン(起重機)が用いられる。クレーンの制御に関し、例えば、特許文献1には、航法用受信機が受信したIGPS信号に基づき認識された上ロールの現在位置と目標位置との偏差を算出し、算出された現在位置と目標位置との偏差に基づいて上ロールの現在位置が目標位置になるように屋内クレーンを自律移動させる技術が開示されている。 A crane (hoisting machine) is used when assembling a large product in a factory or the like. Regarding the control of a crane, for example, in Patent Document 1, the deviation between the current position and the target position of the upper roll recognized based on the IGPS signal received by the navigation receiver is calculated, and the calculated current position and the target position are calculated. A technique is disclosed for autonomously moving an indoor crane so that the current position of the upper roll becomes the target position based on the deviation from .

特開2017-88330号公報JP 2017-88330 A

特許文献1に記載の技術は、現在位置と目標位置との偏差を算出し、算出した偏差に基づいて現在地が目標位置になるように屋内クレーンを自律移動させている。 The technique described in Patent Document 1 calculates the deviation between the current position and the target position, and autonomously moves the indoor crane so that the current position becomes the target position based on the calculated deviation.

しかしながら、特許文献1の記載の技術では、工場で行われる部品の据付作業では、据付先の据付部品と、据え付ける対象である搬送部品とのそれぞれの3D(Dimension)次元空間における位置がわからないため、据付作業の自動化をすることができない。 However, in the technique described in Patent Document 1, the position in the 3D (Dimensional) space of the part to be installed and the transport part to be installed is not known in the part installation work performed at the factory. Installation work cannot be automated.

本発明は、上記の点に鑑みてなされたものであって、搬送部品を吊り上げ搬送して据付部品に据え付ける据付作業を自動化できるようにすることを目的とする。 SUMMARY OF THE INVENTION The present invention has been made in view of the above-described problems, and an object of the present invention is to automate the installation work of lifting and transporting conveyed parts and installing them on installation parts.

本願は、上記課題の少なくとも一部を解決する手段を複数含んでいるが、その例を挙げるならば、以下の通りである。 The present application includes a plurality of means for solving at least part of the above problems, and examples thereof are as follows.

上記課題を解決するため、本発明の一態様に係る据付制御装置は、搬送部品を吊り上げ搬送して据付部品に据え付ける据付作業を制御する据付制御装置であって、前記搬送部品及び前記据付部品を含む作業空間の形状を表す計測データを計測する計測部と、前記計測データ及び搬送部品3D形状データに基づき、前記作業空間における前記搬送部品の位置を検出する搬送部品位置検出部と、前記計測データ及び据付部品3D形状データに基づき、前記作業空間における前記据付部品の位置を検出する据付部品位置検出部と、前記作業空間における前記搬送部品の位置から前記据付部品の位置までの前記搬送部品の搬送パスを算出する搬送パス算出部と、算出された前記搬送パスに基づき、前記据付作業を実行するクレーンを制御するための制御量を算出する制御量算出部と、を備えることを特徴とする。 In order to solve the above-described problems, an installation control device according to one aspect of the present invention is an installation control device for controlling an installation work of lifting and transporting a transported component and installing it on an installation component, wherein the transported component and the installation component are a measurement unit that measures measurement data representing the shape of a working space including a conveying part position detection unit that detects the position of the conveying part in the working space based on the measurement data and the conveying part 3D shape data; and the measurement data and an installation component position detection unit that detects the position of the installation component in the work space based on the installation component 3D shape data; A conveying path calculating unit that calculates a path, and a control amount calculating unit that calculates a controlled amount for controlling a crane that performs the installation work based on the calculated conveying path.

本発明によれば、搬送部品を吊り上げ搬送して据付部品に据え付ける据付作業を自動化することが可能となる。 ADVANTAGE OF THE INVENTION According to this invention, it becomes possible to automate the installation work which lifts and conveys a conveying component, and installs it in an installation component.

上記した以外の課題、構成、及び効果は、以下の実施形態の説明により明らかにされる。 Problems, configurations, and effects other than those described above will be clarified by the following description of the embodiments.

図1は、本発明の一実施形態に係る据付制御装置が有する機能ブロックの構成例を示す図である。FIG. 1 is a diagram showing a configuration example of functional blocks included in an installation control device according to an embodiment of the present invention. 図2は、計測データの一例を示す図である。FIG. 2 is a diagram showing an example of measurement data. 図3は、搬送物の一例を示す立体図である。FIG. 3 is a three-dimensional view showing an example of a transported object. 図4は、据付物の一例を示す立体図である。FIG. 4 is a three-dimensional view showing an example of a fixture. 図5は、据付自動処理の一例を説明するフローチャートである。FIG. 5 is a flowchart illustrating an example of automatic installation processing. 図6は、位置検出処理の一例を説明するフローチャートである。FIG. 6 is a flowchart illustrating an example of position detection processing. 図7は、搬送パス算出処理の一例を説明するフローチャートである。FIG. 7 is a flowchart illustrating an example of the conveying path calculation process.

以下、本発明の一実施形態について図面に基づいて説明する。なお、実施形態を説明するための全図において、同一の部材には原則として同一の符号を付し、その繰り返しの説明は省略する。また、以下の実施形態において、その構成要素(要素ステップ等も含む)は、特に明示した場合および原理的に明らかに必須であると考えられる場合等を除き、必ずしも必須のものではないことは言うまでもない。また、「Aからなる」、「Aよりなる」、「Aを有する」、「Aを含む」と言うときは、特にその要素のみである旨明示した場合等を除き、それ以外の要素を排除するものでないことは言うまでもない。同様に、以下の実施形態において、構成要素等の形状、位置関係等に言及するときは、特に明示した場合および原理的に明らかにそうでないと考えられる場合等を除き、実質的にその形状等に近似または類似するもの等を含むものとする。 An embodiment of the present invention will be described below with reference to the drawings. In principle, the same members are denoted by the same reference numerals in all the drawings for describing the embodiments, and repeated description thereof will be omitted. In addition, in the following embodiments, it goes without saying that the constituent elements (including element steps and the like) are not necessarily essential unless otherwise specified or clearly considered essential in principle. stomach. In addition, when saying "consisting of A", "consisting of A", "having A", or "including A", other elements are excluded unless it is explicitly stated that only those elements are included. It goes without saying that it is not something to do. Similarly, in the following embodiments, when referring to the shape, positional relationship, etc. of components, etc., unless otherwise explicitly stated or in principle clearly considered to be otherwise, the actual shape, etc. shall include those that are similar or similar to

<本発明の一実施形態に係る据付制御装置100が有する機能ブロックの構成例>
図1は、本発明の一実施形態に係る据付制御装置100が有する機能ブロックの構成例を示している。
<Configuration Example of Functional Blocks of Installation Control Device 100 According to One Embodiment of the Present Invention>
FIG. 1 shows a configuration example of functional blocks of an installation control device 100 according to one embodiment of the present invention.

据付制御装置100は、工場等に設けられたクレーン(不図示)を用いて搬送部品200(図3)を吊り上げ搬送して据付部品300(図4)に据え付ける据付作業を自動化するものである。なお、据付制御装置100は、制御対象のクレーンに内蔵してもよいし、クレーンの外部に設けてもよい。 The installation control device 100 automates the installation work of lifting and transporting the transport component 200 (FIG. 3) using a crane (not shown) installed in a factory or the like and installing it on the installation component 300 (FIG. 4). The installation control device 100 may be built in the crane to be controlled, or may be provided outside the crane.

据付制御装置100は、例えば、CPU(Central Processor Unit)、メモリ、ストレージ、入力デバイス、出力デバイス、通信インタフェース等を備えるパーソナルコンピュータ等の一般的なコンピュータによって実現される。 The installation control device 100 is realized by a general computer such as a personal computer including, for example, a CPU (Central Processor Unit), memory, storage, input device, output device, communication interface, and the like.

据付制御装置100は、入力部110、出力部120、計測部130、クレーン制御部140、通信部150、記憶部160、及び演算部170の各機能ブロックを有する。 The installation control device 100 has functional blocks of an input unit 110 , an output unit 120 , a measurement unit 130 , a crane control unit 140 , a communication unit 150 , a storage unit 160 and a calculation unit 170 .

入力部110は、コンピュータが備えるキーボード、マウス、マイクロホン等の入力デバイスからなり、ユーザからの各種の入力を受け付ける。出力部120は、コンピュータが備えるディスプレイ、スピーカ等の出力デバイスからなり、操作画面等を表示し、音声を出力する。 The input unit 110 is composed of input devices such as a keyboard, mouse, and microphone provided in the computer, and receives various inputs from the user. The output unit 120 includes an output device such as a display and a speaker provided in the computer, displays an operation screen and the like, and outputs sound.

計測部130は、例えば、レーザスキャナ、カメラ等の3D計測器からなり、搬送物及200及び据付部品300が配置されている作業空間の3D形状を計測し、その計測結果を表す計測データ161を記憶部160に格納する。 The measuring unit 130 is composed of, for example, a 3D measuring device such as a laser scanner and a camera, measures the 3D shape of the work space in which the transported object 200 and the installation parts 300 are arranged, and generates measurement data 161 representing the measurement result. Stored in the storage unit 160 .

クレーン制御部140は、クレーンの電動アクチュエータ(不図示)を制御することによってクレーンの動作を制御する。通信部150は、コンピュータが備える通信インタフェースを介して所定の外部装置を接続し、後述する各種のデータを受信し、記憶部160に格納する。 The crane controller 140 controls the operation of the crane by controlling the electric actuators (not shown) of the crane. The communication unit 150 connects a predetermined external device via a communication interface provided in the computer, receives various data described later, and stores the data in the storage unit 160 .

記憶部160は、コンピュータが備えるメモリ、ストレージからなる。記憶部160には、計測データ161、搬送部品3D形状データ162、据付部品3D形状データ163、搬送部品据付基準点データ164、据付部品据付基準点データ165、搬送姿勢制約データ166、及びクレーン仕様データ167が格納される。 The storage unit 160 is composed of memory and storage provided in the computer. The storage unit 160 stores measurement data 161, transfer part 3D shape data 162, installation part 3D shape data 163, transfer part installation reference point data 164, installation part installation reference point data 165, transfer posture constraint data 166, and crane specification data. 167 are stored.

計測データ161は、計測部130によって計測され、記憶部160に格納されるものである。計測データ161は、搬送部品200、据付部品300、その他の構造物が配置されている作業空間の形状を表す。図2は、計測データ161の一例を示している。計測データ161は、作業空間に存在する搬送部品200、据付部品300、その他の構造物が、作業空間の所定の点を原点とする座標系の3D座標位置(X軸座標,Y軸座標,及びZ軸座標)の点列として記録されている。 The measurement data 161 is measured by the measurement unit 130 and stored in the storage unit 160 . The measurement data 161 represents the shape of the work space in which the transfer component 200, the installation component 300, and other structures are arranged. FIG. 2 shows an example of the measurement data 161. As shown in FIG. The measurement data 161 is the 3D coordinate positions (X-axis coordinates, Y-axis coordinates, and Z-axis coordinates) are recorded as a series of points.

搬送部品3D形状データ162は、予め外部装置上のCAD(Computer Aided Design)ソフトウェア等によって作成され、記憶部160に格納されているものである。搬送部品3D形状データ162は、搬送部品200の3D形状を表す。図3は、搬送部品200の3D形状の一例を示している。搬送部品200には、後述する複数の据付基準点201~201(据付基準点201は不図示)が設定されている。以下、据付基準点201~201を個々に区別する必要がない場合、据付基準点201と称する。なお、据付基準点201の数は、4に限らず、1,2,3または4以上であってもよい。 The conveyed part 3D shape data 162 is created in advance by CAD (Computer Aided Design) software or the like on an external device and stored in the storage unit 160 . The transport component 3D shape data 162 represents the 3D shape of the transport component 200 . FIG. 3 shows an example of the 3D shape of the transport component 200. As shown in FIG. A plurality of installation reference points 201 1 to 201 4 (the installation reference point 201 4 is not shown), which will be described later, are set on the conveying component 200 . Hereinafter, the installation reference points 201 1 to 201 4 will be referred to as installation reference points 201 when there is no need to distinguish them individually. The number of installation reference points 201 is not limited to four, and may be one, two, three, or four or more.

据付部品3D形状データ163は、予め外部装置上のCADソフトウェア等によって作成され、記憶部160に格納されているものである。据付部品3D形状データ163は、据付部品300の3D形状情報を表す。図4は、据付部品300の3D形状の一例を示している。据付部品300には、後述する複数の据付基準点301~301が設定されている。以下、据付基準点301~301を個々に区別する必要がない場合、据付基準点301と称する。なお、据付基準点301の数は、4に限らず、1,2,3または4以上であってもよい。また、据付基準点201及び据付基準点301の数は必ずしも一致していなくてもよい。 The installation part 3D shape data 163 is created in advance by CAD software or the like on an external device and stored in the storage unit 160 . The installation part 3D shape data 163 represents 3D shape information of the installation part 300 . FIG. 4 shows an example of the 3D shape of the mounting part 300. As shown in FIG. A plurality of installation reference points 301 1 to 301 4 to be described later are set on the installation component 300 . Hereinafter, the installation reference points 301 1 to 301 4 will be referred to as installation reference points 301 when there is no need to distinguish them individually. Note that the number of installation reference points 301 is not limited to four, and may be one, two, three, or four or more. Also, the number of installation reference points 201 and installation reference points 301 does not necessarily have to match.

搬送部品据付基準点データ164は、予め外部装置から送信されて記憶部160に格納されている。搬送部品据付基準点データ164は、搬送部品200における複数の据付基準点201(図3)の位置を、搬送部品200の所定の点を原点とする座標系の3D座標によって表す。据付部品据付基準点データ165は、予め外部装置から送信されて記憶部160に格納されているものである。据付部品据付基準点データ165は、据付部品300における複数の据付基準点301(図4)の位置を、据付部品300の所定の点を原点とする座標系の3D座標によって表す。 Conveying component installation reference point data 164 is transmitted in advance from an external device and stored in storage unit 160 . The transfer component installation reference point data 164 represents the positions of a plurality of installation reference points 201 (FIG. 3) on the transfer component 200 by 3D coordinates in a coordinate system with a predetermined point on the transfer component 200 as the origin. The installation component installation reference point data 165 is transmitted in advance from an external device and stored in the storage unit 160 . The installation component installation reference point data 165 represents the positions of a plurality of installation reference points 301 (FIG. 4) on the installation component 300 by 3D coordinates in a coordinate system with a predetermined point on the installation component 300 as the origin.

搬送姿勢制約データ166は、予め外部装置から送信されて記憶部160に格納されているものである。搬送姿勢制約データ166は、搬送部品200をクレーンによって吊り上げ搬送する際の搬送部品200の姿勢に対する制約を表す。クレーン仕様データ167は、予め記憶部160に格納されているものであり、例えば、電動アクチュエータの分解能、吊り上げ荷重制限、搬送速度等のクレーンの仕様を表す。 The transport attitude constraint data 166 is transmitted in advance from an external device and stored in the storage unit 160 . The transfer posture constraint data 166 represents a constraint on the posture of the transport component 200 when the transport component 200 is lifted and transported by a crane. The crane specification data 167 is stored in the storage unit 160 in advance, and represents crane specifications such as the resolution of the electric actuator, the lifting load limit, and the transport speed.

演算部170は、コンピュータが備えるCPUからなり、該CPUが所定のプログラムを実行することにより、据付制御装置100の全体を制御するとともに、搬送部品位置検出部171、据付部品位置検出部172、搬送パス算出部173、及び制御量算出部174の各機能ブロックを実現する。 The calculation unit 170 is composed of a CPU provided in a computer, and the CPU executes a predetermined program to control the installation control device 100 as a whole, and to control the conveyed part position detector 171, the installed part position detector 172, the conveyer Each functional block of the path calculation unit 173 and the control amount calculation unit 174 is realized.

搬送部品位置検出部171は、計測データ161、及び搬送部品3D形状データ162に基づき、計測データ161によって表される作業空間における搬送部品200を識別し、その3D座標位置を算出する。さらに、搬送部品位置検出部171は、搬送部品200の3D座標位置、及び搬送部品据付基準点データ164に基づき、搬送部品200の複数の据付基準点201の作業空間における3D座標位置を算出する。 The conveyed component position detection unit 171 identifies the conveyed component 200 in the work space represented by the measured data 161 based on the measured data 161 and the conveyed component 3D shape data 162, and calculates its 3D coordinate position. Further, the conveyed component position detection unit 171 calculates the 3D coordinate positions of the plurality of installation reference points 201 of the conveyed component 200 in the work space based on the 3D coordinate positions of the conveyed component 200 and the conveyed component installation reference point data 164 .

据付部品位置検出部172は、計測データ161、及び据付部品3D形状データ163に基づき、計測データ161によって表される作業空間における据付部品300を識別し、その3D座標位置を算出する。さらに、据付部品位置検出部172は、据付部品300の3D座標位置、及び据付部品据付基準点データ165に基づき、据付部品300の複数の据付基準点301の作業空間における3D座標位置を算出する。 The installation component position detection unit 172 identifies the installation component 300 in the workspace represented by the measurement data 161 based on the measurement data 161 and the installation component 3D shape data 163, and calculates its 3D coordinate position. Furthermore, based on the 3D coordinate position of the installation component 300 and the installation component installation reference point data 165, the installation component position detection unit 172 calculates the 3D coordinate positions of the multiple installation reference points 301 of the installation component 300 in the work space.

搬送パス算出部173は、搬送部品200の複数の据付基準点201の3D座標位置を始点、据付部品300の複数の据付基準点301の3D座標位置を終点とする最短距離の搬送パスを算出する。図3及び図4の場合、搬送部品200の4点の据付基準点201~201が据付部品300の4点の据付基準点301~301に一致するように搬送パスが算出される。 The conveying path calculation unit 173 calculates the shortest conveying path whose start point is the 3D coordinate position of the plurality of installation reference points 201 of the conveying part 200 and whose end point is the 3D coordinate position of the plurality of installation reference points 301 of the installation part 300 . . 3 and 4, the transport path is calculated so that the four installation reference points 201 1 to 201 4 of the transport component 200 coincide with the four installation reference points 301 1 to 301 4 of the installation component 300. .

制御量算出部174は、算出された搬送パス、及びクレーン仕様データ167に基づき、クレーン制御部140によるクレーンの電動アクチュエータの制御量を算出する。 The control amount calculation unit 174 calculates the control amount of the electric actuator of the crane by the crane control unit 140 based on the calculated transport path and the crane specification data 167 .

<据付制御装置100による据付自動処理>
次に、図5は、据付制御装置100による据付自動処理の一例を示している。
<Automatic Installation Processing by Installation Control Device 100>
Next, FIG. 5 shows an example of automatic installation processing by the installation control device 100. As shown in FIG.

前提として、既に記憶部160には、計測データ161、搬送部品3D形状データ162、据付部品3D形状データ163、搬送部品据付基準点データ164、据付部品据付基準点データ165、搬送姿勢制約データ166、及びクレーン仕様データ167が格納されているものとする。該据付自動処理は、作業空間において作業者がワイヤ等によって搬送部品200をクレーンに取り付けた後、据付制御装置100のオペレータが所定の開始操作を行うことに応じて開始される。 As a premise, the storage unit 160 already stores measurement data 161, transfer part 3D shape data 162, installation part 3D shape data 163, transfer part installation reference point data 164, installation part installation reference point data 165, transfer attitude constraint data 166, and crane specification data 167 are stored. The automatic installation process is started when the operator of the installation control device 100 performs a predetermined start operation after the worker attaches the transfer component 200 to the crane with a wire or the like in the work space.

はじめに、演算部170が、記憶部160に格納されている各種のデータを読み込む(ステップS11)。次に、搬送部品位置検出部171及び据付部品位置検出部172が、位置検出処理を行い、作業空間における搬送部品200及び据付部品300の位置を検出する(ステップS12)。 First, the calculation unit 170 reads various data stored in the storage unit 160 (step S11). Next, the transport component position detection unit 171 and the installation component position detection unit 172 perform position detection processing to detect the positions of the transport component 200 and the installation component 300 in the work space (step S12).

図6は、ステップS12における位置検出処理の一例を説明するフローチャートである。まず、搬送部品位置検出部171が、計測データ161及び搬送部品3D形状データ162に基づき、計測データ161が表す作業空間における搬送部品200を識別し、作業空間における搬送部品200の3D座標位置を算出する(ステップS21)。 FIG. 6 is a flowchart illustrating an example of position detection processing in step S12. First, the conveyed component position detection unit 171 identifies the conveyed component 200 in the work space represented by the measurement data 161 based on the measurement data 161 and the conveyed component 3D shape data 162, and calculates the 3D coordinate position of the conveyed component 200 in the work space. (step S21).

具体的には、搬送部品200の識別は、計測データ161を平面フィッティング処理等により3D形状化し、計測データ161の3D形状と、搬送部品3D形状データとの形状特徴量を比較することにより、計測データ161のうち、搬送部品200を表す点列を抽出する。また、搬送部品200の3D座標位置の算出は、計測データ161では搬送部品200の全体を表しきれておらず、隠れている部分が存在する可能性があるため、搬送部品200の全体を表す搬送部品3D形状データ162を、計測データ161における搬送部品200を表す点列と一致するように配置することにより、作業空間における搬送部品200の3D座標位置を算出する。 Specifically, the transport component 200 is identified by converting the measurement data 161 into a 3D shape by plane fitting processing or the like, and comparing the shape feature amount between the 3D shape of the measurement data 161 and the 3D shape data of the transport component. From the data 161, a sequence of points representing the conveyed parts 200 is extracted. In addition, the 3D coordinate position of the conveyed component 200 is calculated because the measurement data 161 cannot fully represent the conveyed component 200 and there may be hidden portions. By arranging the part 3D shape data 162 so as to match the point sequence representing the conveyed part 200 in the measurement data 161, the 3D coordinate position of the conveyed part 200 in the work space is calculated.

次に、据付部品位置検出部172が、計測データ161及び据付部品3D形状データ163に基づき、計測データ161が表す作業空間における据付部品300を識別し、作業空間における据付部品300の3D座標位置を算出する(ステップS22)。具体的には、搬送部品位置検出部171によるステップS21の処理と同様なので、その説明は省略する。 Next, based on the measurement data 161 and the installation part 3D shape data 163, the installation part position detection unit 172 identifies the installation part 300 in the work space represented by the measurement data 161, and determines the 3D coordinate position of the installation part 300 in the work space. Calculate (step S22). Specifically, the processing is the same as the processing of step S21 by the conveyed component position detection unit 171, so the description thereof will be omitted.

次に、搬送部品位置検出部171が、作業空間における搬送部品200の3D座標位置、及び搬送部品据付基準点データ164に基づき、搬送部品200の複数の据付基準点201の作業空間における3D座標位置を算出する(ステップS23)。具体的には、搬送部品据付基準点データ164が表す搬送部品200における複数の据付基準点201の座標を、作業空間の座標系の座標に変換することにより、搬送部品200の複数の据付基準点201の作業空間における3D座標位置を算出する。 Next, based on the 3D coordinate position of the conveyed component 200 in the work space and the conveyed component installation reference point data 164, the conveyed component position detection unit 171 detects the 3D coordinate positions of the plurality of installation reference points 201 of the conveyed component 200 in the work space. is calculated (step S23). Specifically, by converting the coordinates of the plurality of installation reference points 201 of the transfer component 200 represented by the transfer component installation reference point data 164 into the coordinates of the coordinate system of the work space, the plurality of installation reference points of the transfer component 200 can be obtained. Calculate the 3D coordinate position in the workspace of 201 .

次に、据付部品位置検出部172が、作業空間における据付部品300の3D座標位置、及び据付部品据付基準点データ165に基づき、据付部品300の複数の据付基準点301の作業空間における3D座標位置を算出する(ステップS24)。具体的には、搬送部品位置検出部171によるステップS23の処理と同様なので、その説明は省略する。以上で、図5のステップS12における位置検出処理は終了される。なお、上述したステップS21,S22の処理は、実行する順序を入れ替えてもよいし、並行して実行するようにしてもよい。ステップS23,S24の処理についても同様である。 Next, based on the 3D coordinate position of the installation part 300 in the work space and the installation part installation reference point data 165, the installation part position detection unit 172 detects the 3D coordinate positions of the plurality of installation reference points 301 of the installation part 300 in the work space. is calculated (step S24). Specifically, since it is the same as the processing of step S23 by the conveyed component position detection unit 171, the description thereof will be omitted. With this, the position detection processing in step S12 of FIG. 5 is terminated. The processing of steps S21 and S22 described above may be performed in a different order, or may be performed in parallel. The same applies to the processing of steps S23 and S24.

図5に戻る。上述した位置検出処理により、搬送部品200の複数の据付基準点201、及び据付部品300の複数の据付基準点301の作業空間のおける3D座標位置が算出された後、次に、搬送パス算出部173が、搬送パス算出処理を実行する(ステップS13)。 Return to FIG. After the 3D coordinate positions in the work space of the plurality of installation reference points 201 of the transport component 200 and the plurality of installation reference points 301 of the installation component 300 are calculated by the above-described position detection processing, next, the transport path calculation unit 173 executes a conveying path calculation process (step S13).

図7は、ステップS13における搬送パス算出処理の一例を説明するフローチャートである。まず、搬送パス算出部173が、搬送部品200の複数の据付基準点201の作業空間における3D座標位置を搬送パスの始点、据付部品300の複数の据付基準点301の作業空間における3D座標位置を搬送パスの始点に設定する(ステップS31)。 FIG. 7 is a flowchart illustrating an example of the conveying path calculation process in step S13. First, the conveying path calculation unit 173 calculates the 3D coordinate positions of the plurality of installation reference points 201 of the conveying part 200 in the work space as the start point of the conveying path, and the 3D coordinate positions of the plurality of installation reference points 301 of the mounting part 300 in the work space. The starting point of the conveying path is set (step S31).

次に、搬送パス算出部173が、計測データ161が表す作業空間における搬送部品200及び据付部品300以外の構造物を障害物に設定する(ステップS32)。具体的には、計測データ161から、ステップS21で算出した搬送部品200の3D座標位置の点列、及びステップS22で算出した据付部品300の3D座標位置の点列を削除し、残った点列を作業空間における障害物として抽出する。 Next, the transport path calculation unit 173 sets structures other than the transport component 200 and the installation component 300 in the work space represented by the measurement data 161 as obstacles (step S32). Specifically, the point sequence of the 3D coordinate position of the conveying component 200 calculated in step S21 and the point sequence of the 3D coordinate position of the installation component 300 calculated in step S22 are deleted from the measurement data 161, and the remaining point sequence is extracted as an obstacle in the workspace.

次に、搬送パス算出部173が、搬送中の搬送部品200が障害物と干渉しないこと、及び搬送姿勢制約データ166が表す搬送中の搬送部品200に対する姿勢の遷移の制限を制約とし、始点から終点までの搬送パスの最短距離を求める問題を最適化問題として帰着する(ステップS33)。この最適化問題は、例えば、混合整数計画問題や最短グラフ探索問題等に帰着してもよい。 Next, the conveying path calculation unit 173 constrains that the conveyed part 200 being conveyed does not interfere with obstacles and restricts the attitude transition of the conveying part 200 that is being conveyed represented by the conveying attitude constraint data 166. The problem of obtaining the shortest distance of the conveying path to the end point is reduced as an optimization problem (step S33). This optimization problem may, for example, be reduced to a mixed integer programming problem, a shortest graph search problem, or the like.

次に、搬送パス算出部173が、搬送パスの最適化問題を最適化解法を用いて求解し、搬送パスを算出する(ステップS34)最適化解法としては、例えば、MIP(Mixed Integer Programming)ソルバーや、遺伝的アルゴリズムや、ダイクストラ法等用いて最適解または準最適解を求めるようにしてもよい。以上で、搬送パス算出処理は終了される。 Next, the transport path calculation unit 173 solves the optimization problem of the transport path using the optimization solution method and calculates the transport path (step S34). Alternatively, an optimal solution or a quasi-optimal solution may be obtained using a genetic algorithm, the Dijkstra method, or the like. With this, the conveying path calculation process is completed.

図5に戻る。上述した搬送パス算出処理によって搬送パスが算出された後、次に、制御量算出部174が、搬送パス、及びクレーン仕様データ167に基づき、クレーンが搬送パスを通って据付作業を実行するようにクレーンの電動アクチュエータの制御量を算出してクレーン制御部140に出力する(ステップS14)。 Return to FIG. After the conveying path is calculated by the conveying path calculation process described above, next, the control amount calculating unit 174 controls the conveying path and the crane specification data 167 so that the crane performs the installation work through the conveying path. A control amount of the electric actuator of the crane is calculated and output to the crane control unit 140 (step S14).

次に、クレーン制御部140が、制御量算出部174から入力された制御量に従って電動アクチュエータを動作させる(ステップS15)。これにより、クレーンによる据付作業が実現される。以上で、据付制御装置100による据付自動処理は終了される。 Next, the crane control unit 140 operates the electric actuator according to the control amount input from the control amount calculation unit 174 (step S15). As a result, installation work using a crane is realized. With this, the automatic installation process by the installation control device 100 is completed.

以上に説明した据付制御装置100による据付自動処理によれば、据付部品300に対して搬送部品200を据え付ける据付作業を自動化することが可能となる。 According to the automatic installation processing by the installation control device 100 described above, it is possible to automate the installation work of installing the transfer component 200 on the installation component 300 .

<変形例>
本実施形態によれば、クレーンによる据付作業までを自動化しているが、算出された搬送パス、及び算出された電動アクチュエータの制御量の少なくとも一方を、出力部120としてのディスプレイに表示してクレーンのオペレータに提示し、クレーンの操作はオペレータが実行するようにしてもよい。
<Modification>
According to this embodiment, up to the installation work by the crane is automated. may be presented to the operator, and the crane operation may be performed by the operator.

また、本実施形態は、クレーンを制御対象としているが、搬送部品を据付部品に据え付けるロボット等を制御対象としてもよい。 Also, in this embodiment, the control target is a crane, but the control target may be a robot or the like that installs a conveying part on an installation part.

本発明は、上述した実施形態に限定されるものではなく、様々な変形が可能である。例えば、上述した実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えたり、追加したりすることが可能である。 The present invention is not limited to the embodiments described above, and various modifications are possible. For example, the above-described embodiments have been described in detail in order to explain the present invention in an easy-to-understand manner, and are not necessarily limited to those having all the described configurations. Also, part of the configuration of one embodiment can be replaced with or added to the configuration of another embodiment.

また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、SSD(Solid State Drive)等の記録装置、または、ICカード、SDカード、DVD等の記録媒体に置くことができる。また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。 Further, each of the above configurations, functions, processing units, processing means, and the like may be realized by hardware, for example, by designing a part or all of them using an integrated circuit. Moreover, each of the above configurations, functions, etc. may be realized by software by a processor interpreting and executing a program for realizing each function. Information such as programs, tables, and files that implement each function can be stored in recording devices such as memories, hard disks, SSDs (Solid State Drives), or recording media such as IC cards, SD cards, and DVDs. In addition, the control lines and information lines indicate those considered to be necessary for explanation, and not all the control lines and information lines are necessarily indicated on the product. In practice, it may be considered that almost all configurations are interconnected.

100・・・据付制御装置、110・・・入力部、120・・・出力部、130・・・計測部、140・・・クレーン制御部、150・・・通信部、160・・・記憶部、161・・・計測データ、162・・・搬送部品3D形状データ、163・・・据付部品3D形状データ、164・・・搬送部品据付基準点データ、165・・・据付部品据付基準点データ、166・・・搬送姿勢制約データ、167・・・クレーン仕様データ、170・・・演算部、171・・・搬送部品位置検出部、172・・・据付部品位置検出部、173・・・搬送パス算出部、174・・・制御量算出部、200・・・搬送部品、201・・・据付基準点、300・・・据付部品、301・・・据付基準点 DESCRIPTION OF SYMBOLS 100... Installation control apparatus, 110... Input part, 120... Output part, 130... Measurement part, 140... Crane control part, 150... Communication part, 160... Storage part , 161... measurement data, 162... transfer part 3D shape data, 163... installation part 3D shape data, 164... transfer part installation reference point data, 165... installation part installation reference point data, 166 Conveyance posture constraint data 167 Crane specification data 170 Calculation unit 171 Conveyed parts position detection unit 172 Installed parts position detection unit 173 Conveyance path Calculation unit 174 Control amount calculation unit 200 Conveying parts 201 Installation reference point 300 Installation parts 301 Installation reference point

Claims (6)

搬送部品を吊り上げ搬送して据付部品に据え付ける据付作業を制御する据付制御装置であって、
前記搬送部品及び前記据付部品を含む作業空間の形状を表す計測データを計測する計測部と、
前記計測データ及び搬送部品3D形状データに基づき、前記作業空間における前記搬送部品の位置を検出する搬送部品位置検出部と、
前記計測データ及び据付部品3D形状データに基づき、前記作業空間における前記据付部品の位置を検出する据付部品位置検出部と、
前記作業空間における前記搬送部品の位置から前記据付部品の位置までの前記搬送部品の搬送パスを算出する搬送パス算出部と、
算出された前記搬送パスに基づき、前記据付作業を実行するクレーンを制御するための制御量を算出する制御量算出部と、
を備えることを特徴とする据付制御装置。
An installation control device for controlling the installation work of lifting and conveying a conveying part and installing it on an installation part,
a measurement unit that measures measurement data representing the shape of the work space including the conveying part and the installation part;
a transport component position detection unit that detects the position of the transport component in the work space based on the measurement data and the 3D shape data of the transport component;
an installation part position detection unit that detects the position of the installation part in the work space based on the measurement data and the 3D shape data of the installation part;
a conveying path calculation unit that calculates a conveying path of the conveyed part from the position of the conveyed part to the position of the installation part in the work space;
a control amount calculation unit that calculates a control amount for controlling a crane that performs the installation work based on the calculated conveying path;
An installation control device comprising:
請求項1に記載の据付制御装置であって、
前記搬送部品位置検出部は、搬送部品据付基準点データに基づき、前記搬送部品の複数の据付基準点の前記作業空間における位置を算出し、
前記据付部品位置検出部は、据付部品据付基準点データに基づき、前記据付部品の複数の据付基準点の前記作業空間における位置を算出し、
前記搬送パス算出部は、前記作業空間における前記搬送部品の複数の据付基準点の位置を始点、前記据付部品の複数の据付基準点の位置を終点とする前記搬送パスを算出する
ことを特徴とする据付制御装置。
The installation control device of claim 1, comprising:
The conveyed component position detection unit calculates the positions of the plurality of installation reference points of the conveyed component in the work space based on the conveyed component installation reference point data,
The installation component position detection unit calculates the positions of the plurality of installation reference points of the installation component in the work space based on the installation component installation reference point data,
The conveying path calculation unit calculates the conveying path having starting points at positions of a plurality of installation reference points of the conveyed part in the work space and positions of a plurality of installation reference points of the installation part as ending points. installation control device.
請求項1に記載の据付制御装置であって、
算出された前記制御量に基づいて前記クレーンを操作するための電動アクチュエータを制御するクレーン制御部、
を備えることを特徴とする据付制御装置。
The installation control device of claim 1, comprising:
a crane control unit that controls an electric actuator for operating the crane based on the calculated control amount;
An installation control device comprising:
請求項1に記載の据付制御装置であって、
算出された前記搬送パス、及び前記制御量の少なくとも一方を前記クレーンのオペレータに提示する出力部、
を備えることを特徴とする据付制御装置。
The installation control device of claim 1, comprising:
an output unit that presents at least one of the calculated conveying path and the control amount to an operator of the crane;
An installation control device comprising:
請求項1に記載の据付制御装置であって、
前記搬送パス算出部は、搬送中の前記搬送部品が姿勢制約を満たすように前記搬送パスを算出する
ことを特徴とする据付制御装置。
The installation control device of claim 1, comprising:
The installation control device, wherein the conveying path calculation unit calculates the conveying path so that the conveyed part being conveyed satisfies an attitude constraint.
搬送部品を吊り上げ搬送して据付部品に据え付ける据付作業を制御する据付制御装置の据付制御方法であって、
前記搬送部品及び前記据付部品を含む作業空間の形状を表す計測データを計測する計測ステップと、
前記計測データ及び搬送部品3D形状データに基づき、前記作業空間における前記搬送部品の位置を検出する搬送部品位置検出ステップと、
前記計測データ及び据付部品3D形状データに基づき、前記作業空間における前記据付部品の位置を検出する据付部品位置検出ステップと、
前記作業空間における前記搬送部品の位置から前記据付部品の位置までの前記搬送部品の搬送パスを算出する搬送パス算出ステップと、
算出された前記搬送パスに基づき、前記据付作業を実行するクレーンを制御するための制御量を算出する制御量算出ステップと、
を含むことを特徴とする据付制御方法。
An installation control method for an installation control device for controlling installation work of lifting and conveying a conveyed part and installing it on an installation part, comprising:
a measurement step of measuring measurement data representing a shape of a work space including the conveying part and the installation part;
a transport component position detection step of detecting the position of the transport component in the work space based on the measurement data and the 3D shape data of the transport component;
an installation part position detection step of detecting the position of the installation part in the work space based on the measurement data and the 3D shape data of the installation part;
a conveying path calculation step of calculating a conveying path of the conveying part from a position of the conveying part to a position of the installation part in the work space;
a control amount calculation step of calculating a control amount for controlling a crane that performs the installation work based on the calculated conveying path;
An installation control method, comprising:
JP2020015942A 2020-02-03 2020-02-03 Installation control device and installation control method Active JP7264839B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2020015942A JP7264839B2 (en) 2020-02-03 2020-02-03 Installation control device and installation control method
PCT/JP2020/033857 WO2021157114A1 (en) 2020-02-03 2020-09-08 Installation control device and installation control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020015942A JP7264839B2 (en) 2020-02-03 2020-02-03 Installation control device and installation control method

Publications (2)

Publication Number Publication Date
JP2021123433A JP2021123433A (en) 2021-08-30
JP7264839B2 true JP7264839B2 (en) 2023-04-25

Family

ID=77199795

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020015942A Active JP7264839B2 (en) 2020-02-03 2020-02-03 Installation control device and installation control method

Country Status (2)

Country Link
JP (1) JP7264839B2 (en)
WO (1) WO2021157114A1 (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000243600A (en) 1999-02-16 2000-09-08 Toshiba Corp Installation position control device and method of accelerator equipment, and storage medium
JP2006256848A (en) 2005-03-18 2006-09-28 Mitsui Eng & Shipbuild Co Ltd Cargo handling support method and cargo handling support system
JP2008152380A (en) 2006-12-14 2008-07-03 Toyohashi Univ Of Technology Conveyance method of overhead crane using laser pointer and overhead crane system
JP2008214009A (en) 2007-03-02 2008-09-18 Sintokogio Ltd Carrying method by overhead traveling crane and overhead traveling crane system using the carrying method
JP2009155056A (en) 2007-12-27 2009-07-16 Seiko Precision Inc Image processing device, baggage carrying facility, and program
JP2009269110A (en) 2008-05-02 2009-11-19 Olympus Corp Assembly equipment
WO2013108749A1 (en) 2012-01-16 2013-07-25 株式会社日立製作所 Delivery route planning system
JP2016132538A (en) 2015-01-20 2016-07-25 株式会社日立製作所 Carrying-in and installation work plan support device and carrying-in and installation work plan support method

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013069100A (en) * 2011-09-22 2013-04-18 Dainippon Screen Mfg Co Ltd Three-dimensional position/posture recognition device, industrial robot, three-dimensional position/posture recognition method, program and storing medium
JP6772803B2 (en) * 2016-12-09 2020-10-21 株式会社タダノ crane
JP7025896B2 (en) * 2017-11-13 2022-02-25 株式会社日立産機システム Crane system and crane control method

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000243600A (en) 1999-02-16 2000-09-08 Toshiba Corp Installation position control device and method of accelerator equipment, and storage medium
JP2006256848A (en) 2005-03-18 2006-09-28 Mitsui Eng & Shipbuild Co Ltd Cargo handling support method and cargo handling support system
JP2008152380A (en) 2006-12-14 2008-07-03 Toyohashi Univ Of Technology Conveyance method of overhead crane using laser pointer and overhead crane system
JP2008214009A (en) 2007-03-02 2008-09-18 Sintokogio Ltd Carrying method by overhead traveling crane and overhead traveling crane system using the carrying method
JP2009155056A (en) 2007-12-27 2009-07-16 Seiko Precision Inc Image processing device, baggage carrying facility, and program
JP2009269110A (en) 2008-05-02 2009-11-19 Olympus Corp Assembly equipment
WO2013108749A1 (en) 2012-01-16 2013-07-25 株式会社日立製作所 Delivery route planning system
JP2016132538A (en) 2015-01-20 2016-07-25 株式会社日立製作所 Carrying-in and installation work plan support device and carrying-in and installation work plan support method

Also Published As

Publication number Publication date
WO2021157114A1 (en) 2021-08-12
JP2021123433A (en) 2021-08-30

Similar Documents

Publication Publication Date Title
JP6704157B1 (en) Robot system with dynamic packing mechanism
US20200139547A1 (en) Teaching device, teaching method, and robot system
JP6450727B2 (en) Apparatus, method, program, and recording medium for simulating article alignment work performed by robot
JP5872894B2 (en) Robot motion teaching support apparatus and method
US10919153B2 (en) Teaching method for teaching operations to a plurality of robots and teaching system used therefor
EP3166084B1 (en) Method and system for determining a configuration of a virtual robot in a virtual environment
KR100680413B1 (en) Robot instruction program for instructing robot, cassette using the same, location measurement apparatus and method of operating robot using the same
US11185984B2 (en) Method and apparatus for controlling robot
WO2004085120A1 (en) Robot simulation device, and robot simulation program
JP6653064B2 (en) Simulation apparatus, robot, simulation method, and program therefor
WO2022091421A1 (en) Industrial system, abnormality detection system, and abnormality detection method
US11370120B2 (en) Method and system for teaching a robot in reaching a given target in robot manufacturing
CN114080590A (en) Robotic bin picking system and method using advanced scanning techniques
JP7264839B2 (en) Installation control device and installation control method
JP2012003489A (en) Simulation system
US11518024B2 (en) Extensible underconstrained robotic motion planning
US10339230B2 (en) Simulation apparatus and method of an article and a conveyor in a 3D simulated space
JPWO2018189851A1 (en) Transfer operation control device, system, method and program
CN112847329A (en) Trajectory of simulation robot
JP3411770B2 (en) Off-line automatic teaching method of sensing pattern and sensing operation simulation method
JP7481472B2 (en) Control device and control method
WO2022070560A1 (en) Operation control method, operation control system, and target point setting device
US20230109876A1 (en) Information processing apparatus, information processing method, and method of manufacturing products
TWI818717B (en) Work program production system and work program production method
JP2013158845A (en) Robot device, image generation device, image generation method, and image generation program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220420

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: 20230404

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230413

R151 Written notification of patent or utility model registration

Ref document number: 7264839

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151