JP2010224765A - Program, device and method for analyzing approach prohibited space - Google Patents

Program, device and method for analyzing approach prohibited space Download PDF

Info

Publication number
JP2010224765A
JP2010224765A JP2009070000A JP2009070000A JP2010224765A JP 2010224765 A JP2010224765 A JP 2010224765A JP 2009070000 A JP2009070000 A JP 2009070000A JP 2009070000 A JP2009070000 A JP 2009070000A JP 2010224765 A JP2010224765 A JP 2010224765A
Authority
JP
Japan
Prior art keywords
space
entry prohibition
data
shape
prohibition 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.)
Granted
Application number
JP2009070000A
Other languages
Japanese (ja)
Other versions
JP5381208B2 (en
Inventor
Akira Kato
朗 加藤
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP2009070000A priority Critical patent/JP5381208B2/en
Publication of JP2010224765A publication Critical patent/JP2010224765A/en
Application granted granted Critical
Publication of JP5381208B2 publication Critical patent/JP5381208B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To appropriately determine an approach prohibited area other than an interference area. <P>SOLUTION: An interference space determination means 1b determines the interference space 4 at which a movable part of equipment 2 arrives based on equipment data stored in an equipment data memory means 1a. An approach prohibited space determination means 1c determines an interference space 4 and an approach prohibited space 5 including the space below the interference space 4. An approach prohibited space data storage means 1d stores the approach prohibited space data which shows a position and a shape of the approach prohibited space 5 in an approach prohibited space data memory means 1e. <P>COPYRIGHT: (C)2011,JPO&INPIT

Description

本発明は機器の周囲の進入禁止空間を分析するための進入禁止空間分析プログラム、進入禁止空間分析装置、および進入禁止空間分析方法に関する。   The present invention relates to an entry prohibition space analysis program, an entry prohibition space analysis device, and an entry prohibition space analysis method for analyzing an entry prohibition space around a device.

工場には、人が立ち入ることが原則として禁止される区域がある。例えば、ロボットのハンド部が届く範囲内は作業員が不用意に立ち入らないように柵によって囲まれている。工場のレイアウトを設計する場合、このような立ち入り禁止区域の割り出しが行われる。例えば、工場内にロボットを配置するのであれば、ロボットの動作をシミュレートすることで、ロボットと干渉を起こす領域を判定する技術がある。この技術を利用して、ロボット周囲の立ち入り禁止区域を判定できる。また、移動する物体の干渉空間を判定する技術もある。   In factories, there are areas where people are generally prohibited from entering. For example, an area within the reach of the robot hand is surrounded by a fence so that workers do not enter carelessly. When designing the layout of a factory, such restricted areas are indexed. For example, if a robot is arranged in a factory, there is a technique for determining an area causing interference with the robot by simulating the operation of the robot. Using this technology, it is possible to determine the restricted areas around the robot. There is also a technique for determining the interference space of a moving object.

特開2005−81445号公報JP 2005-81445 A 特開2008−234622号公報JP 2008-234622 A

しかし、ロボットの動作シミュレートによって判定できる干渉空間のみを進入禁止とした場合、干渉空間ではないが、人や他の機械が進入すべきではない空間を見落とす可能性がある。例えばロボットが、ハンド部によって掴んでいた積載物を落とす可能性もある。このような落下物の到達範囲は、ロボットの動作シミュレーションだけでは判別することができない。これはロボットに限らず、運搬物または装置自身の部品などの物品を落下させる可能性があるすべての機器に共通の問題である。   However, if only the interference space that can be determined by simulating the robot motion is prohibited, there is a possibility that a space that is not an interference space but should not be entered by humans or other machines may be overlooked. For example, there is a possibility that the robot drops a load held by the hand unit. Such a reach of fallen objects cannot be determined only by a robot motion simulation. This is a problem common not only to robots but also to all devices that may drop articles such as transported items or parts of the device itself.

本発明はこのような点に鑑みてなされたものであり、進入禁止空間を適切に判定することができる進入禁止空間分析プログラム、進入禁止空間分析装置、および進入禁止空間分析方法を提供することを目的とする。   The present invention has been made in view of such points, and provides an entry prohibition space analysis program, an entry prohibition space analysis device, and an entry prohibition space analysis method that can appropriately determine an entry prohibition space. Objective.

上記課題を解決するために、コンピュータに以下の処理を実行させる進入禁止空間分析プログラムが提供される。コンピュータは、機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、機器データに基づき、機器の可動部分が到達可能な干渉空間を判定する。次にコンピュータは、干渉空間と、干渉空間よりも下の空間とを含む進入禁止空間を判定する。さらにコンピュータは、進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する。   In order to solve the above problem, an entry prohibition space analysis program for causing a computer to execute the following processing is provided. The computer refers to device data storage means in which device data indicating the device structure is stored in advance, and determines an interference space that the movable part of the device can reach based on the device data. Next, the computer determines an entry prohibition space including an interference space and a space below the interference space. Further, the computer stores the entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means.

また、上記課題を解決するために、上記進入禁止空間分析プログラムを実行するコンピュータと同様の機能を有する進入禁止空間分析装置が提供される。さらに、上記進入禁止空間分析プログラムを実行するコンピュータと同様の手順で処理を実行する進入禁止空間分析方法が提供される。   Moreover, in order to solve the said subject, the entry prohibition space analysis apparatus which has the function similar to the computer which performs the said entry prohibition space analysis program is provided. Furthermore, there is provided an entry prohibition space analysis method for executing processing in the same procedure as a computer executing the entry prohibition space analysis program.

落下物を想定した適切な進入禁止空間を判定することができる。   An appropriate entry-prohibited space that assumes a fallen object can be determined.

実施の形態の概要を示す図である。It is a figure which shows the outline | summary of embodiment. 本実施の形態に用いる設備配置計画支援装置のハードウェア構成例を示す図である。It is a figure which shows the hardware structural example of the equipment arrangement plan assistance apparatus used for this Embodiment. 設備配置計画支援装置の機能を示すブロック図である。It is a block diagram which shows the function of an equipment arrangement plan assistance apparatus. 機器データ記憶部内のデータ例を示す図である。It is a figure which shows the example of data in an apparatus data storage part. 機器データのデータ構造例を示す図である。It is a figure which shows the data structure example of apparatus data. 積載物データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of payload data. 円柱形の部品データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of cylindrical part data. 多角錘状の部品データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of component data of a polygonal cone shape. 進入禁止空間の判定および柵配置の処理手順を示すフローチャートである。It is a flowchart which shows the procedure of determination of entry prohibition space, and a fence arrangement | positioning. 外接形状作成処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of circumscribed shape creation processing. 外接形状を得るためのロボットの姿勢を示す図である。It is a figure which shows the attitude | position of the robot for obtaining a circumscribed shape. 外接形状作成後の干渉空間データ記憶部内のデータを示す図である。It is a figure which shows the data in the interference space data storage part after circumscribed shape preparation. 外接形状付き機器データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of apparatus data with circumscribed shape. 最大移動軌跡作成処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of the maximum movement locus | trajectory creation process. 移動情報入力処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of a movement information input process. 移動する機器の軌跡の例を示す図である。It is a figure which shows the example of the locus | trajectory of the apparatus to move. 進行方向に平行な軸回りの回転運動における軌跡形状を示す図である。It is a figure which shows the locus | trajectory shape in the rotational motion around the axis | shaft parallel to a advancing direction. 鉛直方向の軸回りの回転運動における軌跡形状を示す図である。It is a figure which shows the locus | trajectory shape in the rotational movement around the axis | shaft of a perpendicular direction. 軌跡形状作成処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of a locus | trajectory shape creation process. 最大移動軌跡作成後の干渉空間データ記憶部の格納データを示す図である。It is a figure which shows the storage data of the interference space data memory | storage part after the largest movement locus | trajectory creation. 移動軌跡付き機器データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of apparatus data with a movement locus | trajectory. 軌跡形状データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of locus | trajectory shape data. 進入禁止空間作成処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of an entry prohibition space creation process. 進入禁止空間データ記憶部内のデータ例を示す図である。It is a figure which shows the example of data in the entry prohibition space data storage part. 進入禁止空間付き機器データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of apparatus data with entry prohibition space. 柵部品配置処理の手順を示すフローチャートである。It is a flowchart which shows the procedure of a fence components arrangement | positioning process. 工場の製造ラインへの機器の配置を示す図である。It is a figure which shows arrangement | positioning of the apparatus to the manufacturing line of a factory. ベルトコンベアの進入禁止空間を示す図である。It is a figure which shows the entry prohibition space of a belt conveyor. 電源装置の進入禁止空間を示す図である。It is a figure which shows the entry prohibition space of a power supply device. 車の進入禁止空間を示す図である。It is a figure which shows the entry prohibition space of a vehicle. クレーンの進入禁止空間を示す図である。It is a figure which shows the approach prohibition space of a crane. 進入禁止空間のX−Y平面図と進入禁止領域図とを示す図である。It is a figure which shows the XY top view and entry prohibition area | region figure of entry prohibition space. 進入禁止空間のX−Z平面図である。It is a XZ top view of entry prohibition space. 進入禁止空間のY−Z平面図である。It is a YZ top view of entry prohibition space. 柵の部品データのデータ構造例を示す図である。It is a figure which shows the example of a data structure of the components data of a fence. 工場内の機器と柵との配置を示す表示画面を示す図である。It is a figure which shows the display screen which shows arrangement | positioning of the apparatus and fence in a factory. 隠れ線処理を行って工場内の機器と柵との配置を示す表示画面を示す図である。It is a figure which shows the display screen which performs the hidden line process and shows arrangement | positioning of the apparatus and fence in a factory. 荷積み場の設備の配置例を示す図である。It is a figure which shows the example of arrangement | positioning of the equipment of a loading site. トラッククレーンの進入禁止空間を示す図である。It is a figure which shows the entry prohibition space of a truck crane. フォークリフトの進入禁止空間を示す図である。It is a figure which shows the approach prohibition space of a forklift.

以下、本実施の形態を、図面を参照して説明する。
図1は、実施の形態の概要を示す図である。進入禁止空間分析装置1は、機器の周囲の人や物の進入禁止空間の位置や形状を分析する装置である。進入禁止空間分析装置1は、機器データ記憶手段1a、干渉空間判定手段1b、進入禁止空間判定手段1c、進入禁止空間データ格納手段1d、および進入禁止空間データ記憶手段1eを有する。
Hereinafter, the present embodiment will be described with reference to the drawings.
FIG. 1 is a diagram showing an outline of the embodiment. The entry prohibition space analysis device 1 is a device that analyzes the position and shape of an entry prohibition space for people and objects around the device. The entry prohibition space analyzing apparatus 1 includes device data storage means 1a, interference space determination means 1b, entry prohibition space determination means 1c, entry prohibition space data storage means 1d, and entry prohibition space data storage means 1e.

機器データ記憶手段1aは、機器2の構造を示す機器データが予め格納されている。例えば、ロボット型の機器2のアームの長さや、関節の可動範囲などが機器データ記憶手段1aに予め格納されている。また、機器データ記憶手段1aには、機器2が運搬する運搬物3の形状を格納しておくこともできる。   The device data storage unit 1a stores device data indicating the structure of the device 2 in advance. For example, the arm length of the robot-type device 2, the movable range of the joint, and the like are stored in advance in the device data storage means 1a. Moreover, the shape of the conveyed product 3 which the apparatus 2 conveys can also be stored in the apparatus data storage means 1a.

干渉空間判定手段1bは、機器データ記憶手段1aに格納されている機器データに基づき、機器2の可動部分が到達可能な干渉空間4を判定する。機器2の可動部分とは、該当部分の占める空間を移動させることが可能な部分である。例えば図1に示すように機器2がロボットであれば、ロボットのアーム部分が可動部分に相当する。ロボット型の機器2の場合、干渉空間4は球形となる。なお、干渉空間判定手段1bは、機器2によって運搬される運搬物3の到達範囲も、干渉空間4に含めることができる。   The interference space determination unit 1b determines the interference space 4 that the movable part of the device 2 can reach based on the device data stored in the device data storage unit 1a. The movable part of the device 2 is a part that can move the space occupied by the corresponding part. For example, as shown in FIG. 1, if the device 2 is a robot, the arm portion of the robot corresponds to the movable portion. In the case of the robot-type device 2, the interference space 4 has a spherical shape. In addition, the interference space determination means 1b can also include the reach | attainment range of the conveyed product 3 conveyed by the apparatus 2 in the interference space 4. FIG.

進入禁止空間判定手段1cは、干渉空間4と、干渉空間4よりも下の空間とを含む進入禁止空間5を判定する。干渉空間4よりも下の空間は、機器2の動作中に運搬物3や機器2自身の部品を落としたときに、落下物が到達可能な空間である。なお、進入禁止空間判定手段1cは、干渉空間4と、干渉空間4の下の空間とを合わせた空間よりも、所定量だけ広げた空間を進入禁止空間とすることができる。   The entry prohibition space determination unit 1 c determines the entry prohibition space 5 including the interference space 4 and a space below the interference space 4. The space below the interference space 4 is a space where a fallen object can reach when the transported object 3 or the parts of the apparatus 2 itself are dropped during the operation of the apparatus 2. In addition, the entry prohibition space determination unit 1c can set a space that is a predetermined amount larger than the space that includes the interference space 4 and the space below the interference space 4 as the entry prohibition space.

進入禁止空間データ格納手段1dは、進入禁止空間5の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段1eに格納する。図1に示すように干渉空間4が球形の場合、進入禁止空間5は、上部が半球形となり、下部が円柱形となる。なお進入禁止空間5の位置は、例えば機器2の位置に基づいて決定される。   The entry prohibition space data storage unit 1d stores the entry prohibition space data indicating the position and shape of the entry prohibition space 5 in the entry prohibition space data storage unit 1e. As shown in FIG. 1, when the interference space 4 is spherical, the entry prohibition space 5 is hemispherical at the top and cylindrical at the bottom. The position of the entry prohibition space 5 is determined based on the position of the device 2, for example.

このように、干渉空間4に加え、干渉空間4の下の空間も進入禁止空間5とすることができる。換言すると、進入禁止空間5が、干渉空間4から鉛直方向軸の落下方向に向かい、接地面まで延伸されている。その結果、工場のレイアウト設計などの際に、干渉空間4の下に人の出入りができないように対策を施しておくことができる。その結果、安全性の高い工場のレイアウト設計が容易になる。   Thus, in addition to the interference space 4, the space below the interference space 4 can also be used as the entry prohibition space 5. In other words, the entry prohibition space 5 extends from the interference space 4 in the falling direction of the vertical axis and extends to the ground contact surface. As a result, it is possible to take measures to prevent people from entering and leaving the interference space 4 when designing a factory layout. As a result, highly safe factory layout design is facilitated.

また、予め進入禁止空間が適切に判定されていることで、実際に機器を設置した後に進入禁止空間が判明するといった不手際を防止できる。その結果、新設した工場の操業をスムーズに開始させることができる。   In addition, since the entry prohibition space is appropriately determined in advance, it is possible to prevent a trouble that the entry prohibition space becomes clear after the device is actually installed. As a result, the operation of the newly established factory can be started smoothly.

ところで、図1に示した進入禁止空間分析装置1は、工場への設備設置の計画支援を行う設備配置計画支援装置に内蔵させることができる。設備配置計画支援装置では、工場への設備の配置を行う際に、各機器の適切な進入禁止空間が分かることで、設備配置計画を容易に行うことができる。そこで、以下に、進入禁止空間判定機能を有する設備配置計画支援装置の例を用い、本実施の形態を詳細に説明する。   By the way, the entry prohibition space analyzing apparatus 1 shown in FIG. 1 can be incorporated in an equipment arrangement planning support apparatus that performs planning support for equipment installation in a factory. In the equipment arrangement planning support device, when the equipment is arranged in the factory, the equipment arrangement planning can be easily performed by knowing the appropriate entry prohibition space of each device. Therefore, in the following, the present embodiment will be described in detail using an example of a facility arrangement plan support device having an entry prohibition space determination function.

図2は、本実施の形態に用いる設備配置計画支援装置のハードウェア構成例を示す図である。設備配置計画支援装置100は、コンピュータとしてのハードウェアを備えている。具体的には、設備配置計画支援装置100は、CPU(Central Processing Unit)101によって装置全体が制御されている。CPU101には、バス108を介してRAM(Random Access Memory)102と複数の周辺機器が接続されている。   FIG. 2 is a diagram illustrating a hardware configuration example of the facility arrangement plan support apparatus used in the present embodiment. The equipment arrangement plan support apparatus 100 includes hardware as a computer. Specifically, the facility arrangement planning support apparatus 100 is controlled by a CPU (Central Processing Unit) 101 as a whole. A RAM (Random Access Memory) 102 and a plurality of peripheral devices are connected to the CPU 101 via a bus 108.

RAM102は、設備配置計画支援装置100の主記憶装置として使用される。RAM102には、CPU101に実行させるOS(Operating System)のプログラムやアプリケーションプログラムの少なくとも一部が一時的に格納される。また、RAM102には、CPU101による処理に必要な各種データが格納される。   The RAM 102 is used as a main storage device of the facility arrangement plan support apparatus 100. The RAM 102 temporarily stores at least part of an OS (Operating System) program and application programs to be executed by the CPU 101. The RAM 102 stores various data necessary for processing by the CPU 101.

バス108に接続されている周辺機器としては、ハードディスクドライブ(HDD:Hard Disk Drive)103、グラフィック処理装置104、入力インタフェース105、光学ドライブ装置106、および通信インタフェース107がある。   Peripheral devices connected to the bus 108 include a hard disk drive (HDD) 103, a graphic processing device 104, an input interface 105, an optical drive device 106, and a communication interface 107.

HDD103は、内蔵したディスクに対して、磁気的にデータの書き込みおよび読み出しを行う。HDD103は、設備配置計画支援装置100の二次記憶装置として使用される。HDD103には、OSのプログラム、アプリケーションプログラム、および各種データが格納される。なお、二次記憶装置としては、フラッシュメモリなどの半導体記憶装置を使用することもできる。   The HDD 103 magnetically writes and reads data to and from the built-in disk. The HDD 103 is used as a secondary storage device of the equipment arrangement plan support apparatus 100. The HDD 103 stores an OS program, application programs, and various data. Note that a semiconductor storage device such as a flash memory can also be used as the secondary storage device.

グラフィック処理装置104には、モニタ11が接続されている。グラフィック処理装置104は、CPU101からの命令に従って、画像をモニタ11の画面に表示させる。モニタ11としては、CRT(Cathode Ray Tube)を用いた表示装置や液晶表示装置などがある。   A monitor 11 is connected to the graphic processing device 104. The graphic processing device 104 displays an image on the screen of the monitor 11 in accordance with a command from the CPU 101. Examples of the monitor 11 include a display device using a CRT (Cathode Ray Tube) and a liquid crystal display device.

入力インタフェース105には、キーボード12とマウス13とが接続されている。入力インタフェース105は、キーボード12やマウス13から送られてくる信号をCPU101に送信する。なお、マウス13は、ポインティングデバイスの一例であり、他のポインティングデバイスを使用することもできる。他のポインティングデバイスとしては、タッチパネル、タブレット、タッチパッド、トラックボールなどがある。   A keyboard 12 and a mouse 13 are connected to the input interface 105. The input interface 105 transmits a signal sent from the keyboard 12 or the mouse 13 to the CPU 101. The mouse 13 is an example of a pointing device, and other pointing devices can also be used. Examples of other pointing devices include a touch panel, a tablet, a touch pad, and a trackball.

光学ドライブ装置106は、レーザ光などを利用して、光ディスク14に記録されたデータの読み取りを行う。光ディスク14は、光の反射によって読み取り可能なようにデータが記録された可搬型の記録媒体である。光ディスク14には、DVD(Digital Versatile Disc)、DVD−RAM、CD−ROM(Compact Disc Read Only Memory)、CD−R(Recordable)/RW(ReWritable)などがある。   The optical drive device 106 reads data recorded on the optical disk 14 using laser light or the like. The optical disk 14 is a portable recording medium on which data is recorded so that it can be read by reflection of light. The optical disk 14 includes a DVD (Digital Versatile Disc), a DVD-RAM, a CD-ROM (Compact Disc Read Only Memory), a CD-R (Recordable) / RW (ReWritable), and the like.

通信インタフェース107は、ネットワーク20に接続されている。通信インタフェース107は、ネットワーク20を介して、サーバ21などの他のコンピュータとの間でデータの送受信を行う。   The communication interface 107 is connected to the network 20. The communication interface 107 transmits and receives data to and from other computers such as the server 21 via the network 20.

以上のようなハードウェア構成によって、本実施の形態の処理機能を実現することができる。
図3は、設備配置計画支援装置の機能を示すブロック図である。設備配置計画支援装置100は、ユーザインタフェース部110、機器データ記憶部120、外接形状作成部130、最大移動軌跡作成部140、干渉空間データ記憶部150、進入禁止空間判定部160、進入禁止空間データ記憶部170、柵作成部180、および柵配置図記憶部190を有している。
With the hardware configuration as described above, the processing functions of the present embodiment can be realized.
FIG. 3 is a block diagram illustrating functions of the facility arrangement plan support apparatus. The facility arrangement plan support apparatus 100 includes a user interface unit 110, a device data storage unit 120, a circumscribed shape creation unit 130, a maximum movement locus creation unit 140, an interference space data storage unit 150, an entry prohibition space determination unit 160, and an entry prohibition space data. It has a storage unit 170, a fence creation unit 180, and a fence layout drawing storage unit 190.

ユーザインタフェース部110は、ユーザからの操作入力をキーボード12やマウス13を介して受け付けると共に、設備配置計画支援装置100内のデータを、モニタ11を介して表示する。そして、ユーザインタフェース部110は、ユーザからの入力内容を、設備配置計画支援装置100内の他の各要素に入力する。また、ユーザインタフェース部110は、他の要素から出力された表示用のデータを、モニタ11に表示する。   The user interface unit 110 receives an operation input from the user via the keyboard 12 and the mouse 13 and displays data in the equipment arrangement plan support apparatus 100 via the monitor 11. Then, the user interface unit 110 inputs the input content from the user to each other element in the equipment arrangement plan support apparatus 100. In addition, the user interface unit 110 displays display data output from other elements on the monitor 11.

機器データ記憶部120は、工場内に配置する機器の部品データを記憶する記憶機能である。例えば、HDD103の記憶領域の一部が、機器データ記憶部120として使用される。   The device data storage unit 120 is a storage function that stores component data of devices arranged in the factory. For example, a part of the storage area of the HDD 103 is used as the device data storage unit 120.

外接形状作成部130は、工場内に配置する機器の外接形状を示す3次元データを作成する。具体的には、外接形状作成部130は、ユーザインタフェース部110を介したユーザからの対話型の操作入力に応じて、機器データ記憶部120に格納された機器の情報を抽出する。次に、外接形状作成部130は、抽出した機器を構成する部品の形状に基づいて、該当機器の可動範囲を計算する。そして、外接形状作成部130は、可動範囲を包含する立体形状を、該当機器の外接形状とする。外接形状作成部130は、該当機器が工場内を移動する場合、外接形状を示す外接形状データを最大移動軌跡作成部140に渡す。また外接形状作成部130は、該当機器が工場の所定の位置に固定される場合、外接形状の情報を含む外接形状付き機器データを干渉空間データ記憶部150に格納する。   The circumscribed shape creating unit 130 creates three-dimensional data indicating the circumscribed shape of the equipment arranged in the factory. Specifically, the circumscribed shape creation unit 130 extracts device information stored in the device data storage unit 120 in response to an interactive operation input from the user via the user interface unit 110. Next, the circumscribed shape creating unit 130 calculates the movable range of the corresponding device based on the extracted shapes of the parts that constitute the device. Then, the circumscribed shape creating unit 130 sets the three-dimensional shape including the movable range as the circumscribed shape of the corresponding device. The circumscribed shape creating unit 130 passes circumscribed shape data indicating the circumscribed shape to the maximum movement trajectory creating unit 140 when the corresponding device moves in the factory. The circumscribed shape creating unit 130 stores circumscribed shape-equipped device data including circumscribed shape information in the interference space data storage unit 150 when the corresponding device is fixed at a predetermined position in the factory.

最大移動軌跡作成部140は、移動する機器がある場合、該当機器の最大移動軌跡データを作成する。最大移動軌跡は、該当する機器が移動することで通過可能な空間を示す3次元形状で表される。最大移動軌跡作成部140は、作成した最大移動軌跡の情報を含む移動軌跡付き機器データを干渉空間データ記憶部150に格納する。   When there is a moving device, the maximum movement locus creation unit 140 creates maximum movement locus data of the device. The maximum movement trajectory is represented by a three-dimensional shape indicating a space that can be passed by moving the corresponding device. The maximum movement locus creation unit 140 stores device data with a movement locus including information on the created maximum movement locus in the interference space data storage unit 150.

干渉空間データ記憶部150は、各機器の干渉空間を示すデータ(干渉空間データ)を記憶する記憶機能である。例えば、RAM102またはHDD103の記憶領域の一部が、干渉空間データ記憶部150として使用される。なお、干渉空間データには、外接形状データと最大移動軌跡データとがある。   The interference space data storage unit 150 is a storage function that stores data (interference space data) indicating the interference space of each device. For example, a part of the storage area of the RAM 102 or the HDD 103 is used as the interference space data storage unit 150. The interference space data includes circumscribed shape data and maximum movement trajectory data.

進入禁止空間判定部160は、各機器の干渉空間データに基づいて、工場内の進入禁止空間を判定する。具体的には、進入禁止空間判定部160は、干渉空間の周囲に安全を考慮した接近禁止空間を定義し、干渉空間と接近禁止空間とを含む空間を進入禁止空間とする。そして、進入禁止空間判定部160は、判定結果として得られた進入禁止空間を示す進入禁止空間データを、進入禁止空間データ記憶部170に格納する。   The entry prohibition space determination unit 160 determines the entry prohibition space in the factory based on the interference space data of each device. Specifically, the entry prohibition space determination unit 160 defines an access prohibition space in consideration of safety around the interference space, and sets a space including the interference space and the access prohibition space as an entry prohibition space. Then, the entry prohibition space determination unit 160 stores the entry prohibition space data indicating the entry prohibition space obtained as a determination result in the entry prohibition space data storage unit 170.

進入禁止空間データ記憶部170は、進入禁止空間データを記憶する記憶機能である。例えば、RAM102またはHDD103の記憶領域の一部が、進入禁止空間データ記憶部170として使用される。   The entry prohibition space data storage unit 170 is a storage function that stores entry prohibition space data. For example, a part of the storage area of the RAM 102 or the HDD 103 is used as the entry prohibition space data storage unit 170.

柵作成部180は、進入禁止空間を取り囲む柵を示す柵データを生成する。さらに、柵作成部180は、柵の配置場所を示す柵配置図を生成する。そして、柵作成部180は、作成した柵配置図を、柵配置図記憶部190に格納する。   The fence creation unit 180 generates fence data indicating a fence surrounding the entry prohibition space. Furthermore, the fence creation unit 180 generates a fence layout diagram showing the layout location of the fence. The fence creation unit 180 stores the created fence layout drawing in the fence layout drawing storage unit 190.

柵配置図記憶部190は、柵配置図を記憶する記憶機能である。例えば、HDD103の記憶領域の一部が、柵配置図記憶部190として使用される。
なお、図1に示した進入禁止空間分析装置1の各要素と、図3に示した設備配置計画支援装置100の各要素との対応関係は、次の通りである。進入禁止空間分析装置1の機器データ記憶手段1aは、設備配置計画支援装置100の機器データ記憶部120によって実現される機能である。進入禁止空間分析装置1の干渉空間判定手段1bは、設備配置計画支援装置100の外接形状作成部130によって実現される機能である。進入禁止空間分析装置1の進入禁止空間判定手段1cは、設備配置計画支援装置100の外接形状作成部130と進入禁止空間判定部160によって実現される機能である。進入禁止空間分析装置1の進入禁止空間データ格納手段1dは、進入禁止空間判定部160によって実現される機能である。進入禁止空間分析装置1の進入禁止空間データ記憶手段1eは、設備配置計画支援装置100の進入禁止空間データ記憶部170によって実現される機能である。
The fence arrangement drawing storage unit 190 is a storage function that stores the fence arrangement drawing. For example, a part of the storage area of the HDD 103 is used as the fence arrangement drawing storage unit 190.
The correspondence relationship between each element of the entry prohibition space analysis apparatus 1 shown in FIG. 1 and each element of the facility arrangement plan support apparatus 100 shown in FIG. 3 is as follows. The device data storage unit 1 a of the entry prohibition space analysis device 1 is a function realized by the device data storage unit 120 of the facility arrangement plan support device 100. The interference space determination unit 1b of the entry prohibition space analysis device 1 is a function realized by the circumscribed shape creation unit 130 of the facility arrangement plan support device 100. The entry prohibition space determination unit 1 c of the entry prohibition space analysis device 1 is a function realized by the circumscribed shape creation unit 130 and the entry prohibition space determination unit 160 of the facility arrangement plan support device 100. The entry prohibition space data storage unit 1 d of the entry prohibition space analysis device 1 is a function realized by the entry prohibition space determination unit 160. The entry prohibition space data storage unit 1e of the entry prohibition space analysis device 1 is a function realized by the entry prohibition space data storage unit 170 of the facility arrangement plan support device 100.

図3に示したような機能により、進入禁止空間の判定、および進入禁止空間を囲う柵の配置場所の判定を自動で行うことができる。進入禁止空間の判定および柵の配置場所の判定を行うために、ユーザは予め機器データ記憶部120に機器データを格納する。例えば、CAD(Computer-Aided Design)システムによって作成された機器データが、ユーザからの操作入力に基づいた設備配置計画支援装置100内のOSの機能により、機器データ記憶部120に格納される。   With the function as shown in FIG. 3, it is possible to automatically determine the entry-prohibited space and the location of the fence surrounding the entry-prohibited space. The user stores device data in the device data storage unit 120 in advance in order to determine the entry prohibition space and the location of the fence. For example, device data created by a CAD (Computer-Aided Design) system is stored in the device data storage unit 120 by the function of the OS in the facility arrangement plan support apparatus 100 based on an operation input from a user.

図4は、機器データ記憶部内のデータ例を示す図である。機器データ記憶部120には、複数の機器データ121a,121b,121c,・・・、複数の積載物データ122a,122b,122c,・・・、および複数の部品データ123a,123b,123c,・・・が格納されている。   FIG. 4 is a diagram illustrating an example of data in the device data storage unit. The device data storage unit 120 includes a plurality of device data 121a, 121b, 121c,..., A plurality of load data 122a, 122b, 122c,..., And a plurality of component data 123a, 123b, 123c,. -Is stored.

機器データ121a,121b,121c,・・・は、工場内に配置される機器の構成部品と、その機器の積載物を定義するデータである。例えば、マニピュレータ型のロボットに関する機器データであれば、ロボットの土台やアームなどの各部品の識別情報と、ロボットがアームで把持する積載物の識別情報とが、機器データ内に定義される。   The device data 121a, 121b, 121c,... Is data that defines the component parts of the device arranged in the factory and the load of the device. For example, in the case of device data related to a manipulator type robot, identification information of each part such as the base and arm of the robot and identification information of a load that the robot holds with the arm are defined in the device data.

積載物データ122a,122b,122c,・・・は、積載物データは、積載物の形状を示すデータである。
部品データ123a,123b,123c,・・・は、部品の形状を定義したデータである。
The load data 122a, 122b, 122c,... Is data indicating the shape of the load.
The component data 123a, 123b, 123c,... Is data defining the shape of the component.

次に、機器データ記憶部120内の各データのデータ構造を、図5〜図8を参照して説明する。
図5は、機器データのデータ構造例を示す図である。図5には、ロボット31に関する機器データ121aが示されている。機器データ121aには、機器名、安全考慮値、機器動作テーブル名、積載物名、および構成部品名が設定されている。
Next, the data structure of each data in the device data storage unit 120 will be described with reference to FIGS.
FIG. 5 is a diagram illustrating an exemplary data structure of device data. FIG. 5 shows device data 121a regarding the robot 31. In the device data 121a, a device name, a safety consideration value, a device operation table name, a load name, and a component name are set.

機器名は、ロボット31を識別するための名称である。安全考慮値は、各部品の周囲に設ける接近禁止空間の幅を示す数値である。安全考慮値は、部品の形状ごとに設けられている。図5の例では、円柱と直方体とのそれぞれの安全考慮値が設定されている。また、形状ごとの安全考慮値として、縦方向の接近禁止空間の幅と、横方向の接近禁止空間の幅とが設定されている。なお安全考慮値には、予め初期値が設定されており、進入禁止空間を判定する際にユーザからの操作入力によって任意の値に変更される。   The device name is a name for identifying the robot 31. The safety consideration value is a numerical value indicating the width of the access prohibition space provided around each component. Safety consideration values are provided for each part shape. In the example of FIG. 5, safety consideration values for the cylinder and the rectangular parallelepiped are set. In addition, as the safety consideration value for each shape, the width of the access prohibition space in the vertical direction and the width of the access prohibition space in the horizontal direction are set. Note that an initial value is set in advance as the safety consideration value, and is changed to an arbitrary value by an operation input from the user when determining the entry prohibition space.

機器動作テーブル名は、ロボット31の動作を定義するデータテーブル(機器動作テーブル)の名称である。機器動作テーブルには、ロボット13の動作パターンが定義されており、機器動作テーブルに基づいて動作中のロボット31の姿勢を判断することができる。ロボット31に積載物32を持たせた状態で動作させたときの各姿勢におけるロボット31と積載物32との占有空間の論理和が、ロボット31の干渉空間となる。   The device operation table name is the name of a data table (device operation table) that defines the operation of the robot 31. The operation pattern of the robot 13 is defined in the device operation table, and the posture of the operating robot 31 can be determined based on the device operation table. The logical sum of the occupied space of the robot 31 and the load 32 in each posture when the robot 31 is operated with the load 32 is provided as the interference space of the robot 31.

ここで、機器動作テーブルに代えて、動作プログラムを用いることもできる。すなわち、ロボット31に動作を指示する動作プログラムのプログラム名を、機器動作テーブル名に代えて機器データ121aに設定する。動作プログラムをロボットで実行することで、ロボットの動作シミュレーションが可能である。なお、動作プログラムに基づくロボット31などの動作シミュレーションは、特許文献1で紹介した特開2005−81445号公報の技術などを用いて可能である。そこで、機器動作テーブルや動作プログラムに基づく機器の動作シミュレーションについては説明を省略する。   Here, an operation program can be used instead of the device operation table. That is, the program name of the operation program that instructs the robot 31 to operate is set in the device data 121a instead of the device operation table name. By executing the operation program with the robot, it is possible to simulate the operation of the robot. The operation simulation of the robot 31 and the like based on the operation program can be performed using the technique disclosed in Japanese Patent Application Laid-Open No. 2005-81445 introduced in Patent Document 1. Therefore, the description of the device operation simulation based on the device operation table and the operation program is omitted.

積載物名は、ロボット31に持たせる積載物32を識別するための名称である。例えば、ロボット31に持たせることが可能な最も大きな積載物32の名称が、積載物名として設定される。   The load name is a name for identifying the load 32 that the robot 31 has. For example, the name of the largest load 32 that can be given to the robot 31 is set as the load name.

構成部品名は、ロボット31の構成部品を識別するための名称である。ロボット31には、5個の構成部品を有している。第1の部品31aは関節部の部品であり、円柱形をしている。第2の部品31bは台座部の部品であり、円柱形をしている。第3の部品31cは、上腕部の部品であり、多角錘形をしている。第4の部品31dは前腕部の部品であり、多角錘形をしている。第5の部品31eはハンド部の部品である。ハンド部は、積載物32を掴めるように複雑な形状をしている。ただし、積載物32を把持した状態での干渉空間の判定においては、ハンド部の詳細な形状は重要ではない。そこで、本実施の形態では、ハンド部を示す第5の部品31eの形状を、先端に行く程細くなる多角錘形に簡略化している。   The component name is a name for identifying the component of the robot 31. The robot 31 has five components. The first part 31a is a part of the joint part and has a cylindrical shape. The second part 31b is a pedestal part and has a cylindrical shape. The third part 31c is a part of the upper arm part and has a polygonal pyramid shape. The fourth component 31d is a forearm component and has a polygonal pyramid shape. The fifth part 31e is a part of the hand part. The hand portion has a complicated shape so that the load 32 can be grasped. However, the detailed shape of the hand portion is not important in the determination of the interference space with the load 32 held. Therefore, in the present embodiment, the shape of the fifth component 31e indicating the hand portion is simplified to a polygonal pyramid shape that becomes thinner toward the tip.

図6は、積載物データのデータ構造例を示す図である。図6には、直方体の積載物32に関する積載物データ122aが示されている。積載物データ122aには、積載物名、基準点、3軸方向のベクトル、縦、横、および高さが設定されている。   FIG. 6 is a diagram illustrating an example of the data structure of the load data. FIG. 6 shows the load data 122a relating to the rectangular load 32. In the load data 122a, a load name, a reference point, a vector in three axis directions, vertical, horizontal, and height are set.

積載物名は、積載物32を識別するための名称である。基準点は、積載物32の基準点となる頂点P1のグローバル座標における座標値である。グローバル座標とは、処理対象となる全体の空間を定義する座標である。例えば、工場のレイアウトを決める場合、工場内に配置する各機器の位置を示すために使用する座標がグローバル座標である。   The load name is a name for identifying the load 32. The reference point is a coordinate value in the global coordinates of the vertex P <b> 1 that becomes the reference point of the load 32. The global coordinates are coordinates that define the entire space to be processed. For example, when the factory layout is determined, the coordinates used to indicate the position of each device arranged in the factory are global coordinates.

3軸方向のベクトルは、ローカル座標のX軸、Y軸、Z軸それぞれの方向を示すベクトルである。ローカル座標は、基準点を原点として、積載物32の位置および向きを定義するのに使用される座標である。「ベクトルX1」がローカル座標のX軸方向を表し、「ベクトルY1」がローカル座標のY軸方向を表し、「ベクトルZ1」がローカル座標のZ軸方向を表す。各ベクトルは、それぞれグローバル座標におけるX成分、Y成分、Z成分で表される。   The three-axis direction vector is a vector indicating the directions of the X, Y, and Z axes of the local coordinates. The local coordinates are coordinates used to define the position and orientation of the load 32 with the reference point as the origin. “Vector X1” represents the X-axis direction of the local coordinates, “Vector Y1” represents the Y-axis direction of the local coordinates, and “Vector Z1” represents the Z-axis direction of the local coordinates. Each vector is represented by an X component, a Y component, and a Z component in global coordinates, respectively.

縦は、「ベクトルZ1」方向への積載物32の長さである。横は、「ベクトルX1」方向への積載物32の長さである。高さは、「ベクトルY1」方向への積載物32の長さである。   The vertical is the length of the load 32 in the “vector Z1” direction. The horizontal is the length of the load 32 in the “vector X1” direction. The height is the length of the load 32 in the “vector Y1” direction.

図7は、円柱形の部品データのデータ構造例を示す図である。図7には、円柱形の第1の部品31aに関する部品データ123aが示されている。部品データ123aには、部品名、基準点、3軸方向のベクトル、半径、および高さが設定されている。   FIG. 7 is a diagram illustrating a data structure example of cylindrical part data. FIG. 7 shows part data 123a related to the cylindrical first part 31a. In the component data 123a, a component name, a reference point, a vector in three axes, a radius, and a height are set.

部品名は、第1の部品31aを識別するための名称である。基準点は、第1の部品31aの基準点となる頂点P2のグローバル座標における座標値である。
3軸方向のベクトルは、第1の部品31aに対するローカル座標におけるX軸、Y軸、Z軸それぞれの方向を、グローバル座標で表したベクトルである。「ベクトルX2」がローカル座標のX軸方向を表し、「ベクトルY2」がローカル座標のY軸方向を表し、「ベクトルZ2」がローカル座標のZ軸方向を表す。
The component name is a name for identifying the first component 31a. The reference point is a coordinate value in the global coordinates of the vertex P2 that becomes the reference point of the first component 31a.
The three-axis direction vector is a vector in which the directions of the X axis, the Y axis, and the Z axis in the local coordinates with respect to the first component 31a are expressed in global coordinates. “Vector X2” represents the X-axis direction of the local coordinates, “Vector Y2” represents the Y-axis direction of the local coordinates, and “Vector Z2” represents the Z-axis direction of the local coordinates.

半径は、第1の部品31aの底面の円の半径rである。高さは、「ベクトルZ2」方向への第1の部品31aの長さh1である。
図8は、多角錘状の部品データのデータ構造例を示す図である。図8には、多角錘型の第3の部品31cに関する部品データ123bが示されている。部品データ123bには、部品名、基準点、3軸方向のベクトル、高さ、角数、および頂点数分の頂点座標(T1〜T8)が設定されている。
The radius is a radius r of the circle on the bottom surface of the first component 31a. The height is the length h1 of the first component 31a in the “vector Z2” direction.
FIG. 8 is a diagram illustrating a data structure example of polygonal pyramid component data. FIG. 8 shows component data 123b related to the third pyramidal third component 31c. In the component data 123b, a component name, a reference point, a triaxial vector, a height, a number of corners, and vertex coordinates (T1 to T8) corresponding to the number of vertices are set.

部品名は、第3の部品31cを識別するための名称である。基準点は、第3の部品31cの基準点となる頂点P3のグローバル座標における座標値である。
3軸方向のベクトルは、第3の部品31cに対するローカル座標におけるX軸、Y軸、Z軸それぞれの方向を、グローバル座標で表したベクトルである。「ベクトルX3」がローカル座標のX軸方向を表し、「ベクトルY3」がローカル座標のY軸方向を表し、「ベクトルZ3」がローカル座標のZ軸方向を表す。
The component name is a name for identifying the third component 31c. The reference point is a coordinate value in the global coordinates of the vertex P3 that becomes the reference point of the third component 31c.
The three-axis direction vector is a vector in which the directions of the X axis, the Y axis, and the Z axis in the local coordinates with respect to the third component 31c are expressed in global coordinates. “Vector X3” represents the X-axis direction of the local coordinates, “Vector Y3” represents the Y-axis direction of the local coordinates, and “Vector Z3” represents the Z-axis direction of the local coordinates.

高さは、第1の部品31aの「ベクトルZ3」方向への長さh2である。角数は、底面を形成する多角形の角の数(整数)である。頂点座標(T1〜T8)は、各頂点のローカル座標における3軸方向の座標値である。   The height is the length h2 of the first component 31a in the “vector Z3” direction. The number of corners is the number (integer) of polygon corners forming the bottom surface. The vertex coordinates (T1 to T8) are coordinate values in the three-axis directions in the local coordinates of each vertex.

なお、円柱形の第2の部品31bに関する部品データのデータ構造は、図7に示した部品データ123aと同様である。また、多角錘状の第4の部品31dと第5の部品31eとのそれぞれに関する部品データのデータ構造は、図8に示した部品データ123bと同様である。   The data structure of the component data related to the cylindrical second component 31b is the same as the component data 123a shown in FIG. Further, the data structure of the component data relating to each of the fourth and fifth components 31d and 31e having the polygonal pyramid shape is the same as the component data 123b shown in FIG.

なお、図5に示したロボット31などの機器の工場内への配置や移動シミュレーションを行う場合、各機器の基準点が定義される。そして、グローバル座標形における基準点の座標を指定することで、機器の配置場所が設定される。また、基準点の座標を時間変化に伴って変更することで、機器の平行移動動作をシミュレートできる。例えば、図5に示したロボット31であれば、第2の部品31bの基準点を、ロボット31の基準点とすることができる。   In addition, when performing an arrangement or movement simulation of a device such as the robot 31 shown in FIG. 5 in a factory, a reference point of each device is defined. And the arrangement | positioning location of an apparatus is set by designating the coordinate of the reference point in a global coordinate form. Moreover, the parallel movement operation | movement of an apparatus can be simulated by changing the coordinate of a reference point with a time change. For example, in the case of the robot 31 shown in FIG. 5, the reference point of the second component 31 b can be used as the reference point of the robot 31.

次に、進入禁止空間の判定および柵配置の処理手順について説明する。
図9は、進入禁止空間の判定および柵配置の処理手順を示すフローチャートである。以下、図9に示す処理をステップ番号に沿って説明する。
Next, the procedure for determining the entry-prohibited space and the fence arrangement will be described.
FIG. 9 is a flowchart showing a procedure for determining the entry prohibition space and arranging the fence. In the following, the process illustrated in FIG. 9 will be described in order of step number.

[ステップS11]外接形状作成部130は、機器データ記憶部120内の各機器データで示される機器の外接形状を作成する。そして、外接形状作成部130は、作成した外接形状を示す外接形状データと、作成した外接形状との対応関係を追加した外接形状付き機器データとを干渉空間データ記憶部150に格納する。この処理の詳細は後述する(図10参照)。   [Step S11] The circumscribed shape creating unit 130 creates a circumscribed shape of the device indicated by each device data in the device data storage unit 120. Then, the circumscribed shape creating unit 130 stores circumscribed shape data indicating the created circumscribed shape and device data with circumscribed shape to which the correspondence relationship between the created circumscribed shapes is added in the interference space data storage unit 150. Details of this processing will be described later (see FIG. 10).

[ステップS12]外接形状作成部130は、機器データ記憶部120内の各機器データで示される機器のうち、位置が移動する機器があるか否かを判断する。例えば外接形状作成部130は、機器データ内の機器動作テーブルまたは動作プログラムにおいてグローバル座標における機器の基準位置の移動が定義されている場合、その機器を「移動する機器」であると判断する。移動する機器がある場合、処理がステップS13に進められる。移動する機器がなければ、処理がステップS14に進められる。   [Step S12] The circumscribed shape creation unit 130 determines whether there is a device whose position moves among the devices indicated by the device data in the device data storage unit 120. For example, when the movement of the reference position of the device in global coordinates is defined in the device operation table or operation program in the device data, the circumscribed shape creation unit 130 determines that the device is a “moving device”. If there is a moving device, the process proceeds to step S13. If there is no moving device, the process proceeds to step S14.

[ステップS13]最大移動軌跡作成部140は、位置が移動する機器の最大移動軌跡を作成する。そして、最大移動軌跡作成部140は、最大移動軌跡を示す最大移動軌跡データを干渉空間データ記憶部150に格納する。なお、この処理の詳細は後述する(図14〜図19参照)。   [Step S13] The maximum movement trajectory creation unit 140 creates the maximum movement trajectory of the device whose position moves. Then, the maximum movement locus creation unit 140 stores the maximum movement locus data indicating the maximum movement locus in the interference space data storage unit 150. Details of this process will be described later (see FIGS. 14 to 19).

[ステップS14]進入禁止空間判定部160は、干渉空間データ記憶部150に格納された干渉空間データ(外接形状データまたは最大移動軌跡データ)に基づいて、進入禁止空間を判定する。そして、進入禁止空間判定部160は、進入禁止空間を示す進入禁止空間データを、進入禁止空間データ記憶部170に格納する。この処理の詳細は後述する(図23参照)。   [Step S14] The entry prohibition space determination unit 160 determines the entry prohibition space based on the interference space data (circumscribed shape data or maximum movement trajectory data) stored in the interference space data storage unit 150. Then, the entry prohibition space determination unit 160 stores the entry prohibition space data indicating the entry prohibition space in the entry prohibition space data storage unit 170. Details of this processing will be described later (see FIG. 23).

[ステップS15]柵作成部180は、進入禁止空間データ記憶部170内の進入禁止空間データに基づいて、進入禁止空間を囲う柵の配置場所を決定する。そして、柵作成部180は、柵の配置場所を示す配置図を柵配置図記憶部190に格納する。この処理の詳細は後述する(図26参照)。   [Step S <b> 15] The fence creation unit 180 determines an arrangement place of the fence surrounding the entry prohibition space based on the entry prohibition space data in the entry prohibition space data storage unit 170. Then, the fence creation unit 180 stores a layout diagram indicating the layout location of the fence in the fence layout map storage unit 190. Details of this processing will be described later (see FIG. 26).

以上のような手順により、進入禁止空間の判定と、その進入禁止空間を囲う柵の配置場所の決定とが行われる。
次に、図9に示す各処理の内容を詳細に説明する。
By the procedure as described above, the determination of the entry prohibition space and the determination of the location of the fence surrounding the entry prohibition space are performed.
Next, the contents of each process shown in FIG. 9 will be described in detail.

図10は、外接形状作成処理の手順を示すフローチャートである。以下、図10に示す処理をステップ番号に沿って説明する。
[ステップS21]外接形状作成部130は、機器データ記憶部120から対象機器を1つ選択する。具体的には、外接形状作成部130は、機器データ記憶部120に格納されている機器データのうち、ステップS22からステップS26の処理が未処理の機器データを選択する。
FIG. 10 is a flowchart showing the procedure of the circumscribed shape creation process. In the following, the process illustrated in FIG. 10 will be described in order of step number.
[Step S21] The circumscribed shape creation unit 130 selects one target device from the device data storage unit 120. Specifically, the circumscribed shape creation unit 130 selects device data that has not been processed in steps S22 to S26 among the device data stored in the device data storage unit 120.

[ステップS22]外接形状作成部130は、選択した機器の干渉空間を作成する。例えば、外接形状作成部130は、選択した機器データに示された動作テーブルに従って、該当機器の動作シミュレーションを行う。また、外接形状作成部130は、ユーザインタフェース部110を介してユーザからの機器の動作の指示を受け取り、その指示に従って機器の動作をシミュレートすることもできる。機器の動作のシミュレートに際して、外接形状作成部130は、機器データに示されている積載物データを取得し、取得した積載物データに基づいて動作シミュレーション中に該当機器に積載される積載物の形状を認識する。さらに、外接形状作成部130は、動作シミュレーションによって機器と積載物が届く空間を算出し、干渉空間とする。   [Step S22] The circumscribed shape creating unit 130 creates an interference space for the selected device. For example, the circumscribed shape creation unit 130 performs an operation simulation of the corresponding device according to the operation table indicated in the selected device data. In addition, the circumscribed shape creation unit 130 can also receive an operation instruction of the device from the user via the user interface unit 110, and can simulate the operation of the device according to the instruction. When simulating the operation of the device, the circumscribed shape creation unit 130 acquires the load data indicated in the device data, and based on the acquired load data, the circumscribed shape creation unit 130 determines the load to be loaded on the corresponding device during the operation simulation. Recognize the shape. Furthermore, the circumscribed shape creation unit 130 calculates a space where the device and the load can reach by operation simulation, and sets it as an interference space.

[ステップS23]外接形状作成部130は、選択した機器の外接形状を作成する。具体的には、外接形状作成部130は、干渉空間と、干渉空間の下にある空間とを含む形状を、外接形状とする。干渉空間の下の空間とは、グローバル座標における干渉空間からZ軸負の方向の空間である。ただし、グローバル座標のX−Y平面に工場の床が配置される場合、Z軸の値が負となる空間は、落下物干渉空間から除外される。作成された外接形状は、RAM102内に一時的に保存される。   [Step S23] The circumscribed shape creating unit 130 creates a circumscribed shape of the selected device. Specifically, the circumscribed shape creation unit 130 sets a circumscribed shape that includes the interference space and the space below the interference space. The space below the interference space is a space in the negative direction of the Z axis from the interference space in global coordinates. However, when a factory floor is arranged on the XY plane of global coordinates, a space in which the value of the Z axis is negative is excluded from the falling object interference space. The created circumscribed shape is temporarily stored in the RAM 102.

このような外接形状の作成は、進入禁止空間判定の予備的な処理である。すなわち、外接形状作成部130は、進入禁止空間作成処理の一部を担っていることとなる。
[ステップS24]外接形状作成部130は、外接形状を保存するか否かを、ユーザインタフェース部110を介してユーザに問い合わせる。その際、外接形状作成部130は、作成した外接形状を示す画像をモニタ11に表示させる。ユーザは、モニタ11に表示された外接形状が適切か否かを判断し、キーボード12などの入力装置を用いて、作成された外接形状の保存の要否を入力する。外接形状作成部130は、ユーザからの操作入力に基づいて、外接形状の保存の要否を判断する。ユーザから外接形状を保存しない旨の指示が入力された場合、処理がステップS25に進められる。ユーザから外接形状を保存する旨の指示が入力された場合、処理がステップS26に進められる。
Creation of such circumscribed shape is a preliminary process for determining the entry prohibition space. That is, the circumscribed shape creation unit 130 is responsible for part of the entry prohibition space creation process.
[Step S24] The circumscribed shape creating unit 130 inquires of the user via the user interface unit 110 whether or not to store the circumscribed shape. At that time, the circumscribed shape creating unit 130 causes the monitor 11 to display an image showing the created circumscribed shape. The user determines whether or not the circumscribed shape displayed on the monitor 11 is appropriate, and inputs the necessity of storing the created circumscribed shape using an input device such as the keyboard 12. The circumscribed shape creation unit 130 determines whether or not the circumscribed shape needs to be stored based on an operation input from the user. If the user inputs an instruction not to save the circumscribed shape, the process proceeds to step S25. If an instruction to save the circumscribed shape is input from the user, the process proceeds to step S26.

[ステップS25]外接形状を保存しない場合、外接形状作成部130は、ステップS24で作成した外接形状をRAM102から削除する。その後、処理がステップS22に進められ、外接形状の作成が再度行われる。外接形状を再作成する場合、ユーザは、ユーザインタフェース部110を介して前回とは異なる動作を外接形状作成部130にシミュレートさせる。これにより、前回と異なる外接形状を生成させることができる。   [Step S25] When the circumscribed shape is not stored, the circumscribed shape creating unit 130 deletes the circumscribed shape created in step S24 from the RAM 102. Thereafter, the process proceeds to step S22, and the circumscribed shape is created again. When recreating the circumscribed shape, the user causes the circumscribed shape creating unit 130 to simulate an operation different from the previous operation via the user interface unit 110. Thereby, a circumscribed shape different from the previous time can be generated.

[ステップS26]外接形状作成部130は、ステップS22で作成した外接形状を示す外接形状データと、外接形状付き機器データとを干渉空間データ記憶部150に格納する。この際、外接形状作成部130は、外接形状付き機器データによって指定されている積載物データおよび部品データを、機器データ記憶部120から干渉空間データ記憶部150にコピーする。   [Step S26] The circumscribed shape creating unit 130 stores circumscribed shape data indicating the circumscribed shape created in step S22 and device data with circumscribed shape in the interference space data storage unit 150. At this time, the circumscribed shape creating unit 130 copies the load data and component data specified by the circumscribed shape-equipped device data from the device data storage unit 120 to the interference space data storage unit 150.

[ステップS27]外接形状作成部130は、他の機器の外接形状を作成するか否かを判断する。具体的には、外接形状作成部130は、機器データ記憶部120に格納されている機器データのうち、ステップS22からステップS26の処理が未処理の機器データがある場合、他の機器の外接形状を作成するものと判断する。他の機器の外接形状を作成する場合、処理がステップS21に進められる。すべての機器の外接形状が作成された場合、外接形状作成処理が終了する。   [Step S27] The circumscribed shape creating unit 130 determines whether or not to create a circumscribed shape of another device. Specifically, the circumscribed shape creation unit 130, when there is device data that has not been processed in steps S22 to S26 among the device data stored in the device data storage unit 120, the circumscribed shape of another device. Is determined to be created. When creating a circumscribed shape of another device, the process proceeds to step S21. When the circumscribed shapes of all the devices are created, the circumscribed shape creating process ends.

このようにして、外接形状が作成される。ここで、ロボット31の外接形状の作成例を以下に示す。
図11は、外接形状を得るためのロボットの姿勢を示す図である。ロボット31の場合、干渉空間を包含する円柱を外接形状とすることができる。そこで、ロボット31の外接形状を作成する場合、外接形状作成部130は、ロボット31のハンド部で積載物32を把持した状態で、積載物を真上に上げた姿勢をシミュレートする。外接形状作成部130は、積載物を真上に上げたときの積載物の上方の到達点(図11の例では3,400mm)を、円柱の高さとする。さらに、外接形状作成部130は、ロボット31のハンド部で積載物32を把持した状態で、積載物を横方向に突きだした姿勢をシミュレートする。外接形状作成部130は、積載物を横方向に突きだしたときの積載物の横方向の到達点までのロボット31の中心からの距離(図11の例では2,500mm)を、円柱の半径とする。外接形状作成部130は、このようにして計算した円柱を、外接形状とする。作成された外接形状を示す外接形状データは、干渉空間データ記憶部150に格納される。
In this way, a circumscribed shape is created. Here, an example of creating the circumscribed shape of the robot 31 is shown below.
FIG. 11 is a diagram illustrating the posture of the robot for obtaining a circumscribed shape. In the case of the robot 31, a cylinder including the interference space can be circumscribed. Therefore, when creating the circumscribed shape of the robot 31, the circumscribed shape creating unit 130 simulates the posture in which the loaded object is lifted up while the loaded object 32 is held by the hand unit of the robot 31. The circumscribed shape creation unit 130 sets the arrival point (3,400 mm in the example of FIG. 11) above the load when the load is raised right above as the height of the cylinder. Further, the circumscribed shape creation unit 130 simulates the posture of the loaded object protruding in the lateral direction while the loaded object 32 is held by the hand unit of the robot 31. The circumscribed shape creation unit 130 determines the distance from the center of the robot 31 (2,500 mm in the example of FIG. 11) to the arrival point in the horizontal direction of the load when the load is protruded in the horizontal direction, and the radius of the cylinder. To do. The circumscribed shape creation unit 130 sets the calculated cylinder as the circumscribed shape. The circumscribed shape data indicating the created circumscribed shape is stored in the interference space data storage unit 150.

図12は、外接形状作成後の干渉空間データ記憶部内のデータを示す図である。外接形状が作成されると、各機器の外接形状付き機器データ151a,151b,151c,・・・と、機器の外接形状を示す外接形状データ152a,152b,152c,・・・とが干渉空間データ記憶部150に格納される。また、各機器の積載物や、構成部品に関する積載物データ122a,122b,122c,・・・や部品データ123a,123b,123c,・・・が、外接形状作成部130によって機器データ記憶部120から干渉空間データ記憶部150にコピーされている。   FIG. 12 is a diagram illustrating data in the interference space data storage unit after the circumscribed shape is created. When the circumscribed shape is created, the device data 151a, 151b, 151c,... With circumscribed shape of each device and circumscribed shape data 152a, 152b, 152c,. It is stored in the storage unit 150. Further, the load data 122a, 122b, 122c,... And the component data 123a, 123b, 123c,... Copied to the interference space data storage unit 150.

図13は、外接形状付き機器データのデータ構造例を示す図である。ロボット31の外接形状付き機器データ151aは、図5に示したロボット31の機器データ121aを包含している。そして、外接形状付き機器データ151aには、機器データ121aに含まれていた情報に加え、外接形状名が設定されている。   FIG. 13 is a diagram illustrating an example of the data structure of device data with circumscribed shape. The circumscribed shape device data 151a of the robot 31 includes the device data 121a of the robot 31 shown in FIG. In the circumscribed shape-equipped device data 151a, the circumscribed shape name is set in addition to the information included in the device data 121a.

外接形状名は、ロボットの外接形状33を一意に特定するための名称である。ロボット13の外接形状33は、半径R1、高さH1の円柱形である。外接形状33の半径や高さの情報は、外接形状名によって特定される外接形状データに設定される。   The circumscribed shape name is a name for uniquely identifying the circumscribed shape 33 of the robot. The circumscribed shape 33 of the robot 13 is a cylindrical shape having a radius R1 and a height H1. Information on the radius and height of the circumscribed shape 33 is set in circumscribed shape data specified by the circumscribed shape name.

円柱形の外接形状データのデータ構造は、図7に示した円柱形の部品データの123aのデータ構造と同様である。ただし、外接形状データでは、部品データ123aの部品名に代えて、外接形状名が設定される。   The data structure of the cylindrical circumscribed shape data is the same as the data structure of the cylindrical part data 123a shown in FIG. However, in the circumscribed shape data, the circumscribed shape name is set instead of the component name in the component data 123a.

なお、基準位置が移動する機器については、最大移動軌跡作成処理が行われる。
図14は、最大移動軌跡作成処理の手順を示すフローチャートである。以下、図14に示す処理をステップ番号に沿って説明する。
Note that, for a device whose reference position moves, the maximum movement trajectory creation process is performed.
FIG. 14 is a flowchart showing the procedure of the maximum movement trajectory creation process. In the following, the process illustrated in FIG. 14 will be described in order of step number.

[ステップS31]最大移動軌跡作成部140は、機器データ記憶部120から対象機器を1つ選択する。具体的には、最大移動軌跡作成部140は、機器データ記憶部120内の機器動作テーブルにおいて基準位置の移動が定義されている機器データのうち、ステップS32〜ステップS36の処理が未処理の機器データを選択する。   [Step S31] The maximum movement trajectory creation unit 140 selects one target device from the device data storage unit 120. Specifically, the maximum movement trajectory creation unit 140 is a device that has not been processed in steps S32 to S36 among the device data for which the movement of the reference position is defined in the device operation table in the device data storage unit 120. Select data.

[ステップS32]最大移動軌跡作成部140は、選択した機器の移動情報を入力する。例えば、最大移動軌跡作成部140は、予め機器動作テーブルに設定された移動情報を読み込む。また、最大移動軌跡作成部140は、ユーザインタフェース部110を介したユーザからの操作入力により、機器の移動情報を取得することもできる。この処理の詳細は後述する(図15参照)。   [Step S32] The maximum movement trajectory creation unit 140 inputs movement information of the selected device. For example, the maximum movement trajectory creation unit 140 reads movement information set in advance in the device operation table. Further, the maximum movement trajectory creation unit 140 can also acquire device movement information by an operation input from the user via the user interface unit 110. Details of this processing will be described later (see FIG. 15).

[ステップS33]最大移動軌跡作成部140は、軌跡形状作成処理を実行する。機器別最大移動軌跡作成処理により、選択した機器の軌跡形状が作成され、RAM102に一時的に格納される。この処理の詳細は後述する(図19参照)。   [Step S33] The maximum movement locus creation unit 140 executes locus shape creation processing. The trajectory shape of the selected device is created by the device-specific maximum movement trajectory creation process, and is temporarily stored in the RAM 102. Details of this processing will be described later (see FIG. 19).

[ステップS34]最大移動軌跡作成部140は、外接形状を保存するか否かを、ユーザインタフェース部110を介してユーザに問い合わせる。その際、最大移動軌跡作成部140は、作成した軌跡形状を示す画像をモニタ11に表示させる。ユーザは、モニタ11に表示された軌跡形状が適切か否かを判断し、キーボード12などの入力装置を用いて、作成された軌跡形状の保存の要否を入力する。最大移動軌跡作成部140は、ユーザからの操作入力に基づいて、軌跡形状の保存の要否を判断する。ユーザから外接形状を保存しない旨の指示が入力された場合、処理がステップS35に進められる。ユーザから外接形状を保存する旨の指示が入力された場合、処理がステップS36に進められる。   [Step S34] The maximum movement trajectory creation unit 140 inquires of the user via the user interface unit 110 whether or not to save the circumscribed shape. At that time, the maximum movement trajectory creation unit 140 causes the monitor 11 to display an image indicating the created trajectory shape. The user determines whether or not the trajectory shape displayed on the monitor 11 is appropriate, and inputs the necessity of saving the created trajectory shape using an input device such as the keyboard 12. The maximum movement trajectory creation unit 140 determines whether or not the trajectory shape needs to be stored based on an operation input from the user. If the user inputs an instruction not to save the circumscribed shape, the process proceeds to step S35. If an instruction to save the circumscribed shape is input from the user, the process proceeds to step S36.

[ステップS35]軌跡形状を保存しない場合、最大移動軌跡作成部140は、ステップS33で作成した軌跡形状をRAM102から削除する。その後、処理がステップS32に進められ、軌跡形状の作成が再度行われる。軌跡形状を再作成する場合、ユーザは、ユーザインタフェース部110を介して前回とは異なる移動情報を最大移動軌跡作成部140に入力する。これにより、前回と異なる軌跡形状を生成させることができる。   [Step S35] When the trajectory shape is not stored, the maximum movement trajectory creation unit 140 deletes the trajectory shape created in Step S33 from the RAM 102. Thereafter, the process proceeds to step S32, and the creation of the trajectory shape is performed again. When recreating the trajectory shape, the user inputs movement information different from the previous one to the maximum movement trajectory creating unit 140 via the user interface unit 110. Thereby, a different trajectory shape from the previous time can be generated.

[ステップS36]最大移動軌跡作成部140は、ステップS33で作成した軌跡形状を示す軌跡形状データと、軌跡形状データ付き機器データとを干渉空間データ記憶部150に格納する。この際、最大移動軌跡作成部140は、軌跡形状付き機器データによって指定されている積載物データおよび部品データを、機器データ記憶部120から干渉空間データ記憶部150にコピーする。   [Step S36] The maximum movement trajectory creation unit 140 stores the trajectory shape data indicating the trajectory shape created in step S33 and the device data with the trajectory shape data in the interference space data storage unit 150. At this time, the maximum movement trajectory creation unit 140 copies the load data and component data specified by the device data with the trajectory shape from the device data storage unit 120 to the interference space data storage unit 150.

[ステップS37]最大移動軌跡作成部140は、ユーザからの操作入力に基づいて、選択した機器の移動を継続するか否かを判断する。この際、ユーザは、選択中の機器が可能なすべての移動情報の入力が干渉するまでは、該当機器の移動を継続する旨の入力を行う。それにより、最終的に得られる移動軌跡は、機器に許されるすべて移動によって生成される移動軌跡(最大移動軌跡)を生成することができる。継続して移動させる場合、処理がステップS32に進められる。選択した機器の移動が終了した場合、処理がステップS38に進められる。   [Step S37] The maximum movement trajectory creation unit 140 determines whether or not to continue the movement of the selected device based on an operation input from the user. At this time, the user performs an input indicating that the movement of the corresponding device is continued until the input of all possible movement information of the selected device interferes. Thereby, the movement trajectory (maximum movement trajectory) generated by all movements allowed for the device can be generated as the movement trajectory finally obtained. If it is moved continuously, the process proceeds to step S32. When the movement of the selected device is completed, the process proceeds to step S38.

なお、選択した機器を繰り返し移動させて軌跡形状の作成を作成するとき、移動の順番をフェーズ番号で区別する。最初の移動が第1フェーズであり、その後、機器を移動させるごとに第2フェーズ、第3フェーズとフェーズ番号がカウントアップされる。   Note that when creating a trajectory shape by repeatedly moving the selected device, the order of movement is distinguished by the phase number. The first movement is the first phase, and thereafter, each time the device is moved, the second phase, the third phase, and the phase number are counted up.

[ステップS38]最大移動軌跡作成部140は、他の機器の軌跡形状を作成するか否かを判断する。具体的には、最大移動軌跡作成部140は、機器データ記憶部120内の基準位置の移動が定義されている機器データのうち、ステップS32からステップS36の処理が未処理の機器データがある場合、他の機器の軌跡形状を作成するものと判断する。他の機器の軌跡形状を作成する場合、処理がステップS31に進められる。すべての機器の軌跡形状が作成された場合、最大移動軌跡作成処理が終了する。   [Step S38] The maximum movement trajectory creation unit 140 determines whether to create a trajectory shape of another device. Specifically, the maximum movement trajectory creation unit 140 includes device data in which processing from step S32 to step S36 is unprocessed among device data in which movement of the reference position in the device data storage unit 120 is defined. It is determined that the trajectory shape of another device is created. When creating a trajectory shape of another device, the process proceeds to step S31. When the trajectory shapes of all the devices are created, the maximum movement trajectory creation process ends.

次に、移動情報入力処理の手順について詳細に説明する。
図15は、移動情報入力処理の手順を示すフローチャートである。以下、図15に示す処理をステップ番号に沿って説明する。
Next, the procedure of the movement information input process will be described in detail.
FIG. 15 is a flowchart showing the procedure of the movement information input process. In the following, the process illustrated in FIG. 15 will be described in order of step number.

[ステップS41]最大移動軌跡作成部140は、選択した機器の初回の移動軌跡作成(第1フェーズ)であれば、移動基準点の入力を受け付ける。なお、選択した機器の2回目以降の移動軌跡作成(第2フェーズ以降)の場合、直前の移動動作における最後の位置での機器の基準点が、移動基準点となる。最大移動軌跡作成部140は、入力された移動基準点をRAM102内に格納する。   [Step S41] The maximum movement trajectory creation unit 140 accepts an input of a movement reference point if it is the first movement trajectory creation (first phase) of the selected device. In addition, in the case of the second or subsequent movement trajectory creation (after the second phase) of the selected device, the reference point of the device at the last position in the previous movement operation becomes the movement reference point. The maximum movement trajectory creation unit 140 stores the input movement reference point in the RAM 102.

[ステップS42]最大移動軌跡作成部140は、ユーザからの操作入力に基づいて、機器の移動動作が回転移動か否かを判断する。機器を回転移動させる場合、処理がステップS44に進められる。機器を平行移動させる場合、処理がステップS43に進められる。   [Step S42] The maximum movement trajectory creation unit 140 determines whether the movement operation of the device is a rotational movement based on an operation input from the user. When the device is rotated, the process proceeds to step S44. When the device is moved in parallel, the process proceeds to step S43.

[ステップS43]最大移動軌跡作成部140は、機器を平行移動させる場合、平行移動の方向を示す方向ベクトル、および平行移動の距離の入力を受け付ける。そして、最大移動軌跡作成部140は、入力された方向ベクトルと距離とをRAM102に格納する。その度、移動情報入力処理が終了する。   [Step S43] When the device moves in parallel, the maximum movement trajectory creation unit 140 receives an input of a direction vector indicating a direction of parallel movement and a distance of parallel movement. The maximum movement trajectory creation unit 140 stores the input direction vector and distance in the RAM 102. Each time, the movement information input process ends.

[ステップS44]最大移動軌跡作成部140は、機器を回転運動させる場合、ユーザからの操作入力に基づいて、方向ベクトル回りの回転か否かを判断する。方向ベクトル回りの回転であれば、処理がステップS45に進められる。方向ベクトル回りの回転ではない場合、進行方向に垂直な軸回りの回転をさせるものと判断され、処理がステップS46に進められる。   [Step S44] When the device moves in a rotational manner, the maximum movement trajectory creation unit 140 determines whether the rotation is around a direction vector based on an operation input from the user. If the rotation is around the direction vector, the process proceeds to step S45. If the rotation is not about the direction vector, it is determined that the rotation is about the axis perpendicular to the traveling direction, and the process proceeds to step S46.

[ステップS45]最大移動軌跡作成部140は、機器に方向ベクトル回りの回転運動をさせる場合、回転基準点と回転角度との入力を受け付ける。そして、最大移動軌跡作成部140は、入力された回転角度をRAM102に格納する。その後、移動情報入力処理が終了する。   [Step S45] The maximum movement trajectory creation unit 140 receives an input of a rotation reference point and a rotation angle when causing the device to perform a rotational motion around a direction vector. Then, the maximum movement trajectory creation unit 140 stores the input rotation angle in the RAM 102. Thereafter, the movement information input process ends.

[ステップS46]最大移動軌跡作成部140は、機器に方向ベクトルに垂直な軸回りの回転運動をさせる場合、回転基準点、方向ベクトル、および回転角度の入力を受け付ける。そして、最大移動軌跡作成部140は、回転基準点と方向ベクトルとをRAM102に格納する。   [Step S46] The maximum movement trajectory creation unit 140 accepts input of a rotation reference point, a direction vector, and a rotation angle when causing the device to rotate about an axis perpendicular to the direction vector. Then, the maximum movement trajectory creation unit 140 stores the rotation reference point and the direction vector in the RAM 102.

次に、入力された移動情報に基づいて移動する機器の軌跡について説明する。
図16は、移動する機器の軌跡の例を示す図である。図16の例では、機器41が、入力された移動情報に従って移動する様子が示されている。機器41の移動情報としては、移動基準点P4、第1〜第4の方向ベクトルV1〜V4、第1,第2の回転基準点P5,P6、第1、第2、第4の距離d1,d2,d4などがある。また、回転運動を行う際には、回転角度も入力される。
Next, the trajectory of the device that moves based on the input movement information will be described.
FIG. 16 is a diagram illustrating an example of a trajectory of a moving device. In the example of FIG. 16, a state in which the device 41 moves according to the input movement information is shown. The movement information of the device 41 includes a movement reference point P4, first to fourth direction vectors V1 to V4, first and second rotation reference points P5 and P6, first, second and fourth distances d1, d2, d4, etc. In addition, when performing a rotational motion, a rotational angle is also input.

移動基準点P4は、機器41の移動開始位置を示している。第1の方向ベクトルV1は、移動基準点P4から機器41が平行移動する方向を示している。機器41は、移動基準点P4から第1の方向ベクトルV1で示される方向に第1の距離d1だけ平行移動する。   The movement reference point P4 indicates the movement start position of the device 41. The first direction vector V1 indicates the direction in which the device 41 moves in parallel from the movement reference point P4. The device 41 translates from the movement reference point P4 by the first distance d1 in the direction indicated by the first direction vector V1.

第1の回転基準点P5は、回転軸が通過する点を示している。すなわち、機器41は、進行方向(第1の方向ベクトルV1で示された方向)に平行で第1の回転基準点P5を通る軸(ロール軸)回りの回転運動をシミュレートする。回転の角度は、右ねじの法則(進行方向に向かって時計回り)の回転を正の方向とし、移動情報で指定された角度だけ機器41が回転する。   The first rotation reference point P5 indicates a point through which the rotation axis passes. That is, the device 41 simulates a rotational motion around an axis (roll axis) that is parallel to the traveling direction (the direction indicated by the first direction vector V1) and passes through the first rotation reference point P5. Regarding the rotation angle, the rotation of the right-handed screw rule (clockwise toward the traveling direction) is a positive direction, and the device 41 rotates by an angle specified by the movement information.

第2の方向ベクトルV2は、第1の回転基準点P5における回転動作後の機器41の平行移動の方向を示している。機器41は、第1の回転基準点P5から第2の方向ベクトルV2で示される方向に第2の距離d2だけ平行移動する。   The second direction vector V2 indicates the direction of translation of the device 41 after the rotation operation at the first rotation reference point P5. The device 41 translates from the first rotation reference point P5 by the second distance d2 in the direction indicated by the second direction vector V2.

第2の回転基準点P6は、機器41の2回目の平行移動を終了し、進行方向(第2の方向ベクトルV2で示された方向)に垂直な軸(ヨー軸)回りに回転運動を行う位置を示している。このとき、機器41の一部が第2の回転基準点P6に達したときに、第2の回転基準点P6を通り、第2の回転基準点P6から機器41の基準点へのベクトルと第3の方向ベクトルV3の両方に垂直な軸を中心軸とする回転運動が行われる。このときの回転角度は、移動情報で指定された角度である。ここで、第3の距離d3は、回転動作中の第2の回転基準点P6と機器41の基準点との距離を半径とする弧の長さであり、回転角と半径に基づき計算によって求められる。   The second rotation reference point P6 finishes the second parallel movement of the device 41, and performs a rotational motion around an axis (yaw axis) perpendicular to the traveling direction (the direction indicated by the second direction vector V2). Indicates the position. At this time, when a part of the device 41 reaches the second rotation reference point P6, the second rotation reference point P6 passes through the second rotation reference point P6 and the vector from the second rotation reference point P6 to the reference point of the device 41. Rotational motion is performed with an axis perpendicular to both of the three direction vectors V3 as a central axis. The rotation angle at this time is an angle designated by the movement information. Here, the third distance d3 is a length of an arc having a radius between the second rotation reference point P6 during rotation and the reference point of the device 41, and is obtained by calculation based on the rotation angle and the radius. It is done.

第4の方向ベクトルV4は、第2の回転基準点P6における回転動作後の機器41の平行移動の方向を示している。機器41は、進行方向に垂直な軸回りの回転が終了した位置から第4の方向ベクトルV4で示される方向に第4の距離d4だけ平行移動する。   The fourth direction vector V4 indicates the direction of translation of the device 41 after the rotation operation at the second rotation reference point P6. The device 41 translates by a fourth distance d4 in the direction indicated by the fourth direction vector V4 from the position where the rotation about the axis perpendicular to the traveling direction is completed.

機器41の軌跡形状を判定するとき、機器41が平行移動をした場合、多角柱の形をした軌跡形状が作成される。また、機器41が進行方向に平行な軸回りの回転運動をした場合、円柱の形をした軌跡形状が作成される。   When determining the trajectory shape of the device 41, a trajectory shape in the shape of a polygonal column is created when the device 41 translates. Further, when the device 41 rotates around an axis parallel to the traveling direction, a trajectory shape in the shape of a cylinder is created.

図17は、進行方向に平行な軸回りの回転運動における軌跡形状を示す図である。図17に示すように、機器41が進行方向(図17中に矢印で示す)に平行な軸回りに回転運動をすると、回転する機器41を包含する円柱42が軌跡形状となる。   FIG. 17 is a diagram showing a trajectory shape in a rotational motion around an axis parallel to the traveling direction. As shown in FIG. 17, when the device 41 rotates around an axis parallel to the traveling direction (indicated by an arrow in FIG. 17), the cylinder 42 including the rotating device 41 has a trajectory shape.

機器41が鉛直方向の軸回りの回転運動をした場合、機器41が外接する球を、軌跡形状とする。
図18は、鉛直方向の軸回りの回転運動における軌跡形状を示す図である。図18に示すように、第2の回転基準点P6から半径R2の球43が軌跡形状となる。この球43は、機器41が第2の回転基準点P6を通る鉛直の軸回りに回転したときに外接する球である。
When the device 41 rotates around the vertical axis, the sphere circumscribing the device 41 is defined as a trajectory shape.
FIG. 18 is a diagram illustrating a trajectory shape in a rotational motion around an axis in the vertical direction. As shown in FIG. 18, a sphere 43 having a radius R2 from the second rotation reference point P6 has a trajectory shape. The sphere 43 is a sphere that circumscribes the device 41 when it rotates about a vertical axis passing through the second rotation reference point P6.

次に、図16〜図18に示したような移動を行わせるための移動情報に基づく軌跡形状作成処理の手順を説明する。
図19は、軌跡形状作成処理の手順を示すフローチャートである。以下、図19に示す処理をステップ番号に沿って説明する。
Next, the procedure of the trajectory shape creation process based on the movement information for performing the movement as shown in FIGS. 16 to 18 will be described.
FIG. 19 is a flowchart illustrating the procedure of the trajectory shape creation process. In the following, the process illustrated in FIG. 19 will be described in order of step number.

[ステップS51]最大移動軌跡作成部140は、フェーズ番号を示す変数nを、「1」に設定する。
[ステップS52]最大移動軌跡作成部140は、n番目のフェーズ(第nフェーズ)の移動を実施する。すなわち、最大移動軌跡作成部140は、第nフェーズの移動情報に従って、機器の平行移動、または回転移動をシミュレートする。
[Step S51] The maximum movement trajectory creation unit 140 sets a variable n indicating a phase number to “1”.
[Step S52] The maximum movement trajectory creation unit 140 performs movement in the nth phase (nth phase). That is, the maximum movement trajectory creation unit 140 simulates the parallel movement or rotational movement of the device according to the movement information of the nth phase.

[ステップS53]最大移動軌跡作成部140は、部品の外形により軌跡形状を生成し、干渉空間データ記憶部150に格納する。
[ステップS54]最大移動軌跡作成部140は、第nフェーズが最終フェーズか否かを判断する。最終フェーズであれば、軌跡形状作成処理が終了する。最終フェーズでなければ、処理がステップS55に進められる。
[Step S <b> 53] The maximum movement trajectory creation unit 140 generates a trajectory shape based on the external shape of the component, and stores the trajectory shape in the interference space data storage unit 150.
[Step S54] The maximum movement trajectory creation unit 140 determines whether the nth phase is the final phase. In the final phase, the trajectory shape creation process ends. If it is not the final phase, the process proceeds to Step S55.

[ステップS55]最大移動軌跡作成部140は、変数nの値を1だけカウントアップする。その後、処理がステップS52に進められる。
このように移動する各機器に関する最大移動軌跡作成処理が実行されると、移動軌跡付き機器データと、軌跡形状データとが、干渉空間データ記憶部150に格納される。なお、移動軌跡作成処理のより詳細な内容については、特開2008−234622号公報に開示されている。
[Step S55] The maximum movement trajectory creation unit 140 increments the value of the variable n by one. Thereafter, the process proceeds to step S52.
When the maximum movement trajectory creation process for each device that moves in this way is executed, device data with a movement trajectory and trajectory shape data are stored in the interference space data storage unit 150. Details of the movement trajectory creation process are disclosed in Japanese Patent Application Laid-Open No. 2008-234622.

図20は、最大移動軌跡作成後の干渉空間データ記憶部の格納データを示す図である。干渉空間データ記憶部150には、新たに複数の移動機器付き機器データ153a,153b,153c,・・・と、複数の軌跡形状データ154a,154b,154c,・・・とが格納されている。   FIG. 20 is a diagram illustrating data stored in the interference space data storage unit after the maximum movement trajectory is created. The interference space data storage unit 150 newly stores a plurality of device data with mobile devices 153a, 153b, 153c,... And a plurality of locus shape data 154a, 154b, 154c,.

図21は、移動軌跡付き機器データのデータ構造例を示す図である。図21には、直方体の機器44についての移動軌跡付き機器データ153aを示している。移動軌跡付き機器データ153aには、図5に示した機器データ121aと同種のデータに加え、複数の軌跡形状名が登録されている。軌跡形状名には、移動フェーズごとに作成された軌跡形状データを一意に識別するための名称が設定されている。   FIG. 21 is a diagram illustrating an example of the data structure of device data with a movement locus. FIG. 21 shows device data 153a with a movement locus for a rectangular parallelepiped device 44. In the device data with movement locus 153a, a plurality of locus shape names are registered in addition to the same type of data as the device data 121a shown in FIG. In the trajectory shape name, a name for uniquely identifying the trajectory shape data created for each movement phase is set.

図22は、軌跡形状データのデータ構造例を示す図である。図22では、機器44が第1フェーズから第4フェーズまでの移動動作を行った場合を想定している。第1フェーズの軌跡形状データ154aは、直方体の形状を表している。直方体の軌跡形状データ154aのデータ構造は、図6に示した直方体の積載物データ122aのデータ構造と同様である。ただし、積載物データ122aの積載物名に代えて、軌跡形状名が設定されている。   FIG. 22 is a diagram illustrating a data structure example of trajectory shape data. In FIG. 22, it is assumed that the device 44 performs a moving operation from the first phase to the fourth phase. The first-phase trajectory shape data 154a represents the shape of a rectangular parallelepiped. The data structure of the rectangular parallelepiped trajectory shape data 154a is the same as the data structure of the rectangular parallelepiped load data 122a shown in FIG. However, a trajectory shape name is set instead of the load name of the load data 122a.

図22の例では、移動開始前の機器44の頂点P7の座標が軌跡形状データ154aの基準点として設定されている。また、移動開始前の機器44のローカル座標の座標軸を示すベクトル(ベクトルX4、ベクトルY4、ベクトルZ4)が軌跡形状データに設定されている。   In the example of FIG. 22, the coordinates of the vertex P7 of the device 44 before the start of movement are set as the reference point of the trajectory shape data 154a. In addition, vectors (vector X4, vector Y4, vector Z4) indicating the local coordinate axes of the device 44 before the movement start are set in the trajectory shape data.

図22の例では、第1フェーズにおいて、ローカル座標でのX軸の方向(ベクトルX4の方向)に機器44が平行移動している。そのため、軌跡形状の縦、高さは、それぞれ機器44の縦、高さと等しい。軌跡形状の横は、機器44の横の長さに、第1フェーズによる移動距離を加算した値となる。   In the example of FIG. 22, in the first phase, the device 44 is translated in the direction of the X axis in the local coordinates (the direction of the vector X4). Therefore, the length and height of the trajectory shape are equal to the length and height of the device 44, respectively. The side of the trajectory shape is a value obtained by adding the movement distance of the first phase to the horizontal length of the device 44.

また、第4フェーズでは、機器44が、頂点C1を通りベクトルZ4に平行な軸回りの回転運動を行っている。第4フェーズの軌跡形状データ154eでは、頂点C1の座標が基準点に設定されている。また、軌跡形状データ154eには、軌跡形状の内側の半径R3、外側の半径R4、高さH2、および回転の角度K1が設定されている。   In the fourth phase, the device 44 performs a rotational motion around an axis passing through the vertex C1 and parallel to the vector Z4. In the fourth-phase trajectory shape data 154e, the coordinates of the vertex C1 are set as reference points. In the locus shape data 154e, an inner radius R3, an outer radius R4, a height H2, and a rotation angle K1 of the locus shape are set.

このようにして、移動軌跡付き機器データや軌跡形状データが干渉空間データ記憶部150に格納されると、進入禁止空間判定部160によって、進入禁止空間が作成される。
図23は、進入禁止空間作成処理の手順を示すフローチャートである。以下、図23に示す処理をステップ番号に沿って説明する。
In this way, when the device data with the movement trajectory and the trajectory shape data are stored in the interference space data storage unit 150, the entry prohibition space determination unit 160 creates an entry prohibition space.
FIG. 23 is a flowchart illustrating a procedure of entry prohibition space creation processing. In the following, the process illustrated in FIG. 23 will be described in order of step number.

[ステップS61]進入禁止空間判定部160は、ユーザからの操作入力に基づいて、未処理の機器を選択する。
[ステップS62]進入禁止空間判定部160は、ステップS61で選択された機器の外接形状または軌跡形状を、ユーザインタフェース部110を介してモニタ11に表示する。
[Step S61] The entry prohibition space determination unit 160 selects an unprocessed device based on an operation input from the user.
[Step S62] The entry prohibition space determination unit 160 displays the circumscribed shape or the trajectory shape of the device selected in Step S61 on the monitor 11 via the user interface unit 110.

[ステップS63]進入禁止空間判定部160は、ユーザインタフェース部110を介して、ユーザからの安全考慮値の入力を受け付ける。安全考慮値には、円柱用の安全考慮値と直方体用の安全考慮値とがある。円柱用の安全考慮値は、縦の値と横の値とが入力される。直方体用の安全考慮値としては、縦、横、および高さの値が入力される。入力された値は、選択されている機器の外接形状付き機器データまたは移動軌跡付き機器データに設定される。   [Step S63] The entry prohibition space determination unit 160 receives an input of a safety consideration value from the user via the user interface unit 110. The safety consideration value includes a safety consideration value for a cylinder and a safety consideration value for a rectangular parallelepiped. As the safety consideration value for the cylinder, a vertical value and a horizontal value are input. As the safety consideration value for the rectangular parallelepiped, vertical, horizontal, and height values are input. The input value is set in the device data with circumscribed shape or the device data with movement locus of the selected device.

[ステップS64]進入禁止空間判定部160は、安全考慮値に基づいて、進入禁止空間形状を作成する。具体的には、進入禁止空間判定部160、選択した機器の外接形状または軌跡形状の外側に、安全考慮値で示される幅の接近禁止空間を設ける。そして、進入禁止空間判定部160は、外接形状と接近禁止空間とを合わせた空間、または軌跡形状と接近禁止空間を合わせた空間を、進入禁止空間とする。そして、進入禁止空間判定部160は、進入禁止空間形状を示す進入禁止空間形状データをRAM102に格納する。   [Step S64] The entry prohibition space determination unit 160 creates an entry prohibition space shape based on the safety consideration value. Specifically, the entry prohibition space determination unit 160 and an access prohibition space having a width indicated by a safety consideration value are provided outside the circumscribed shape or trajectory shape of the selected device. Then, the entry prohibition space determination unit 160 sets the space that combines the circumscribed shape and the approach prohibition space or the space that combines the trajectory shape and the approach prohibition space as the entry prohibition space. Then, the entry prohibition space determination unit 160 stores entry prohibition space shape data indicating the entry prohibition space shape in the RAM 102.

[ステップS65]進入禁止空間判定部160は、ユーザからの操作入力に応じて、作成した進入禁止空間を保存するか否かを判断する。進入禁止空間を保存する場合、処理がステップS67に進められる。進入禁止空間を保存しない場合、処理がステップS66に進められる。   [Step S65] The entry prohibition space determination unit 160 determines whether or not to save the created entry prohibition space in response to an operation input from the user. If the entry prohibition space is to be stored, the process proceeds to step S67. If the entry prohibition space is not stored, the process proceeds to step S66.

[ステップS66]進入禁止空間判定部160は、進入禁止空間を保存しない場合、ステップS65で作成した進入禁止空間形状データをRAM102から削除する。その後、処理がステップS62に進められ、新たな安全考慮値に基づいて進入禁止空間の再作成が行われる。   [Step S66] The entry prohibition space determination unit 160 deletes the entry prohibition space shape data created in step S65 from the RAM 102 when the entry prohibition space is not stored. Thereafter, the process proceeds to step S62, and the entry prohibition space is recreated based on the new safety consideration value.

[ステップS67]進入禁止空間判定部160は、ステップS64で作成した進入禁止空間形状を示す進入禁止空間形状データと進入禁止空間付き機器データとを、進入禁止空間データ記憶部170に格納する。この際、進入禁止空間判定部160は、進入禁止空間付き機器データによって指定されている積載物データ、部品データ、外接形状データ、および軌跡形状データを、干渉空間データ記憶部150から進入禁止空間データ記憶部170にコピーする。   [Step S67] The entry prohibition space determination unit 160 stores the entry prohibition space shape data indicating the entry prohibition space shape created in step S64 and the device data with the entry prohibition space in the entry prohibition space data storage unit 170. At this time, the entry prohibition space determination unit 160 transmits the load data, the part data, the circumscribed shape data, and the trajectory shape data specified by the device data with the entry prohibition space from the interference space data storage unit 150. Copy to the storage unit 170.

[ステップS68]進入禁止空間判定部160は、ユーザからの操作入力に基づいて、他の機器の進入禁止空間を作成するか否かを判断する。他の機器の進入禁止空間を作成する場合、処理がステップS61に進められる。他の機器の進入禁止空間の作成を行わない場合、進入禁止空間作成処理が終了する。   [Step S68] The entry prohibition space determination unit 160 determines whether or not to create an entry prohibition space for another device based on an operation input from the user. When creating an entry prohibition space for another device, the process proceeds to step S61. When the entry prohibition space for other devices is not created, the entry prohibition space creation process ends.

このような手順で各機器の進入禁止空間が作成される。そして、各機器にする進入禁止空間付き機器データと、進入禁止空間データとが進入禁止空間データ記憶部170に格納される。   The entry prohibition space for each device is created in such a procedure. Then, the device data with entry prohibition space and the entry prohibition space data for each device are stored in the entry prohibition space data storage unit 170.

図24は、進入禁止空間データ記憶部内のデータ例を示す図である。進入禁止空間が作成されると、各機器の進入禁止空間付き機器データ171a,171b,171c,・・・と、機器の進入禁止空間を示す進入禁止空間データ172a,172b,172c,・・・とが進入禁止空間データ記憶部170に格納される。また、進入禁止空間データ記憶部170には、各機器の積載物や、構成部品に関する積載物データ122a,122b,122c,・・・や部品データ123a,123b,123c,・・・が格納されている。これらの積載物データ122a,122b,122c,・・・や部品データ123a,123b,123c,・・・は、進入禁止空間判定部160によって干渉空間データ記憶部150から進入禁止空間データ記憶部170にコピーされる。   FIG. 24 is a diagram illustrating an example of data in the entry prohibition space data storage unit. When the entry prohibition space is created, device data 171a, 171b, 171c,... With entry prohibition space for each device and entry prohibition space data 172a, 172b, 172c,. Is stored in the entry prohibition space data storage unit 170. Further, the entry prohibition space data storage unit 170 stores the load data of each device, the load data 122a, 122b, 122c,... And the component data 123a, 123b, 123c,. Yes. .. And the parts data 123a, 123b, 123c,... Are transferred from the interference space data storage unit 150 to the entry prohibition space data storage unit 170 by the entry prohibition space determination unit 160. Copied.

図25は、進入禁止空間付き機器データのデータ構造例を示す図である。図25には、ロボット31に関する進入禁止空間付き機器データ171aが示されている。
ロボット31には、円柱形の外接形状33が設けられている。そのため、円柱用の安全考慮値に基づいて、外接形状33を覆う円柱形の進入禁止空間34が作成される。進入禁止空間34の高さは、外接形状33の高さHよりも、円柱用の縦の安全考慮値の分だけ高く設定されている。また、進入禁止空間34の底面の半径は、外接形状33の底面の半径よりも、円柱用の横の安全考慮値の分だけ大きく設定されている。
FIG. 25 is a diagram illustrating a data structure example of device data with entry prohibition space. FIG. 25 shows device data 171a with an entry prohibition space related to the robot 31.
The robot 31 is provided with a cylindrical circumscribed shape 33. Therefore, a cylindrical entry prohibition space 34 that covers the circumscribed shape 33 is created based on the safety consideration value for the cylinder. The height of the entry prohibition space 34 is set higher than the height H of the circumscribed shape 33 by the vertical safety consideration value for the cylinder. The radius of the bottom surface of the entry prohibition space 34 is set to be larger than the radius of the bottom surface of the circumscribed shape 33 by the lateral safety consideration value for the cylinder.

そして、進入禁止空間付き機器データ171aには、ロボット31の外接形状付き機器データ151aが有する情報に加え、進入禁止空間名が設定されている。進入禁止空間名は、進入禁止空間34を一意に特定するための名称である。   In addition, in the device data 171a with entry prohibited space, the name of the entry prohibited space is set in addition to the information included in the device data 151a with circumscribed shape of the robot 31. The entry prohibition space name is a name for uniquely specifying the entry prohibition space 34.

進入禁止空間34は円柱形である。そのため、進入禁止空間34に対応する進入禁止空間データのデータ構造は、図7に示した円柱形の部品の部品データ123aと同様である。ただし進入禁止空間データでは、部品データ123aの部品名に代えて、進入禁止空間名が設定される。   The entry prohibition space 34 has a cylindrical shape. Therefore, the data structure of the entry prohibition space data corresponding to the entry prohibition space 34 is the same as the part data 123a of the cylindrical part shown in FIG. However, in the entry prohibition space data, an entry prohibition space name is set instead of the component name of the component data 123a.

なお、ユーザインタフェース部110は、進入禁止空間付き機器データ171aに基づいて、図25に示すようなロボット31とロボットに関する進入禁止空間34とをモニタ11に表示させることができる。これにより、ユーザは、ロボット31の周囲にどの程度の進入禁止空間34を作成すべきなのかを、容易に認識できる。   Note that the user interface unit 110 can display the robot 31 and the entry prohibition space 34 related to the robot as shown in FIG. 25 on the monitor 11 based on the device data 171a with entry prohibition space. Thereby, the user can easily recognize how much the entry prohibition space 34 should be created around the robot 31.

次に、柵部品配置処理について詳細に説明する。
図26は、柵部品配置処理の手順を示すフローチャートである。以下、図26に示す処理をステップ番号に沿って説明する。
Next, the fence component arrangement process will be described in detail.
FIG. 26 is a flowchart illustrating a procedure of the fence component arrangement process. In the following, the process illustrated in FIG. 26 will be described in order of step number.

[ステップS71]柵作成部180は、各機器の進入禁止空間をグローバル座標のZ軸方向から、Z軸の値が0の平面(X−Y平面)上に平行投影する。
[ステップS72]柵作成部180は、各機器のX−Y平面上の投影形状の論理和演算を行う。論理和演算により、複数の投影形状が重なっている場合には、重なり部分が無くなり、1つの投影形状に統合される。
[Step S71] The fence creating unit 180 projects the entry prohibition space of each device in parallel from the Z-axis direction of the global coordinates onto a plane (XY plane) having a Z-axis value of 0.
[Step S <b> 72] The fence creating unit 180 performs a logical sum operation on the projection shape of each device on the XY plane. When a plurality of projection shapes are overlapped by the logical sum operation, there is no overlapping portion and they are integrated into one projection shape.

[ステップS73]柵作成部180は、各機器の進入禁止空間をグローバル座標のY軸方向から、Y軸の値が0の平面(Z−X平面)上に平行投影する。
[ステップS74]柵作成部180は、各機器のZ−X平面上の投影形状の論理和演算を行う。
[Step S <b> 73] The fence creating unit 180 projects the entry prohibition space of each device from the Y-axis direction of the global coordinates onto a plane (Z-X plane) where the value of the Y-axis is 0.
[Step S74] The fence creating unit 180 performs a logical sum operation on the projected shape of each device on the Z-X plane.

[ステップS75]柵作成部180は、各機器の進入禁止空間をグローバル座標のX軸方向から、X軸の値が0の平面(Y−Z平面)上に平行投影する。
[ステップS76]柵作成部180は、各機器のY−Z平面上の投影形状の論理和演算を行う。
[Step S75] The fence creating unit 180 projects the entry prohibition space of each device in parallel from the X-axis direction of the global coordinates onto a plane (YZ plane) where the value of the X-axis is 0.
[Step S76] The fence creating unit 180 performs a logical sum operation on the projected shapes on the YZ plane of each device.

[ステップS77]柵作成部180は、3方向から進入禁止空間を投影した3つの平面図を、進入禁止領域図として柵配置図記憶部190に格納する。
[ステップS78]柵作成部180は、X−Y平面の進入禁止領域図における投影形状の線の上に配置される柵の3次元部品を生成する。柵の3次元形状における幅は予め設定されている。柵の高さは、投影形状の作成元となった機器の高さに応じて決定される。すなわち、機器の高さが高い程、その周囲に設ける柵も高くなる。柵作成部180は、新たに作成した柵の形状および設置場所を示す柵データを、機器データ記憶部120に格納する。
[Step S77] The fence creation unit 180 stores three plan views, which are obtained by projecting the entry prohibition space from three directions, in the fence arrangement drawing storage unit 190 as entry prohibition area diagrams.
[Step S <b> 78] The fence creating unit 180 generates a three-dimensional part of the fence arranged on the projected line in the entry prohibition area diagram on the XY plane. The width in the three-dimensional shape of the fence is set in advance. The height of the fence is determined according to the height of the device from which the projection shape is created. That is, the higher the height of the device, the higher the fence provided around it. The fence creation unit 180 stores the fence data indicating the newly created fence shape and installation location in the device data storage unit 120.

[ステップS79]柵作成部180は、作成した柵の3次元部品の形状を、X−Z平面、X−Y平面、Y−Z平面それぞれに投影する。
[ステップS80]柵作成部180は、3方向から柵の3次元形状を投影した3つの平面図を、柵配置図として柵配置図記憶部190に格納する。
[Step S79] The fence creating unit 180 projects the shape of the created three-dimensional part of the fence onto the XZ plane, the XY plane, and the YZ plane.
[Step S80] The fence creating unit 180 stores three plan views, which are obtained by projecting the three-dimensional shape of the fence from three directions, in the fence arrangement drawing storage unit 190 as fence arrangement drawings.

このようにして、進入禁止空間への人や物の進入を防ぐ柵の配置を容易に決定することができる。例えば、工場の製造ラインには、様々な機器が設置される。設置される機器は、その機器の性質に応じて、進入禁止空間の広さが異なってくる。そこで、工場の製造ラインにおける進入禁止空間の判定結果と柵の配置の例を説明する。   In this way, it is possible to easily determine the arrangement of the fences that prevent the entry of people and objects into the entry prohibition space. For example, various devices are installed in a production line of a factory. The size of the entry prohibition space varies depending on the nature of the installed device. Therefore, an example of the determination result of the entry prohibition space in the factory production line and the arrangement of the fence will be described.

図27は、工場の製造ラインへの機器の配置を示す図である。工場内には、ベルトコンベア51が設置されている。ベルトコンベア51の周囲には、複数のロボット52〜55が配置されている。各ロボット52〜55は電源装置56が接続されている。また、電源装置56には、ロボット52〜55を制御する制御装置57も接続されている。   FIG. 27 is a diagram illustrating an arrangement of devices on a production line in a factory. A belt conveyor 51 is installed in the factory. A plurality of robots 52 to 55 are arranged around the belt conveyor 51. A power supply device 56 is connected to each of the robots 52 to 55. In addition, a controller 57 that controls the robots 52 to 55 is also connected to the power supply device 56.

この工場には、車58が入ることができる。そのため、車58が出入りするための通路が必要となる。さらに、工場には、製品59を運搬するためのクレーン60が設置されている。クレーン60は、ハンド部61によって製品59を把持し、製品59を運搬できる。   A car 58 can enter this factory. Therefore, a passage for the car 58 to enter and exit is necessary. Further, a crane 60 for transporting the product 59 is installed in the factory. The crane 60 can grip the product 59 by the hand unit 61 and transport the product 59.

以下、図27に示す工場における各機器の進入禁止空間について説明する。なお、ロボット52〜55の進入禁止空間は、図25に示した通りである。
図28は、ベルトコンベアの進入禁止空間を示す図である。ベルトコンベア51自身は移動しないが、ベルトなどの回転部分があり、不用意に近づくべきではない。そのため、ベルトコンベア51の周囲300mm内の空間は、進入禁止空間51aとされている。
Hereinafter, the entry prohibition space of each device in the factory shown in FIG. 27 will be described. The entry prohibition spaces for the robots 52 to 55 are as shown in FIG.
FIG. 28 is a diagram illustrating an entry prohibition space of the belt conveyor. The belt conveyor 51 itself does not move, but there is a rotating part such as a belt and should not approach carelessly. Therefore, the space within 300 mm around the belt conveyor 51 is set as an entry prohibition space 51a.

図29は、電源装置の進入禁止空間を示す図である。電源装置56は発熱すため、近寄りすぎるのは不適切である。そこで、電源装置56の周囲400mm内の空間は、進入禁止空間56aとされている。   FIG. 29 is a diagram illustrating an entry prohibition space of the power supply device. Since the power supply device 56 generates heat, it is inappropriate to be too close. Therefore, a space within 400 mm around the power supply device 56 is an entry prohibition space 56a.

図30は、車の進入禁止空間を示す図である。車58は移動するため、車58が移動可能な通路に沿った最大移動軌跡58aが作成される。この場合、最大移動軌跡58aの周囲を覆うように、最大移動軌跡58aとの間に300mmの間隔を有する進入禁止空間58bが作成される。   FIG. 30 is a diagram illustrating a vehicle entry prohibition space. Since the car 58 moves, a maximum movement locus 58a is created along a path through which the car 58 can move. In this case, an entry prohibition space 58b having an interval of 300 mm between the maximum movement locus 58a is created so as to cover the periphery of the maximum movement locus 58a.

図31は、クレーンの進入禁止空間を示す図である。クレーン60は、梁62の部分は移動せず、ハンド部61が移動する。このような場合、外接形状作成部130では、ハンド部61についてのみ着目して、動作シミュレーションを行う。その結果、ハンド部61の干渉空間61aが得られる。そして、干渉空間61aと、その下の落下物干渉空間とを合わせた形状が、外接形状61bとなる。この場合、外接形状61bの周囲を覆うように、外接形状61bとの間に300mmの間隔を有する進入禁止空間61cが作成される。   FIG. 31 is a diagram illustrating a crane entry prohibition space. In the crane 60, the beam 62 does not move, and the hand unit 61 moves. In such a case, the circumscribed shape creating unit 130 performs an operation simulation while paying attention only to the hand unit 61. As a result, an interference space 61a of the hand unit 61 is obtained. A shape obtained by combining the interference space 61a and the falling object interference space below it is a circumscribed shape 61b. In this case, an entry prohibition space 61c having an interval of 300 mm is created between the circumscribed shape 61b and the circumscribed shape 61b.

なお、図27に示す制御装置57はユーザが操作を行う装置であり、ユーザが近寄ることが想定されている。しかし、制御装置57の周囲に進入禁止空間を作成しておけば、不注意によってユーザが制御装置57に接触することにより、意図しないスイッチの操作の発生を防止できる。図27の例では、制御装置57の周囲にも進入禁止空間を作成するものとする。その場合の進入禁止空間の形状は、図30に示した電源装置56の場合と同様である。ただし、安全考慮値については、電源装置56よりも小さな値とすることができる。   Note that the control device 57 shown in FIG. 27 is a device operated by the user, and it is assumed that the user approaches. However, if an entry prohibition space is created around the control device 57, an unintentional switch operation can be prevented when the user inadvertently contacts the control device 57. In the example of FIG. 27, it is assumed that an entry prohibition space is also created around the control device 57. In this case, the shape of the entry prohibition space is the same as that of the power supply device 56 shown in FIG. However, the safety consideration value can be a value smaller than that of the power supply device 56.

このようにして各機器について作成された進入禁止空間は平面に投影され、進入禁止領域図が作成される。
図32は、進入禁止空間のX−Y平面図と進入禁止領域図とを示す図である。各機器の進入禁止空間をX−Y平面に投影したときのX−Y平面図71には、各進入禁止空間の形状が重なり合って示されている。X−Y平面図71内の投影された各進入禁止空間の形状のうち重なりを排除し、その輪郭のみを残すことで進入禁止領域図72となる。
The entry prohibition space created for each device in this way is projected onto a plane, and an entry prohibition area diagram is created.
FIG. 32 is a diagram illustrating an XY plan view of an entry prohibition space and an entry prohibition area diagram. In the XY plan view 71 when the entry prohibition space of each device is projected onto the XY plane, the shapes of the entry prohibition spaces are shown overlapping each other. An entry prohibition area diagram 72 is obtained by eliminating the overlap among the shapes of the projected entry prohibition spaces in the XY plan view 71 and leaving only the contours.

図33は、進入禁止空間のX−Z平面図である。図34は、進入禁止空間のY−Z平面図である。X−Z平面図73およびY−Z平面図74では、水平方向から見たときの進入禁止領域が示される。   FIG. 33 is an XZ plan view of the entry prohibition space. FIG. 34 is a YZ plan view of the entry prohibition space. In the XZ plan view 73 and the YZ plan view 74, an entry prohibition region when viewed from the horizontal direction is shown.

進入禁止領域図72が作成されると、進入禁止領域を示す線に沿って、柵の3次元部品が作成される。なお、ユーザは、ユーザインタフェース部110を介して柵作成部180に指示を入力し、必要に応じて人や車の出入りが可能なように柵の追加や削除、および位置の変更などを行うことができる。作成された柵の部品データは、機器データ記憶部120に格納される。   When the entry prohibition area diagram 72 is created, a three-dimensional part of a fence is created along a line indicating the entry prohibition area. The user inputs an instruction to the fence creation unit 180 via the user interface unit 110, and adds or deletes a fence and changes the position so that people and vehicles can enter and exit as necessary. Can do. The created fence part data is stored in the equipment data storage unit 120.

図35は、柵の部品データのデータ構造例を示す図である。図35の例では、柵80は、直方体部81,82と部分円筒部83とで構成されている。柵データ124aには、柵幅が設定されている。柵幅は、柵80の横方向(図中、ベクトルX5の方向)の長さである。また、柵データ124aには、直方体部81,82と部分円筒部83との形状を示す部品データが設定されている。なお、図35では、直方体部82の部品データについては省略されている。   FIG. 35 is a diagram illustrating an example of a data structure of fence part data. In the example of FIG. 35, the fence 80 is composed of rectangular parallelepiped portions 81 and 82 and a partial cylindrical portion 83. A fence width is set in the fence data 124a. The fence width is the length of the fence 80 in the horizontal direction (the direction of the vector X5 in the figure). Further, part data indicating the shapes of the rectangular parallelepiped portions 81 and 82 and the partial cylindrical portion 83 is set in the fence data 124a. In FIG. 35, the part data of the rectangular parallelepiped portion 82 is omitted.

直方体部81の部品データのデータ構造は、図6に示した直方体の積載物データ122aのデータ構造と同様である。ただし、直方体部81の部品データでは、積載物データ122aの積載物名に代えて、部品名が設定される。   The data structure of the part data of the rectangular parallelepiped portion 81 is the same as the data structure of the load data 122a of the rectangular parallelepiped shown in FIG. However, in the component data of the rectangular parallelepiped portion 81, a component name is set instead of the load name of the load data 122a.

部分円筒部83の部品データには、部品名、基準点、3軸方向のベクトル、内径、外径、中心角、高さの値が設定される。部品名、基準点、3軸方向のベクトルについては、図7に示した円柱形の部品に関する部品データ123aと同種の値が設定される。内径は、部分円筒部83の内面の半径R5である。外径は、部分円筒部83の外面の半径R6である。中心角は、部分円筒部83の基準点から内面の両端それぞれまで引いた2つの線分の成す角である。高さは、部分円筒部83のベクトルZ5方向の長さH3である。   In the part data of the partial cylindrical part 83, values of a part name, a reference point, a triaxial vector, an inner diameter, an outer diameter, a central angle, and a height are set. For the part name, reference point, and triaxial vector, the same type of value as the part data 123a regarding the cylindrical part shown in FIG. 7 is set. The inner diameter is a radius R5 of the inner surface of the partial cylindrical portion 83. The outer diameter is a radius R6 of the outer surface of the partial cylindrical portion 83. The central angle is an angle formed by two line segments drawn from the reference point of the partial cylindrical portion 83 to both ends of the inner surface. The height is the length H3 of the partial cylindrical portion 83 in the vector Z5 direction.

このような柵データ124aが機器データ記憶部120に格納される。その後、ユーザインタフェース部110は、機器データ記憶部120に格納された各種データを参照し、柵と機器との配置状態を、モニタ11の画面に表示することができる。   Such fence data 124 a is stored in the device data storage unit 120. After that, the user interface unit 110 can display the arrangement state of the fence and the device on the screen of the monitor 11 with reference to various data stored in the device data storage unit 120.

図36は、工場内の機器と柵との配置を示す表示画面を示す図である。画面91には、予め配置された機器と、各の周囲の進入禁止区間を囲む柵が表示されている。なお、ユーザインタフェース部110は、隠れ線処理を施すことにより、他の機器または柵の背後になる線を非表示とすることができる。   FIG. 36 is a diagram showing a display screen showing the arrangement of equipment and fences in the factory. The screen 91 displays pre-arranged devices and a fence surrounding each entry prohibition section. Note that the user interface unit 110 can hide other lines or lines behind the fence by performing hidden line processing.

図37は、隠れ線処理を行って工場内の機器と柵との配置を示す表示画面を示す図である。隠れ線処理を行った画面92では、視点方向から見て、他の機器または柵の裏に隠れる部分については、線が非表示となっている。その結果、柵と機器とを配置したときの様子が、分かりやすく表示されている。   FIG. 37 is a diagram showing a display screen showing the arrangement of equipment and fences in the factory by performing hidden line processing. In the screen 92 on which the hidden line processing has been performed, lines are not displayed for portions hidden behind other devices or fences when viewed from the viewpoint direction. As a result, the state when the fence and the device are arranged is displayed in an easy-to-understand manner.

このようにして、工場に配置する機器の進入禁止空間を適格に算出し、その進入禁止領域を囲う柵の配置場所の決定を容易に行うことができる。
ところで、進入禁止空間の判断は、屋外に設置する設備の配置場所を決定する際にも行われる。例えば、工場に隣接する荷積み場に、クレーンなどを設定する場合がある。この場合も、トラックの移動軌跡などを考慮した進入禁止空間の判断が行われる。
In this way, it is possible to appropriately calculate the entry prohibition space of the equipment to be arranged in the factory, and to easily determine the arrangement place of the fence surrounding the entry prohibition area.
By the way, the determination of the entry prohibition space is also made when determining the location of the equipment to be installed outdoors. For example, a crane or the like may be set at a loading site adjacent to a factory. In this case as well, the entry prohibition space is determined in consideration of the track of the truck.

図38は、荷積み場の設備の配置例を示す図である。工場201に隣接した平地に、荷物の積み卸しをするための荷積み場が設けられている。工場201内部のような屋内の空間では、工場201内部のみで進入禁止空間の判定が行われる。屋外の進入禁止空間を判定する場合、予め進入禁止空間判定領域202をユーザが指定する。そして、進入禁止空間判定領域202内の設備ごとに進入禁止空間が判定される。図38の例では、トラッククレーン210、フォークリフト220、トラック230、橋形クレーン240などが配置されている。   FIG. 38 is a diagram illustrating an arrangement example of facilities in the loading area. A loading space for loading and unloading luggage is provided on a flat land adjacent to the factory 201. In an indoor space such as the interior of the factory 201, the entry prohibition space is determined only within the factory 201. When determining the outdoor entry prohibition space, the user designates the entry prohibition space determination area 202 in advance. Then, the entry prohibition space is determined for each facility in the entry prohibition space determination area 202. In the example of FIG. 38, a truck crane 210, a forklift 220, a truck 230, a bridge crane 240, and the like are arranged.

図39は、トラッククレーンの進入禁止空間を示す図である。トラッククレーン210は、停車時にクレーンを使って荷物の積み卸しを行う。そのため、トラッククレーン210では、クレーンの届く範囲と、その下の落下物干渉空間とが外接空間211となる。ユーザは、運搬する荷物の大きさを考慮に入れた安全考慮値を設定する。図39の例では、周囲すべての方向に対して、安全考慮値が1000mmである。すると、外接空間211から安全考慮値だけ広げた空間が、進入禁止空間212とされる。なお、トラッククレーン210が移動する際の進入禁止空間は、図30に示す車58の例と同様の方法で判定される。   FIG. 39 is a diagram illustrating an entry prohibition space of a truck crane. The truck crane 210 loads and unloads luggage using the crane when the vehicle stops. Therefore, in the truck crane 210, the range that the crane reaches and the falling object interference space below the outer space 211 become the circumscribed space 211. The user sets a safety consideration value that takes into account the size of the package to be carried. In the example of FIG. 39, the safety consideration value is 1000 mm for all surrounding directions. Then, a space that is widened by a safety consideration value from the circumscribed space 211 is defined as the entry prohibition space 212. The entry prohibition space when the truck crane 210 moves is determined by a method similar to the example of the car 58 shown in FIG.

図40は、フォークリフトの進入禁止空間を示す図である。フォークリフト220は、荷物を高く掲げることができる。そこで、荷物が届く高さの外接空間221が設定される。そして、ユーザは、運搬する荷物の大きさを考慮に入れた安全考慮値を設定する。図39の例では、横方向の安全考慮値が500mmであり、上方向の安全考慮値は0mmである。すると、外接空間221から安全考慮値だけ広げた空間が、進入禁止空間222とされる。   FIG. 40 is a diagram showing a forklift entry prohibition space. The forklift 220 can raise a load high. Therefore, a circumscribed space 221 that is high enough to receive a package is set. The user then sets a safety consideration value that takes into account the size of the luggage to be transported. In the example of FIG. 39, the safety consideration value in the lateral direction is 500 mm, and the safety consideration value in the upward direction is 0 mm. Then, a space that is widened from the circumscribed space 221 by a safety consideration value is defined as the entry prohibition space 222.

なお、図38に示したトラック230の進入禁止空間は、図30に示す車58の例と同様の方法で判定される。また、図38に示した橋形クレーン240の進入禁止空間は、図31に示すクレーン60の例と同様の方法で判定される。   38 is determined by a method similar to that of the example of the car 58 shown in FIG. Further, the entry prohibition space of the bridge crane 240 shown in FIG. 38 is determined by the same method as in the example of the crane 60 shown in FIG.

このようにして、荷積み場の設備に関しても、適切な進入禁止空間を設定することができる。
以上説明したように、落下物を想定し、干渉空間より下の空間についても進入禁止空間に含めるようにしたため、進入禁止空間の抽出漏れを防止できる。しかも、干渉空間を算出する際には、運搬物が到達可能な空間を含めた干渉空間を算出している。これにより、進入禁止空間外に搬送物が飛び出すことを防止できる。また、外接形状から予め設定された安全考慮値で示される幅だけ広げた空間を進入禁止空間としたことで、誤って進入禁止空間に人が進入する可能性を低下させることができる。
In this way, it is possible to set an appropriate entry prohibition space for the equipment at the loading site.
As described above, since a fallen object is assumed and the space below the interference space is also included in the entry prohibited space, it is possible to prevent the entry prohibited space from being extracted. In addition, when calculating the interference space, the interference space including the space that the transportable object can reach is calculated. Thereby, it can prevent a conveyed product jumping out of the entry prohibition space. Moreover, the possibility that a person accidentally enters the entry prohibition space can be reduced by setting the space that is widened from the circumscribed shape by a predetermined safety consideration value as the entry prohibition space.

なお、上記実施の形態では、進入禁止空間に設置する柵を示す柵データを自動生成している。これにより、工場の設備配置計画段階において、進入禁止空間への人の進入を物理的に防止するための柵の配置場所の決定が容易となる。しかも、複数の機器それぞれの進入禁止空間の投影形状が重なり合う場合、投影形状を合成し、合成後の形状の周囲を囲う柵を示す柵データを生成している。これにより、ある機器の進入禁止空間内に、他の機器を囲む柵が配置されるような柵の配置間違いを防止できる。さらに、柵と機器との配置状況を画面表示することで、機器と柵の配置状況を容易に確認することができる。その結果、機器や柵の自動配置により、工場全体の設備配置設計内容を容易に確認することができる。   In the above embodiment, fence data indicating a fence to be installed in the entry prohibition space is automatically generated. This facilitates the determination of the location of the fence for physically preventing people from entering the entry-prohibited space at the facility installation planning stage of the factory. In addition, when the projected shapes of the entry prohibition spaces of the plurality of devices overlap, the projected shapes are combined, and fence data indicating a fence surrounding the combined shape is generated. Thereby, the arrangement | positioning mistake of the fence which the fence surrounding other apparatuses is arrange | positioned in the entry prohibition space of a certain apparatus can be prevented. Furthermore, by displaying the arrangement state of the fence and the device on the screen, the arrangement state of the device and the fence can be easily confirmed. As a result, the equipment layout design content of the entire factory can be easily confirmed by automatic placement of equipment and fences.

また、上記の実施の形態では、機器が移動可能な場合、機器が移動することで到達可能な空間を示す軌跡形状を作成し、軌跡形状を含む空間も進入禁止空間としている。これにより、工場内の移動機器のための通路の確保と、その通路周辺に設置される機器周辺の安全の確保とを合わせて行うことができる。従って、工場内や荷積み場における設備配置計画を効率的に行うことができる。   Further, in the above embodiment, when the device is movable, a trajectory shape indicating a space that can be reached by the movement of the device is created, and the space including the trajectory shape is also set as the entry prohibition space. Thereby, securing of the passage for the mobile equipment in the factory and securing of the safety around the equipment installed around the passage can be performed together. Therefore, the facility arrangement plan in the factory or at the loading site can be efficiently performed.

なお、図1に示した進入禁止空間分析装置1の処理機能や、図3に示した設備配置計画支援装置100の処理機能は、コンピュータで実現することができる。各装置の処理機能をコンピュータによって実現するため、コンピュータが有すべき機能の処理内容を記述したプログラムが提供される。そのプログラムをコンピュータで実行することにより、上記処理機能がコンピュータ上で実現される。処理内容を記述したプログラムは、コンピュータで読み取り可能な記録媒体に記録しておくことができる。コンピュータで読み取り可能な記録媒体としては、磁気記憶装置、光ディスク、光磁気記録媒体、半導体メモリなどがある。磁気記憶装置には、ハードディスク装置(HDD)、フレキシブルディスク(FD)、磁気テープなどがある。光ディスクには、DVD、DVD−RAM、CD−ROM/RWなどがある。光磁気記録媒体には、MO(Magneto-Optical disc)などがある。   The processing function of the entry prohibition space analysis device 1 shown in FIG. 1 and the processing function of the facility arrangement plan support device 100 shown in FIG. 3 can be realized by a computer. In order to realize the processing function of each device by a computer, a program describing the processing content of the function that the computer should have is provided. By executing the program on a computer, the above processing functions are realized on the computer. The program describing the processing contents can be recorded on a computer-readable recording medium. Examples of the computer-readable recording medium include a magnetic storage device, an optical disk, a magneto-optical recording medium, and a semiconductor memory. Examples of the magnetic storage device include a hard disk device (HDD), a flexible disk (FD), and a magnetic tape. Examples of the optical disc include a DVD, a DVD-RAM, and a CD-ROM / RW. Magneto-optical recording media include MO (Magneto-Optical disc).

プログラムを流通させる場合には、例えば、そのプログラムが記録されたDVD、CD−ROMなどの可搬型記録媒体が販売される。また、プログラムをサーバコンピュータの記憶装置に格納しておき、ネットワークを介して、サーバコンピュータから他のコンピュータにそのプログラムを転送することもできる。   When distributing the program, for example, a portable recording medium such as a DVD or a CD-ROM in which the program is recorded is sold. It is also possible to store the program in a storage device of a server computer and transfer the program from the server computer to another computer via a network.

プログラムを実行するコンピュータは、例えば、可搬型記録媒体に記録されたプログラムもしくはサーバコンピュータから転送されたプログラムを、自己の記憶装置に格納する。そして、コンピュータは、自己の記憶装置からプログラムを読み取り、プログラムに従った処理を実行する。なお、コンピュータは、可搬型記録媒体から直接プログラムを読み取り、そのプログラムに従った処理を実行することもできる。また、コンピュータは、サーバコンピュータからプログラムが転送されるごとに、逐次、受け取ったプログラムに従った処理を実行することもできる。   The computer that executes the program stores, for example, the program recorded on the portable recording medium or the program transferred from the server computer in its own storage device. Then, the computer reads the program from its own storage device and executes processing according to the program. The computer can also read the program directly from the portable recording medium and execute processing according to the program. Further, each time the program is transferred from the server computer, the computer can sequentially execute processing according to the received program.

また、上記の処理機能の少なくとも一部を、DSP(Digital Signal Processor)、ASIC(Application Specific Integrated Circuit)、PDL(Programmable Logic Device)などの電子回路で実現することもできる。   In addition, at least a part of the above processing functions can be realized by an electronic circuit such as a DSP (Digital Signal Processor), an ASIC (Application Specific Integrated Circuit), or a PDL (Programmable Logic Device).

以上、実施の形態を例示したが、実施の形態で示した各部の構成は同様の機能を有する他のものに置換することができる。また、他の任意の構成物や工程が付加されてもよい。さらに、前述した実施の形態のうちの任意の2以上の構成(特徴)を組み合わせたものであってもよい。   As mentioned above, although embodiment was illustrated, the structure of each part shown by embodiment can be substituted by the other thing which has the same function. Moreover, other arbitrary structures and processes may be added. Further, any two or more configurations (features) of the above-described embodiments may be combined.

以上説明した実施の形態の主な技術的特徴は、以下の付記の通りである。
(付記1) コンピュータに、
機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、前記機器データに基づき、機器の可動部分が到達可能な干渉空間を判定し、
前記干渉空間と、前記干渉空間よりも下の空間とを含む進入禁止空間を判定し、
前記進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する、
処理を実行させることを特徴とする進入禁止空間分析プログラム。
The main technical features of the embodiment described above are as follows.
(Supplementary note 1)
With reference to device data storage means in which device data indicating the structure of the device is stored in advance, based on the device data, determine the interference space that the movable part of the device can reach,
Determining an entry prohibition space including the interference space and a space below the interference space;
Storing entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means;
An entry prohibition space analysis program characterized by causing processing to be executed.

(付記2) 前記機器データには、前記機器が運搬する運搬物の形状が設定されており、前記干渉空間を算出する際には、前記機器が動作することにより前記運搬物が到達可能な空間を含めた前記干渉空間を算出することを特徴とする付記1記載の進入禁止空間分析プログラム。   (Additional remark 2) The shape of the transported material carried by the device is set in the device data, and when the interference space is calculated, the space that the transported product can reach by operating the device. The entry prohibition space analysis program according to supplementary note 1, wherein the interference space including the calculation is calculated.

(付記3) 前記進入禁止空間を判定する際には、前記干渉空間と、前記干渉空間よりも下の空間とを合わせた空間を、予め設定された安全考慮値で示される幅だけ広げた空間を前記進入禁止空間とすることを特徴とする付記1記載の進入禁止空間分析プログラム。   (Additional remark 3) When determining the said entry prohibition space, the space which expanded the space which combined the said interference space and the space under the said interference space only by the width | variety shown by the preset safety consideration value The entry prohibition space analysis program according to appendix 1, wherein the entry prohibition space is defined as the entry prohibition space.

(付記4) 前記コンピュータに、さらに、
前記進入禁止空間データを参照し、前記進入禁止空間を前記機器の接地面に平行投影し、投影された形状を囲う位置に設置する柵を示す柵データを生成する処理を実行させることを特徴とする付記1記載の進入禁止空間分析プログラム。
(Appendix 4) In addition to the computer,
Referring to the entry prohibition space data, performing parallel projection of the entry prohibition space on the ground plane of the device, and executing processing for generating fence data indicating a fence installed at a position surrounding the projected shape. The entry prohibition space analysis program according to Supplementary Note 1.

(付記5) 前記機器が複数ある場合、前記柵データを生成する際には、複数の前記機器それぞれの前記進入禁止空間を前記接地面に平行投影し、重なり合う形状を合成し、合成後の形状の周囲を囲う柵を示す前記柵データを生成することを特徴とする付記4記載の進入禁止空間分析プログラム。   (Supplementary Note 5) When there are a plurality of the devices, when generating the fence data, the entry prohibition space of each of the plurality of devices is projected in parallel on the ground contact surface, the overlapping shapes are combined, and the combined shape The entry prohibition space analysis program according to appendix 4, characterized in that the fence data indicating a fence surrounding the periphery of the road is generated.

(付記6) 前記コンピュータに、
前記柵データと前記機器データとに基づいて、前記柵と前記機器との配置を画面表示する処理を実行させることを特徴とする付記4記載の進入禁止空間分析プログラム。
(Appendix 6) In the computer,
The entry prohibition space analysis program according to appendix 4, wherein a process of displaying the arrangement of the fence and the device on a screen is executed based on the fence data and the device data.

(付記7) 前記コンピュータに、さらに、
前記機器が移動可能な場合、移動内容を示す移動情報に基づいて前記機器が移動することで到達可能な空間を示す軌跡形状を作成する処理を実行させ、
前記進入禁止空間を判定する際には、前記軌跡形状を含む空間も前記進入禁止空間とすることを特徴とする付記1記載の進入禁止空間分析プログラム。
(Appendix 7) In addition to the computer,
When the device is movable, a process for creating a trajectory shape indicating a space that can be reached by moving the device based on movement information indicating movement content is performed.
The entry prohibition space analysis program according to appendix 1, wherein when the entry prohibition space is determined, a space including the locus shape is also set as the entry prohibition space.

(付記8) 機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、前記機器データに基づき、機器の可動部分が到達可能な干渉空間を判定する干渉空間判定手段と、
前記干渉空間と、前記干渉空間よりも下の空間とを含む進入禁止空間を判定する進入禁止空間判定手段と、
前記進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する進入禁止空間データ格納手段と、
を有することを特徴とする進入禁止空間分析装置。
(Supplementary Note 8) An interference space determination unit that refers to a device data storage unit in which device data indicating a device structure is stored in advance, and determines an interference space that can be reached by a movable part of the device based on the device data;
An entry prohibition space determination means for determining an entry prohibition space including the interference space and a space below the interference space;
Entry prohibition space data storage means for storing entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means;
An entry-prohibited space analyzing apparatus characterized by comprising:

(付記9) コンピュータが、
機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、前記機器データに基づき、機器の可動部分が到達可能な干渉空間を判定し、
前記干渉空間と、前記干渉空間よりも下の空間とを含む進入禁止空間を判定し、
前記進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する、
ことを特徴とする進入禁止空間分析方法。
(Supplementary note 9)
With reference to device data storage means in which device data indicating the structure of the device is stored in advance, based on the device data, determine the interference space that the movable part of the device can reach,
Determining an entry prohibition space including the interference space and a space below the interference space;
Storing entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means;
An entry prohibition space analysis method characterized by that.

1 進入禁止空間分析装置
1a 機器データ記憶手段
1b 干渉空間判定手段
1c 進入禁止空間判定手段
1d 進入禁止空間データ格納手段
1e 進入禁止空間データ記憶手段
2 機器
3 運搬物
4 干渉空間
5 進入禁止空間
DESCRIPTION OF SYMBOLS 1 Access prohibition space analyzer 1a Equipment data storage means 1b Interference space determination means 1c Access prohibition space determination means 1d Access prohibition space data storage means 1e Access prohibition space data storage means 2 Equipment 3 Carrying object 4 Interference space 5 Access prohibition space

Claims (7)

コンピュータに、
機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、前記機器データに基づき、機器の可動部分が到達可能な干渉空間を判定し、
前記干渉空間と、前記干渉空間よりも下の空間とを含む進入禁止空間を判定し、
前記進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する、
処理を実行させることを特徴とする進入禁止空間分析プログラム。
On the computer,
With reference to device data storage means in which device data indicating the structure of the device is stored in advance, based on the device data, determine the interference space that the movable part of the device can reach,
Determining an entry prohibition space including the interference space and a space below the interference space;
Storing entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means;
An entry prohibition space analysis program characterized by causing processing to be executed.
前記機器データには、前記機器が運搬する運搬物の形状が設定されており、前記干渉空間を算出する際には、前記機器が動作することにより前記運搬物が到達可能な空間を含めた前記干渉空間を算出することを特徴とする請求項1記載の進入禁止空間分析プログラム。   In the device data, the shape of the transported material carried by the device is set, and when calculating the interference space, the space including the space that the transported object can reach by operating the device is included. 2. The entry prohibition space analysis program according to claim 1, wherein the interference space is calculated. 前記コンピュータに、さらに、
前記進入禁止空間データを参照し、前記進入禁止空間を前記機器の接地面に平行投影し、投影された形状を囲う位置に設置する柵を示す柵データを生成する処理を実行させることを特徴とする請求項1記載の進入禁止空間分析プログラム。
In addition to the computer,
Referring to the entry prohibition space data, performing parallel projection of the entry prohibition space on the ground plane of the device, and executing processing for generating fence data indicating a fence installed at a position surrounding the projected shape. The entry prohibition space analysis program according to claim 1.
前記機器が複数ある場合、前記柵データを生成する際には、複数の前記機器それぞれの前記進入禁止空間を前記接地面に平行投影し、重なり合う形状を合成し、合成後の形状の周囲を囲う柵を示す前記柵データを生成することを特徴とする請求項3記載の進入禁止空間分析プログラム。   When there are a plurality of devices, when generating the fence data, the entry prohibition space of each of the plurality of devices is projected in parallel on the grounding surface, the overlapping shapes are combined, and the periphery of the combined shape is surrounded. The entry prohibition space analysis program according to claim 3, wherein the fence data indicating the fence is generated. 前記コンピュータに、さらに、
前記機器が移動可能な場合、移動内容を示す移動情報に基づいて前記機器が移動することで到達可能な空間を示す軌跡形状を作成する処理を実行させ、
前記進入禁止空間を判定する際には、前記軌跡形状を含む空間も前記進入禁止空間とすることを特徴とする請求項1記載の進入禁止空間分析プログラム。
In addition to the computer,
When the device is movable, a process for creating a trajectory shape indicating a space that can be reached by moving the device based on movement information indicating movement content is performed.
2. The entry prohibition space analysis program according to claim 1, wherein when the entry prohibition space is determined, a space including the locus shape is also set as the entry prohibition space.
機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、前記機器データに基づき、機器の可動部分が到達可能な干渉空間を判定する干渉空間判定手段と、
前記干渉空間と、前記干渉空間よりも下の空間とを含む進入禁止空間を判定する進入禁止空間判定手段と、
前記進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する進入禁止空間データ格納手段と、
を有することを特徴とする進入禁止空間分析装置。
Interference space determination means for referring to device data storage means in which device data indicating the structure of the device is stored in advance, and determining an interference space that the movable part of the device can reach based on the device data;
An entry prohibition space determination means for determining an entry prohibition space including the interference space and a space below the interference space;
Entry prohibition space data storage means for storing entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means;
An entry-prohibited space analyzing apparatus characterized by comprising:
コンピュータが、
機器の構造を示す機器データが予め格納された機器データ記憶手段を参照し、前記機器データに基づき、機器の可動部分が到達可能な干渉空間を判定し、
前記干渉空間と、前記干渉空間よりも下の空間とを含む進入禁止空間を判定し、
前記進入禁止空間の位置および形状を示す進入禁止空間データを、進入禁止空間データ記憶手段に格納する、
ことを特徴とする進入禁止空間分析方法。
Computer
With reference to device data storage means in which device data indicating the structure of the device is stored in advance, based on the device data, determine the interference space that the movable part of the device can reach,
Determining an entry prohibition space including the interference space and a space below the interference space;
Storing entry prohibition space data indicating the position and shape of the entry prohibition space in the entry prohibition space data storage means;
An entry prohibition space analysis method characterized by that.
JP2009070000A 2009-03-23 2009-03-23 No entry space analysis program, no entry space analysis device, and no entry space analysis method Active JP5381208B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009070000A JP5381208B2 (en) 2009-03-23 2009-03-23 No entry space analysis program, no entry space analysis device, and no entry space analysis method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009070000A JP5381208B2 (en) 2009-03-23 2009-03-23 No entry space analysis program, no entry space analysis device, and no entry space analysis method

Publications (2)

Publication Number Publication Date
JP2010224765A true JP2010224765A (en) 2010-10-07
JP5381208B2 JP5381208B2 (en) 2014-01-08

Family

ID=43041898

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009070000A Active JP5381208B2 (en) 2009-03-23 2009-03-23 No entry space analysis program, no entry space analysis device, and no entry space analysis method

Country Status (1)

Country Link
JP (1) JP5381208B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013129018A (en) * 2011-12-21 2013-07-04 Kawasaki Heavy Ind Ltd Method and device for regulating operation of robot
WO2017056745A1 (en) * 2015-10-02 2017-04-06 株式会社ミスミ Design assistance system, design assistance program, and design assistance method
JP2017177283A (en) * 2016-03-30 2017-10-05 セイコーエプソン株式会社 Robot control device, robot, and simulation device
JP2019096036A (en) * 2017-11-22 2019-06-20 株式会社日立プラントコンストラクション Structure removal simulation
WO2023037456A1 (en) * 2021-09-08 2023-03-16 ファナック株式会社 Simulation device

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5622795B2 (en) * 1974-10-01 1981-05-27
JPS61260306A (en) * 1985-05-15 1986-11-18 Hitachi Ltd Prevention system against mutual interference between robots
JPS6488809A (en) * 1987-09-30 1989-04-03 Mitsubishi Electric Corp Running type robot device
JPH0615585A (en) * 1992-07-01 1994-01-25 Fanuc Ltd Travel device for robot
JP2001265840A (en) * 2000-03-16 2001-09-28 Babcock Hitachi Kk Device and method for preventing installation accident by three-dimensional cad
JP2005081445A (en) * 2003-09-04 2005-03-31 Fanuc Ltd Interference region confirmation device of robot
JP2007164417A (en) * 2005-12-13 2007-06-28 Fanuc Ltd Interlock automatic setting device and automatic setting method between a plurality of robots
JP2008213056A (en) * 2007-03-01 2008-09-18 Yaskawa Electric Corp Robot system
JP2008234622A (en) * 2007-02-19 2008-10-02 Fujitsu Ltd Locus interference inspection program, method, and apparatus

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5622795B2 (en) * 1974-10-01 1981-05-27
JPS61260306A (en) * 1985-05-15 1986-11-18 Hitachi Ltd Prevention system against mutual interference between robots
JPS6488809A (en) * 1987-09-30 1989-04-03 Mitsubishi Electric Corp Running type robot device
JPH0615585A (en) * 1992-07-01 1994-01-25 Fanuc Ltd Travel device for robot
JP2001265840A (en) * 2000-03-16 2001-09-28 Babcock Hitachi Kk Device and method for preventing installation accident by three-dimensional cad
JP2005081445A (en) * 2003-09-04 2005-03-31 Fanuc Ltd Interference region confirmation device of robot
JP2007164417A (en) * 2005-12-13 2007-06-28 Fanuc Ltd Interlock automatic setting device and automatic setting method between a plurality of robots
JP2008234622A (en) * 2007-02-19 2008-10-02 Fujitsu Ltd Locus interference inspection program, method, and apparatus
JP2008213056A (en) * 2007-03-01 2008-09-18 Yaskawa Electric Corp Robot system

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013129018A (en) * 2011-12-21 2013-07-04 Kawasaki Heavy Ind Ltd Method and device for regulating operation of robot
WO2017056745A1 (en) * 2015-10-02 2017-04-06 株式会社ミスミ Design assistance system, design assistance program, and design assistance method
US11361115B2 (en) 2015-10-02 2022-06-14 Misumi Corporation Design assistance system, design assistance program, and design assistance method
JP2017177283A (en) * 2016-03-30 2017-10-05 セイコーエプソン株式会社 Robot control device, robot, and simulation device
JP2019096036A (en) * 2017-11-22 2019-06-20 株式会社日立プラントコンストラクション Structure removal simulation
WO2023037456A1 (en) * 2021-09-08 2023-03-16 ファナック株式会社 Simulation device

Also Published As

Publication number Publication date
JP5381208B2 (en) 2014-01-08

Similar Documents

Publication Publication Date Title
JP5381208B2 (en) No entry space analysis program, no entry space analysis device, and no entry space analysis method
US20060184275A1 (en) Robot simulation device, and robot simulation program
US11511415B2 (en) System and method for robotic bin picking
JP5806385B2 (en) System and method for manipulation of objects
Kayhani et al. Heavy mobile crane lift path planning in congested modular industrial plants using a robotics approach
JP4176741B2 (en) Destination information setting apparatus and method, program, and recording medium
Kokkas et al. An Augmented Reality approach to factory layout design embedding operation simulation
JPH0467214B2 (en)
EP0957452A2 (en) Apparatus and method for checking interference of objects in computer
KR101471852B1 (en) Smart Device, Apparatus for Providing Robot Information, Method for Generating Trajectory of Robot, and Method for Teaching Work of Robot
US20140118358A1 (en) Computer system and assembly animation generation method
JP2014178794A (en) Carrying-in route planning system
WO2021100268A1 (en) Trajectory plan generation device, trajectory plan generation method, and trajectory plan generation program
JP2006302035A (en) Image processing method and image processing apparatus
JPH0765204A (en) Device and method for shape display
Johnson et al. The use of the voxmap pointshell method of collision detection in virtual assembly methods planning
Zhong et al. A methodology for solid modelling in a virtual reality environment
JP3942028B2 (en) Cursor control device, cursor control program
JP2016132538A (en) Carrying-in and installation work plan support device and carrying-in and installation work plan support method
CN116829314A (en) Generating a robot control plan
JP6867070B1 (en) Measuring device, measuring program and measuring method
JP6867071B1 (en) Measuring device, measuring program and measuring method
WO2023153469A1 (en) Articulated robot path generation device, articulated robot path generation method, and articulated robot path generation program
JPH08278996A (en) Screen display method for layout of interior of building
JP6500555B2 (en) Interference determination method, interference determination device, and computer program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20111107

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20121030

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20121113

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20130423

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130722

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20130731

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130916

R150 Certificate of patent or registration of utility model

Ref document number: 5381208

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150