Source: https://patents.google.com/patent/JP5855469B2/en
Timestamp: 2020-01-24 11:39:23
Document Index: 274476123

Matched Legal Cases: ['art, 102', 'art, 103', 'art, 104', 'art, 105', 'art, 111', 'art, 112', 'art, 113', 'art, 114', 'art, 121']

JP5855469B2 - Carry-in route planning system - Google Patents
Carry-in route planning system Download PDF
JP5855469B2
JP5855469B2 JP2012006155A JP2012006155A JP5855469B2 JP 5855469 B2 JP5855469 B2 JP 5855469B2 JP 2012006155 A JP2012006155 A JP 2012006155A JP 2012006155 A JP2012006155 A JP 2012006155A JP 5855469 B2 JP5855469 B2 JP 5855469B2
JP2012006155A
JP2013145497A (en
隆宏 中野
2012-01-16 Application filed by 株式会社日立製作所 filed Critical 株式会社日立製作所
2012-01-16 Priority to JP2012006155A priority Critical patent/JP5855469B2/en
2013-07-25 Publication of JP2013145497A publication Critical patent/JP2013145497A/en
2016-02-09 Publication of JP5855469B2 publication Critical patent/JP5855469B2/en
The present invention relates to a computer information processing technique, and more particularly to a technique for planning a route for carrying in / out a target object such as a part, material, or equipment from a space / structure such as a building.
For example, in construction or preventive maintenance of a plant or the like, operations such as carrying out old parts, carrying in new parts, and installing (installing) at predetermined positions are performed. At that time, there may be a lot of interference (contact etc.) between the object to be carried in and out, such as parts, and the space / structure (surrounding structure) of the object to be carried in and out. It can be a bottleneck on the top. In other words, it leads to problems such as high cost and increased period due to inefficiency of loading and unloading.
As a prior art example related to route planning, there is JP-A-06-168303 (Patent Document 1).
Patent Document 1 (“Installation Planning Support Method” etc.) has the following description. Provide support for an installation plan that makes it easy to study the optimal installation procedure for a large number of minimum installation units. Divide the layout figure information into the smallest installable units, link the work steps of the smallest installed unit, carry-in route, interference check, calculation of work time etc. and animation display, and optimize the installation procedure obtained from these examination results Etc. are output by a computer. The ability to efficiently create an installation procedure plan that allows installation work to be performed efficiently and safely.
Japanese Patent Laid-Open No. 06-168303
As a problem, we would like to reduce inefficiency due to interference between the object to be carried in / out and the structure, and realize efficiency reduction of work in / out, for example, cost reduction of plant construction, time reduction, preventive maintenance, and the like. Therefore, for example, in information processing systems such as CAD, CAM, CAE and other design systems and construction management systems, a route that allows the object to be carried in and out efficiently without interfering with surrounding structures is automatically set. I want to realize the function to plan (calculate).
In particular, in the function of the above route planning, up to the point of what route (object) and in what posture (angle) the object can be moved efficiently without interfering with surrounding structures I want to realize a function to calculate the optimal route automatically and at high speed.
In particular, in the past, it was highly dependent on human experience for work in and out, but the above-mentioned non-interference route and the like were displayed in an easy-to-understand manner on the screen (for example, the screen of a mobile terminal) that the user (for example, the worker) sees. To provide effective GUI (graphical user interface) to realize effective work support.
As described above, the main object of the present invention is to provide an efficient route and object in which the object and the surrounding structure do not interfere with each other in the technology for planning the route for carrying the object in and out of the space / structure by calculation. It is to provide a technology that can calculate the posture of an object automatically and at high speed. As a result, it is possible to realize cost reduction and time reduction in applications such as plant construction including work for carrying in / out the object to / from the space / structure.
A typical embodiment of the present invention is a system (carrying route planning system) that uses computer information processing to plan a route for carrying an object in and out of a space / structure by calculation. It has the structure shown.
(1) This system has a function (path planning function) that automatically calculates an efficient carry-in route (the same applies to a carry-out route) including the posture of the target object that does not interfere with the target object and surrounding structures. In addition, a calculation processing method corresponding to the function, an information processing apparatus configuring the system, a program for realizing the function, and the like are provided.
(2) This system has a function (GUI display function) that provides a GUI for easily handling the above function (path planning function) by a user operation. In particular, it provides a function of displaying a GUI screen including the route information on the screen of the user's mobile terminal. In addition, a calculation processing method, an information processing apparatus, a program, and the like corresponding to the function are provided.
(3) This system is configured, for example, as a system used when a user such as a designer designs / plans a carry-in / out route in advance. For this application, a relatively long calculation time is acceptable. This system includes a route planning function that performs an efficient route planning process based on design data (including three-dimensional shape data such as objects and structures), and information including the route of the plan result. A computing device having a GUI display function for displaying on a screen to a user;
(4) This system is, for example, a system that allows a user such as a person who performs a loading / unloading operation or a person who instructs it to check the loading / unloading route on the screen (target structure) or remotely. Composed. For this application, a relatively short calculation time is required. This system includes a computing device having a route planning function for performing an efficient route planning process based on design data (including three-dimensional shape data such as objects and structures), and a route of the plan result. And a portable terminal having a GUI display function for displaying information including “” on the screen to the user.
(5) This system has, for example, a configuration for executing a specific calculation process that realizes the calculation process of the route plan at high speed. Specifically, for example, the main computing device includes a CPU, GPGPU (general purpose calculation by GPU and its arithmetic unit), etc., and a large number of paths (candidates) and A process of calculating a number of postures (candidates) in parallel (including a process for checking an interference state between the object and the surrounding structure, for example) is performed.
The route planning function (route planning unit) uses, for example, parallel operations of GPGPU, and a plurality of routes (candidates) in which the object (the 3D shape) and the surrounding structure (the 3D shape) do not interfere with each other. Process to plan.
The path planning function (attitude planning unit) uses, for example, parallel operations of GPGPU, and for each of the plurality of paths (candidates), a plurality of attitudes in which the attitude of the target object and its surrounding structures do not interfere with each other The process of planning (candidate) is performed.
The route planning function (interference check unit) uses, for example, parallel processing of GPGPU to determine (check) the interference state between the target object and the surrounding structure for the route (candidate) including the posture (angle). I do.
The route planning function (optimum evaluation unit) uses, for example, a parallel operation of GPGPU, and for a route (candidate) including the posture (angle), an optimum route according to a predetermined target function (for example, a route whose posture does not vary as much as possible) The process of electing is performed.
According to a typical embodiment of the present invention, in a technique for planning a route for carrying an object in and out of a space / structure by calculation, an efficient route or object in which the object does not interfere with surrounding structures. Can be calculated automatically and at high speed. As a result, it is possible to realize cost reduction and time reduction in applications such as plant construction including work for carrying in / out the object to / from the space / structure.
It is a figure which shows the example of a whole structure of the system (a delivery route planning system is included) of one embodiment of this invention. It is a figure which shows the hardware structural example etc. of the system of FIG. It is a figure which shows the functional block structure of a main computer, a rough processing flow, processing data information, etc. It is a figure which shows the example of the 1st GUI display screen with a portable terminal. It is explanatory drawing shown about a whole path | route, a partial path | route, etc. FIG. It is explanatory drawing which shows the schematic flow of the operation | work and process in the case of planning using a spatial data acquisition apparatus. It is a figure which shows the structural example which speeds up a route planning process and a GUI screen display process by parallel processing with a main computer. It is a figure which shows the structural example which performs the parallel arithmetic processing using GPGPU with the main computer. It is a figure which shows the example of a processing flow in the method of performing a path | route plan process with single CPU using the main computer (when not provided with GPGPU). It is a figure which shows the example of a processing flow in the method of performing a path | route plan process using a parallel arithmetic process using a main computer (when provided with GPGPU). It is explanatory drawing which shows the example of the Voronoi space produced | generated by a route planning process. It is a figure which shows the 2nd GUI display screen example with a portable terminal. It is a figure which shows the example of the 3rd GUI display screen with a portable terminal. It is explanatory drawing shown about the example of the expression of the angle which prescribes | regulates the attitude | position of a target object. It is a figure which shows the example of the model for calculation produced by the model creation part for calculation. It is explanatory drawing which shows the example of a simulation of interference with the surrounding structure by the movement of a target object. (A)-(c) is explanatory drawing which shows the example of a state transition corresponding to the movement example of FIG. (A)-(d) is explanatory drawing in the XY plane corresponding to the example of FIG. It is explanatory drawing which shows the example of the interference state corresponding to the example of FIGS.
DESCRIPTION OF EMBODIMENTS Hereinafter, embodiments of the present invention (carrying route planning system and the like) will be described in detail with reference to the drawings. Note that components having the same function are denoted by the same reference symbols throughout the drawings for describing the embodiment, and the repetitive description thereof will be omitted. This system has the system configuration as shown in FIGS. 1 and 2, performs the processing as shown in FIGS. 3, 9, and 10, and provides GUI screens as shown in FIGS.
As a system of this embodiment, as a configuration in which a technology such as CAD / CAM is combined with a technology such as GPGPU (General-purpose computing on graphics processing units), the target object and its surrounding structures do not interfere efficiently. It has a function to automatically and rapidly plan (calculate) a route for carrying in and out. For this reason, in particular, as shown in FIG. 7, FIG. 8, and FIG. 10, the configuration is such that parallel arithmetic processing is performed using GPGPU.
FIG. 1 shows a configuration example of the system according to the present embodiment. The entire system includes a plan object (carrying in / out object) including a structure 30, an object 31 and a carry-in device 32, a carry-in route planning system 1, an actual operation system (carry-in control device) 40, and a design device 50 ( CAD / CAM system) and a spatial data acquisition device 60. The carry-in route planning system 1 has a configuration in which the main computing device 10 and the mobile terminal 20 are connected via a communication network. The main computing device 10 has a path planning function (server) and a parallel calculation function. The portable terminal 20 has a route planning function (client) and a GUI display function.
In addition, as a user (person) of this system, UA: carrying-in worker (person who carries out carrying-in / out work), UB: carrying-in work instructor (person instructing carrying-in / out work), UC: route planner / remote An instructor (a person who plans a route for loading / unloading / a person who remotely instructs a plan or work). For example, the UA is near the object 31 in the object space (30). For example, the UB is in the target space (30) together with the UA and instructs the UA, or remotely instructs the UA from outside. The UB operates the actual operation system 40, for example. For example, the UC may operate / set the main computing device 10 of this system, and may instruct the UB or the like from a remote location.
The structure 30 is a space, a building, or the like to which the object 31 is carried in and out. For example, a plant to be constructed. The shape of the surrounding structure (30) with respect to the object 31 can be changed by moving a part (installed object or the like). The target 31 includes various parts, materials, equipment, and the like that are to be carried in and out. For example, piping. The carry-in device 32 is a device for carrying in / out (moving) the object 31 in the structure 30. For example, there are devices such as a crane, a hoist, and a chain that suspends the object 31. For example, the carry-in device 32 moves the object 31 or changes the posture (angle) of the object 31 by operating the rotation of the crane or the expansion and contraction of the chain. In addition, when a person carries the target object 31 directly, there is no carrying-in apparatus 32.
Since not only the object 31 but also the carry-in device 32 may interfere with the surrounding structure (30), when the carry-in device 32 is used, the carry-in device together with the object 31 is used when calculating the route in this system. 32 is set as an integrated object / model ("work" described later) and calculated.
The actual operation system 40 controls the operation of loading and unloading the object 31 by controlling the operation of the loading device 32 in the structure 30. The details of the actual operation system 40 depend on the form of the carry-in device 32 and the like, and the real operation system 40 and the carry-in device 32 may be integrated. For example, the actual operation system 40 controls the movement of the loading device 32 in the front-rear and left-right directions and the operation of the object 31 by the loading device 32. For example, the control information (C1) corresponding to the planned route is given from the carry-in route planning system 1 to the actual operation system 40, and the operation control information (C2) is sent from the real operation system 40 to the carry-in device 32 according to the control information (C1). By controlling the operation of the feeding device 32, the movement of the object 31 according to the planned route is realized.
In the present embodiment, the main computing device 10 is a computing device (computer) such as a server equipped with GPGPU (FIG. 2) and the like, and is responsible for the main computation processing and control processing of this system. The main computing device 10 is configured as one server in the configuration of FIG. 1, but may be configured by concatenating a plurality of servers, or access to a cloud computing service (such as a private cloud) on a communication network instead of GPGPU. Thus, the same function may be realized.
The mobile terminal 20 is a device such as a tablet PC that is carried by a user (UA, UB, etc.), communicates with the main computing device 10 and uses the functions (calculation results, data information, etc.) of the main computing device 10, The GUI information is displayed on the screen of the mobile terminal 20.
The design apparatus 50 is, for example, a known CAD / CAM system or the like, and 3D CAD data (object data D1) of the object 31 or 3D CAD data (object data D1) of the structure 30 by a designer (for example, the same person as UC). Structure data D2), 3D CAD data (loading device data D3) of the loading device 32, and the like are created / acquired. D2 is data of a two-dimensional or three-dimensional model such as a design drawing of a building to be constructed. D1 is data of a two-dimensional or three-dimensional model such as a part for forming a building, for example. D3 is data of a two-dimensional or three-dimensional model of the carry-in device 32, for example. Further, D3 may include not only model data of the loading device 32 but also data for controlling the operation of the loading device 32, for example.
The spatial data acquisition device 60 is configured by a laser scanner or the like, and performs a process of automatically acquiring the spatial data D4 from the structure (space) 30 (for example, a known technique can be applied). The spatial data acquisition device 60 may be mounted as an independent device, for example, or may be mounted in the carry-in device 32 or the mobile terminal 20. Spatial data D4 automatically obtained by the spatial data acquisition device 60 is taken into the system 1 (the main computing device 10 or the portable terminal 20). When the spatial data acquisition device 60 is present, the spatial data D4 can be acquired from the structure 30 in real time, which is effective.
The route planning function (server function) of the main computing device 10 is a parallel calculation function using GPGPU (FIG. 2) in response to a user instruction input or a request from the route planning function (client function) of the mobile terminal 20. The calculation process etc. which plan the route of carrying in / out are performed while using the. When receiving an access / request from the route planning function (client function), the route planning function (server function) responds with plan processing result information (such as GUI display data including route information). The parallel calculation function of the main computing device 10 performs parallel calculation processing for a large number of paths and postures by the GPGPU (FIG. 2) based on an instruction from the CPU (FIG. 8 described later).
The GUI display function of the portable terminal 20 displays a GUI screen to the user, accepts user instruction input, etc., and accesses the route planning function (server function) of the main computing device 10 by the route planning function (client function). A request is made, the response information is received, and the GUI information is displayed on the screen of the portable terminal 20 by the GUI display function.
FIG. 2 shows a configuration example of the hardware of this system. Reference numeral 90 denotes a communication network (wireless network, Internet, etc.). The design device 50 includes a design SW (software) 51 and processes each piece of data information (D1 to D3) stored in the design DB (database) 55. The design function is realized by the program processing of the design SW 51. Each data (D1 to D3) is in a format corresponding to the design SW 51, for example, an STL (Standard Triangulated Language) file. The system (the main computing device 10 or the portable terminal 20) acquires each data (D1 to D3) of the design device 50.
Basically, as the input data for the plan calculation, static object data D1, structure data D2, and carry-in device data D3 including a 3D shape model designed in advance by CAD (design SW51) are used. In addition, when the spatial data D4 can be acquired by the spatial data acquisition device 60, D4 is used. Only one of the data of D2 or D4 may be used.
The spatial data acquisition device 60 includes an imaging unit 61, an analysis unit 62, and the like. For example, the spatial data acquisition device 60 uses the analysis unit 62 to perform image analysis processing (edge extraction) based on data obtained by imaging a space in the structure 30 (for example, in front of the object 31) by the imaging unit 61 (laser scan or the like). Etc.) to extract data information (point cloud) such as characteristic points (points) and lines (lines), and to construct a three-dimensional model of surrounding structures (for example, floors, walls, ceilings, etc.) Data D4 is obtained (FIG. 6 described later). Note that the configuration of the three-dimensional model may be performed by the main computer 10 or the like.
The main computing device 10 (GPGPU-installed server) includes a CPU 211, a RAM 212 (main memory), a ROM 213, an input device 214, an output device 215, a communication I / F device 216, a storage device 217, a GPGPU 70 (parallel computing unit), and a display calculation. It comprises a device 81 and a bus. The CPU 211 implements a path planning function (server function) and the like by loading a program (program of the present embodiment) and data from the ROM 213 and the storage device 217 to the RAM 212 and executing processing. The input device 214 and the output device 215 include a keyboard, a display, and its input / output interface control processing unit. The communication I / F device 216 performs interface processing for the communication network 90. The storage device 217 is a secondary storage device such as a disk or a card. The GPGPU 70 is configured by a GPGPU board or the like by a known technique. The display computing unit 81 is configured by a graphic board or the like. The display computing unit 81 may be omitted as an apparatus integrated with the GPGPU 70. In this case, the output of the GPGPU 70 may be properly used for screen display and route planning (reference data).
The portable terminal 20 includes a CPU 221, a RAM 222, a ROM 223, an input device 224, an output device 225, a communication I / F device 226, a storage device 227, a display computing unit 82, a bus, and the like. The CPU 221 implements a path planning function (client function) and the like by loading a program (program of the present embodiment) and data from the ROM 223 and the storage device 227 into the RAM 222 and executing the processing. The input device 224 and the output device 225 include a touch panel and its input / output interface control processing unit. The communication I / F device 226 performs interface processing for the communication network 90. The storage device 227 is a secondary storage device such as a disk or a card. The display computing unit 82 is configured by a graphic board or the like.
[Main computer]
FIG. 3 shows a functional block configuration of the main computing device 10, a schematic processing flow (detailed processing flow will be described later), processing data information, and the like. As a processing unit (program module or the like) constituting the route planning function (server function), a setting unit 101, a data input unit 102, a calculation model creation unit 103, and an interference check data creation unit 104 (path planning data creation unit) , A display data creation unit 105, a route planning unit 111, a posture planning unit 112, an interference check unit 113, an optimum evaluation unit 114, a data output unit 121, and the like.
The setting unit 101 provides a user with a GUI screen for setting operation, and on the screen, inputs instructions related to route planning (use of functions of this system), setting of calculation methods and thresholds, and various information A process of receiving input / setting and storing it as condition information (setting information) d0 is performed. For example, the setting unit 101 first specifies a target 31, a carry-in device 32, and a structure 30 as a condition to be input by the user in the course of route planning. Information such as power points may be received and stored as the condition information d0. Such information can be received not only at the beginning but also on the screen at any time. Alternatively, the set condition information d0 may be designated by the user or the set value may be updated.
The data input unit 102 acquires and inputs various data (D1 to D4) necessary for route planning from the outside, and stores them in the storage device 217 in the main computer 10 as corresponding data such as d1 to d3. I do.
The calculation model creation unit 103 uses the data (calculations) of the models such as the structure 30, the object 31, and the carry-in device 32 for calculating the route plan based on the data such as D1 to D4 (for example, 3D CAD data). Model data) is created and stored as data such as d1 to d3. If data such as D1 to D4 acquired from the outside can be used for calculation as they are, this processing can be omitted. As the model data for calculation, in order to reduce the amount of calculation, in particular, a space margin is taken around the actual complex-shaped object, and elements of a simpler shape (for example, a rectangular parallelepiped or a cylinder) A 3D model (object) using a combination or wire frame is created (FIG. 15 to be described later). The setting of the margin (size, use element, etc.) can be set by the setting unit 101, for example.
The interference check data creation unit 104 performs interference check (for route planning processing including interference check) by conversion processing based on the calculation model data (d1 to d3) at the time of route planning (calculation execution). ) Data d4. This data d4 is data of an object in a predetermined format related to the structure 30, the object 31, the carry-in device 32, etc., for example, polygon data / voxel data, etc. according to the parallel calculation method of the path plan. This data d4 is passed to the parallel computing unit (GPGPU 70), for example, at the time of route planning (in the interference check).
Hereinafter, objects such as the object 31 and the carry-in device 32 during calculation of the route plan are also referred to as “work”. The object 31 (work) being calculated includes the carry-in device 32.
The display data creation unit 105 creates GUI screen display data d5 through conversion processing based on the calculation model data (d1 to d3) at the time of route planning or GUI display. This data d5 is 2D or 3D data for the entire visualization including the object 31 and the structure 30, and Web screen configuration data. The data d5 is passed to the data output unit 121, the display computing unit 81, or the portable terminal 20 when a GUI display request is made.
In order to enable high-speed response by parallel processing of interference check (path planning) and GUI display processing, the GUI display data d5 and the interference check data d4 are set as different data and can be processed in parallel (described later). , FIG. 7 etc.).
The main route planning process (301) includes each process by the route planning unit 111, the posture planning unit 112, the interference check unit 113, the optimum evaluation unit 114, and the like. Any processing can be realized at high speed by parallel arithmetic processing using the GPGPU 70. Each processing unit performs calculation using the condition information d0, interference check data d4, and the like, and outputs the result as route information d6. Note that these processing units are appropriately integrated or separated according to a detailed processing flow (FIGS. 9 and 10) described later.
The route planning unit 111 plans a plurality of route candidates (however, the posture of the object 31 is not considered) passing between the two points in accordance with, for example, designation (condition information d0) of the start point and end point of the carry-in route. For example, a short distance such as a straight line connecting the start point and the end point is ideal, but when it comes into contact with (interfers with) a surrounding structure (30) such as a wall, a route is created so as to be appropriately detoured. The planned route candidate is stored as route information d6. Contact (interference) between the object 31 and the surrounding structure 30 is determined using the interference check unit 113. Here, in order to increase the speed, the shape (model) of the object 31 may be simplified with points, circles, or the like so as to plan a route.
The posture planning unit 112 plans a plurality of posture candidates related to the posture (angle defining the posture) of the object 31 moving on the route, for example, according to the route candidate by the route planning unit 111. Contact (interference) between the object 30 having an attitude corresponding to a position (point) on the route and the surrounding structure 30 is determined using the interference check unit 113. For example, if the posture (angle) of the object 31 is changed at a certain position and the posture of the object 31 and the surrounding structure (30) do not interfere with each other, it is determined as a candidate. . For example, in the case of interference, the posture (angle) is returned and another candidate is searched. The posture planning unit 112 plans a posture that is non-interfering as a candidate, and stores it as posture information in the route information d6 together with position information on the route.
The interference checking unit 113 checks (determines) the interference state (presence / absence of interference) between the object 31 (work) of a certain posture on the route and the surrounding structure (30) with respect to the route candidate / posture candidate. Information indicating an interference state (interference presence / absence) is calculated. This information is, for example, binary information (interference flag) indicating the presence or absence of interference.
By the above processing (111, 112, 113), a non-interfering path and its posture are designed as candidates between the object 31 (work) and the surrounding structure (30), and the path information d6 (position / attitude of the object 31). Route information including information). For example, as the route information d6, the ID of the object 31, the ID of the route, the start point, the end point, and the position (coordinates) of the point that passes along the way, the position at which the posture (angle) is changed, and the angle change amount, etc. Contains information.
The optimum evaluation unit 114 evaluates a candidate for a non-interfering route (including posture) in the route information d6 obtained as a result of the above processing based on a predetermined evaluation function and setting information. Including) is selected and stored as route information d6. For example, the evaluation function is a function in which the evaluation value increases as the change in posture on the route decreases. Since the smaller the change in the posture on the route, the more advantageous in actual work, the higher the evaluation value. Of course, the change in posture (angle) is calculated continuously and can be performed.
For example, the object 31 is moved on the route by a predetermined length while maintaining a non-interfering posture from a certain position on the route (for example, a carry-in end point taking a specific posture). If the non-interference state continues, the evaluation value is increased accordingly, and if the posture changes to avoid interference, the evaluation value is decreased accordingly.
The data output unit 121 uses the route information d6 including the route candidate and the optimum route obtained as a result of the above processing, and the GUI display data d5 created in advance, and the 2D / GUI display data d5 ′ for displaying 3D information on the screen is created. Then, the created GUI display data d5 'is output (transmitted) from the main computing device 10 to the portable terminal 20. The mobile terminal 20 receives, acquires, and stores the GUI display data d5 ′, and displays the GUI information on the screen of the mobile terminal 20 using the display computing unit 82 and the output device 225 by processing of the GUI display function. To do. As a result, the user UA and the like can perform work while confirming the optimum route on the screen.
The route information d6 has the following output (data information), for example. The path is discretized at a certain interval and has {X coordinate, Y coordinate, Z coordinate}, {rotation around X axis, rotation around Y axis, rotation around Z axis}, and interference flag at each point. The interference flag is 1 when there is interference between the object and the surrounding structure at the point (coordinates), and 0 when there is no interference. When there is interference, the member number of the surrounding structure that interferes may be indicated instead of 1.
[GUI screen example (1)]
FIG. 4 shows a GUI display screen example (G1) on the mobile terminal 20. It is an example which displays import route information. On this screen (G1), the route (for example, the optimum route) obtained as a result of the route planning process is displayed in two dimensions (2D) or three dimensions (3D) (2D / 3D switching operation or the like is also possible). Although the carry-in route in FIG. 4 is a curve, a broken line or the like is appropriately displayed (FIG. 12 described later). Moreover, you may display the space of the structure 30 by 2D / 3D corresponding to a background (after-mentioned FIG. 12). In the carry-in route, information such as a start point (carry-in start point), an end point (carry-in start point), and a current point where the target object 31 (its center of gravity) is located is displayed. In addition, a 2D / 3D object or a mark imitating the object 31 (for example, piping) or the carry-in device 32 is displayed. The operable angles (θ, φ) of the loading device 32 are indicated by arrows. Further, since it has a posture (angle) according to the position (path) of the object 31 on the route, various information including the information (for example, the yaw angle (θ) and the pitch angle (φ)) is shown on the right side in the figure. To display. The contents (GUI display data) such as the position and the route are updated and displayed on the screen as the object 31 moves (carrying in / out) in the virtual or actual work. As a route to be displayed, an entire route or a partial route can be selected (FIG. 5).
The carry-in start point and carry-in end point in the carry-in route are points (positions) designated by the user (can be changed as appropriate). The posture of the object 31 at the carry-in starting point is arbitrary (free) according to user designation. The posture of the object 31 at the carry-in end point is arbitrary according to user designation, particularly in the case of installation (installation) or the like. The same applies to the carry-out route.
[Partial route]
FIG. 5 shows the entire route and the partial route. In this system, it is possible to set a partial route out of the entire route and perform a plan calculation process for each partial route. It is also possible to set partial routes by dividing the entire route by a user operation.
For example, the entire route K has a route between the carry-in start point p1 and the carry-in end point (installation position) p5. Points p2 to p4 that are routed between p1 and p5 are set as appropriate, and become partial paths k1 to k4, respectively. For example, FIG. 5 shows a state in which the object 31 has been moved halfway along the partial path k2 (between p2 and p3) (the star is the current point). It is possible to calculate by setting k2 (p2-p3) as a temporary whole route (start point-end point). The overall route K can be planned by comprehensive planning for each partial route.
In addition, as an example of the calculation method, the carry-in end point p5 and its posture are specified in a fixed manner, and the path and posture are calculated (searched) from the carry-in end point p5 to the carry-in start point p1.
The same is possible in the case of unloading. For example, it is possible to calculate (plan) in the same manner with p1 as the unloading end point and p5 as the unloading start point (the posture is fixed).
Depending on the application and situation, the start point and end point may not be clearly determined. In that case, a partial route is set and calculated from time to time. For example, in the case of debris removal work, the front space data D4 is obtained from the start point p1, the corresponding structure data d2 is obtained, and the space state is displayed on the screen of the portable terminal 20. In the display space, the position where the object 31 can move a little ahead is set as a temporary end point, for example, p2, and the partial path k1 (p1-p2) is calculated. As a result, the object 31 is moved from p1 to p2. Next, p2 is used as a temporary start point, the next temporary end point p3 is specified, and calculation / movement on the partial path k2 is performed in the same manner. By such repetition, the inside of the structure 30 can be gradually advanced. As appropriate, a space in which the object 31 can move is secured by removing rubble and the like, and can be designated as a start point and an end point. Even when a plant or the like is under construction, there are cases where surrounding structures (materials, etc.) may be moved, so that a space in which the object 31 can move is secured by appropriate movement and can be designated as a start point / end point. . That is, the route can be flexibly changed (supported) according to the situation and the user's judgment.
[Spatial data acquisition]
FIG. 6 shows a schematic flow of operations and processes in the case (plan) where the spatial data D4 is automatically acquired and the planning is performed (example) corresponding to the system of FIG.
In the target structure 30, the spatial data acquisition device 60 is used by the user UA or the like to acquire the spatial data D4 in the structure 30 (by acquiring the point cloud and 3D modeling), and Transmit to the computing device 10. Reference numeral 601 denotes an example of the acquired spatial data D4 (a 3D wireframe model with points and lines).
For example, the mobile terminal 20 displays the space on the GUI screen according to the captured space data D4. The portable terminal 20 transmits the spatial data D4 to the main computing device 10 and instructs a route plan.
The main computing device 10 uses GPGPU 70 (parallel operation) for calculation processing (ultra-high-speed automatic route planning processing) for planning a route suitable for a space such as 601 using the structure data d2 corresponding to the space data D4. The GUI display information (d5 ′) created based on the route information (d6) obtained as a result is transmitted to the mobile terminal 20.
The portable terminal 20 displays a GUI screen including route information and the like using the GUI display information (d5 ′) obtained from the main computing device 10. For example, the user UA, UB, etc. can check the route while looking at the screen of the mobile terminal 20.
Also, control information (C1) for controlling the operation of the carry-in device 32 corresponding to the planned route is transmitted from the main computing device 10 or the portable terminal 20 to the real operation system 40, and the operation is performed from the real operation system 40 to the carry-in device 32. The control information (C2) is transmitted to control the operation of the carry-in device 32. As a result, the object 31 is moved within the structure 30.
[Parallel processing of plan and display]
FIG. 7 shows a configuration example in which the route planning process (including the interference check process) and the GUI screen display process are accelerated by parallel processing in this system. In the main computing device 10, in the path planning, the parallel processing using the GPGPU 70 is used to speed up the planning processing including the interference check and the like, and the GUI screen display processing using the display computing unit 81/82 is performed. This method achieves both high speed. Processing is performed in parallel (simultaneously in parallel) using GPGPU 70 (interference check computing unit) and display computing unit 81 (or the display computing function of GPGPU 70), which are two types of computing units provided in the main computing device 10.
The 3D CAD data (D1) of the object 31, the 3D CAD data (D2) of the structure 30 and the like are input into the main computer 10 in the form of an STL file (d1 to d3) (102 and the like). Based on the input data (d1 to d3), data for each calculation model (load development polygon data, etc.) is generated and stored in the area of the main memory (RAM 212, etc.) in the main computing device 10 (103, etc.). ).
At the time of route planning (for example, when a user instruction is input), based on the data in the main memory, the interference check data d4 (polygon / voxel data etc. of the work and surrounding structures) and the GUI display data d5 (structure) 30 (the polygon data for visualization of the entire 30) and the like (104, 105, etc.).
During GUI display, the GUI display data d5 (d5 ') is output to the display computing unit 81, the portable terminal 20, etc. (121 and the like). In the route planning process including the interference check, the interference check data d4 is output to the GPGPU 70 (parallel computing unit) (111 to 114 and the like). The processing result (route information d6 and the like) in the GPGPU 70 is returned to the main memory area and reflected in the GUI display data d5 '.
FIG. 8 shows a configuration example corresponding to FIG. 7 in which the main computing device 10 performs parallel arithmetic processing using the GPGPU 70. For example, in the route planning process (301), a parallel calculation process is performed using a large number of calculation cores of the GPGPU 70 for the interference check process for a plurality of route candidates and a plurality of posture candidates. The CPU 211 has, for example, four arithmetic cores. The GPGPU 70 has, for example, 512 GPU operation cores.
As processing in the CPU 211, the CPU 211 requests (instructs) the parallel calculation processing to the GPGPU 70 at the time of route planning. At that time, necessary data information (interference check data d4 and the like) is transferred to the GPGPU 70. The GPGPU 70 divides and allocates processing using a plurality of cores in accordance with a processing request from the CPU 211. For example, an interference check process related to one or more route candidates and posture candidates is assigned by one core, and processes by the plurality of cores are executed in parallel. For example, interference check processing is performed for several hundred routes / postures. Then, the parallel operation processing result (for example, route information d6 including the route, posture, presence / absence of interference) is output and integrated into the main memory (RAM 212, etc.) of the CPU 211. The CPU 211 processes the obtained information on the main memory.
In the present embodiment, the main computing device 10 includes the GPGPU 70, and speeding up by parallel arithmetic processing as shown in FIGS. 7 and 8 is possible. A processing flow corresponding to this configuration is shown in FIG.
Further, when the main computer 10 does not include the GPGPU 70 (when not used), a sequential calculation process by a single CPU or the like may be performed. A processing flow corresponding to this configuration is shown in FIG. In this case, the processing time is longer than in the case of parallel computation, but it is correspondingly useful in applications where real-time response performance is not required.
[Processing flow (1)]
FIG. 9 shows an example of a processing flow (an example of an algorithm) in a method of performing a route plan calculation process (301) using the main computing device 10 in the case of a single CPU. S1 etc. indicate processing steps. In the following processing, the above-described calculation model data (d1 to d3), interference check data d4, route information d6, and the like are used as appropriate. Each processing entity is the main computer 10 (path planning function).
(S1) First, as described above, conditions such as a start point and an end point necessary for calculation are designated (set) (condition information d0).
(S2) Corresponding to the start point and end point of S1, a carry-in route to be calculated (details are not yet determined at this point) is set and discretized (divided into calculation units). Further, for example, the route planning unit 111 plans one route candidate and selects it as a processing target route. For example, the calculation is started from the start point side (note that the reverse direction (calculation starts from the end point side is also possible)).
(S3) A workpiece (object of the calculation target 31 (including the carry-in device 32)) is moved by a specific length along the path (parallel movement). The workpiece position information is updated as appropriate. This specific length can be set by the user in the setting unit 101, for example.
(S4) When the position after the movement is the end point (Y), the process ends, and the route becomes a route candidate to be presented to the user. If it is not the end point (N), the process proceeds to step 901 (S5).
(S5) In 901, an interference check process related to a route candidate is mainly performed using the route planning unit 111 and the interference check unit 113, and a non-interference route is derived. In S5, data information (interference) including the current position / attitude (911) of the workpiece, the workpiece model (912), and the surrounding structure model (913) based on the data of d1 to d3 and d6. Using the check data d4), the interference check unit 113 performs a calculation process for determining an interference state (presence / absence of interference) between the workpiece (its position / posture) and the surrounding structure.
(S6) As a result of S5, information (interference state information 914) indicating the interference state (interference presence / absence) is calculated and stored (part of the route information d6). Note that the processes of S5 and S6 may be integrated. Then, the process proceeds to S7.
(S7) In S7, when there is interference in the path / posture / workpiece to be calculated from the interference state information 914 (Y), the process proceeds to step 902 (S8). If there is no interference (N), the process returns to S3 and repeats in the same manner.
(S8) In the processing of 902, interference check processing regarding posture candidates is mainly performed using the posture planning unit 112 and the interference check unit 113, and a non-interference posture is derived. In S8, the posture planning unit 112 uses the data information (interference check data d4) including the current position / posture (921) of the workpiece based on the data of d1 to d3 and d6, to determine the current workpiece on the route. One or more pose candidates at the position are planned and selected as processing targets.
(S9) Then, in S9, the workpiece position / posture (921) as a result of S8, the workpiece model (922) (similar to 912), the workpiece surrounding structure model (923) (same as 913), and Using the data information including the data (interference check data d4), the interference check unit 113 performs an arithmetic process for determining the interference state (presence or absence of interference) between the workpiece in the position and posture and the surrounding structure.
(S10) As a result of S9, a posture (space) that is in a non-interfering state is calculated, and the non-interfering posture information (924) is stored (part of d6). Note that the processes of S9 and S10 may be integrated. Then, the process proceeds to S11.
(S11) In S11, when there is a non-interfering posture in the calculation target route / posture / work (Y) from the non-interfering posture information (924) in S10, the process proceeds to S12. If there is no non-interfering posture (N), the process proceeds to S13.
(S12) In S12, the posture planning unit 112 selects one of the non-interfering posture candidates, and calculates another posture candidate by changing the current posture (angle) of the workpiece. For example, the posture angle (θ, φ) to be changed is determined and rotated by a predetermined angle. The changed posture information is stored (part of d6). And it returns to S3 and repeats similarly.
(S13) In S13, since there is no non-interfering posture, the current position of the work is shifted by a specific length on the path (parallel movement) as in S3, and the process returns to 902 (S8) and is repeated in the same manner.
As described above, a path with a posture that does not interfere with surrounding structures can be obtained while trying to translate the position of the workpiece (object 31) and change the posture (angle).
[Processing flow (2)]
FIG. 10 shows an example of a processing flow (an example of an algorithm) in a method (corresponding to the configuration example of FIGS. 7 and 8) for performing a route plan calculation process (301) using the parallel arithmetic processing of the GPGPU 70 in the main computing device 10. The same is shown. This processing flow includes 1001, 1002, and the like as processing steps for performing parallel operations using the GPGPU 70. In the processing of 1001, processing in units of paths is assigned to a plurality of cores (FIG. 8) of the GPGPU 70, and calculation is performed for a plurality of paths (basic paths that do not consider the posture). In the processing of 1002, for the basic route (candidate) obtained in 1001, processing in units of routes / attitudes is assigned to a plurality of cores (FIG. 8) of the GPGPU 70, and a plurality of orientations are calculated. In 1002, calculation is performed in consideration of the shape and posture of an object, and a path of a posture that does not interfere is calculated.
(S21) The main calculation device 10 generates calculation model data by the calculation model data creation unit 103 based on various data (d1 to d3) based on the input data (D1 to D4), and the main memory (RAM 212). Etc.) as polygon data for load development (FIG. 7).
(S22) As described above, conditions such as a start point and an end point necessary for calculation are set.
(S23) At the time of route planning (for example, by user instruction input), the interference check data creation unit 104 generates interference check data d4 by conversion processing or the like based on the calculation model data in the main memory. And stored in the main memory (FIG. 7).
(S24) In parallel with S23, GUI display data d5 is generated in advance by the conversion processing or the like based on the calculation model data by the display data creation unit 105 and stored in the main memory (S24). FIG. 7).
(S25) In the process of 1001, using the interference check data d4, the route planning unit 111 generates a Voronoi space (FIG. 11) based on the structure data d3 around the designated start and end points. Then, while checking (determining) the interference state between the object 31 and the surrounding structure (30) by the interference check unit 113, a plurality of route candidates that will not interfere with each other are planned (extracted). In this process, the process for each path is performed by the parallel calculation process using the GPGPU 70 described above (FIG. 8). Thereby, route information d6 including a plurality of route candidates is obtained.
The processing content of 1 GPU core unit is, for example, a Voronoi diagram generation process when a cross section is taken in a horizontal plane of a certain height in the vertical axis direction.
(S26) In the process of 1002, using the route planning unit 112 and the interference check unit 113 using the route information d6 including the plurality of route candidates obtained in S25, the object at each route candidate (position in the middle). An attitude in which 31 and the surrounding structure (30) do not interfere is planned (calculated). In this process, the process for each posture of the position (point) on the path is performed by the parallel calculation process using the GPGPU 70 described above (FIG. 8). Thereby, route information d6 including a plurality of posture candidates is obtained.
In the interference check in each route in S26, a plurality of postures at a certain point (position) on the route are generated in advance, and each GPU core interferes with the target object and surrounding structures for each posture. Determine. And the combination of the attitude | position which does not interfere in a certain point on a path | route is displayed in an attitude | position area.
The processing content of 1 GPU core unit is, for example, interference check processing (with an object and surrounding structures) in a certain posture at a point on a certain route.
(S27) With respect to the route / posture information in the route information d6 as a result of the above processing, the optimum evaluation unit 114 performs an evaluation process using a target function to determine an optimum route (for example, a route whose posture does not vary as much as possible). In this process, a parallel calculation process using the GPGPU 70 may be similarly used.
(S28) The GUI display data d5 ′ reflecting the processing result including the route information d6 is created using the display data creation unit 105, and the GUI display data d5 ′ is carried using the data output unit 121. Output (transmit) to the terminal 20.
(S29) In the portable terminal 20, the GUI information is displayed on the screen of the portable terminal 20 by using the GUI display data d5 ', the display calculator 82, the output device 225, and the like.
For example, when the data d5 'is output on the screen of the main computing device 10, the GUI information is displayed on the screen using the display computing unit 81 (or GPGPU 70), the output device 215, or the like. Also, in the output processing step such as S29, when there are a plurality of routes (candidates) based on the calculation result of this system, information is displayed with these as candidates, and one of them is arbitrarily selected by user operation. So that it can be used. For example, when the user determines that a certain route is inappropriate, the user can select another route.
[Route planning (Voronoi space)]
FIG. 11 shows an example of the Voronoi space (potential field corresponding to the distance between the object 31 and the surrounding structure (30)) generated in the route planning process of S25. Reference numeral 1100 denotes an example of a point (unit for calculation, coordinates) corresponding to the current position of the workpiece (object 31). Reference numeral 1101 denotes a non-interference area, and points included in this area have no interference. Reference numeral 1102 denotes an interference area, and a point included in this area is interference. In this case, the interference state is determined based on the binary value of the presence / absence of interference.
In S25, a Voronoi space is generated by parallel computation using the GPGPU 70. As this generation method, 2.5-dimensional calculation is performed for the purpose of speeding up. In other words, a number of planes cut in a horizontal plane are created in the vertical direction, and a Voronoi diagram is calculated for each GPU core in each plane. Finally, a 2.5-dimensional pseudo space is generated by geometrically adding Voronoi diagrams of a plurality of horizontal planes in the vertical direction.
[GUI screen example (2)]
FIG. 12 shows a second GUI display screen example (G2) on the mobile terminal 20. This is an example in which the object 31 and surrounding structures (spaces) are displayed in two dimensions (2D) and their interference states are displayed. In this screen (G2), based on the display data d5 ′ and the route information d6 of the route plan result, the structure 30 is displayed in a 2D XY plane (such as a sketch of a bird's-eye view of the building floor) like g1, and g2 The carry-in route (entire route or partial route) is displayed as follows. For example, a solid-line arrow portion (for example, red display) of g2 is a partial route designated by the user, and a broken-line portion is another route portion of the entire route. A circle is a start point, an end point, or a point (temporary start point / end point) that passes along the way. For example, g3 is a marker for displaying / instructing the start point of the partial path, g4 is a marker for displaying / indicating the end point of the partial path, and g5 is a marker (for example, red display) for displaying the current position of the object 31. A point (temporary start point / end point) through which the route passes can be specified by the user.
As in g7, surrounding structures (such as walls and installation objects) are displayed using various figures such as rectangles and circles, colors, characters, and the like. Further, when there is a surrounding structure with a high possibility of interference on the route (or a surrounding structure that needs to be contacted in the carrying-in operation) as in g8, it may be highlighted with a specific color ( Interference determination processing result is used). The outer frame of g1 is a boundary (boundary box) of a calculation range including interference determination.
Further, g11 displays the value of the distance interval for interference determination (interference check), and can be variably set by the user. When the distance between the object 31 and the surrounding structure (30) is ensured to be equal to or greater than this value during the above-described interference check process, it is determined that there is no interference, and when the distance is less than this value, it is determined that there is interference. (C in FIG. 18C). In addition, for example, various related information (information on the object 31, the structure 30, the route, etc.), operation instruction buttons, and the like are displayed on the right side.
Moreover, g21 shows the part (attitude space information display part) which displays the interference state in a designated path | route (example: g2). In g21, the abscissa and ordinate indicate ranges (for example, θ: 0 to 360 degrees, φ: 0 to 180 degrees) that an angle that defines the posture of the object 31 can be taken. g22 indicates a marker for displaying / designating the posture (angle) of the object 31. Similar to the Voronoi space described above (FIG. 11), the presence / absence of interference in the posture is shown separately in two types of regions (for example, red: interference, blue: no interference). For example, the user can perform an operation so as not to interfere while viewing the information on this screen (G2).
[GUI screen example (3)]
FIG. 13 shows a third GUI display screen example (G3) on the mobile terminal 20. This is an example in which the object 31 and surrounding structures (spaces) are displayed in three dimensions (3D) and their interference states are displayed. On this screen (G3), the space of the structure 30 is displayed as a 3D image like g31 based on the display data d5 ′ of the route plan result and the route information d6. In addition, in the 3D image (g31), the object 31 is displayed as a 3D object including the state of the posture, as in g32. g32 is an example of the target 31 (FIG. 15 described later). g33 is an example of the surrounding structure (30) (FIG. 16 described later). The display content (direction) of g31 is, for example, a carry-in direction on the route, a front view seen from the user (mobile terminal 20), a front view seen from the carry-in device 32, and the like, and the direction is changed by a user operation. Can be displayed. The display content of g31 can be in the form of a still image or a moving image according to d5 ′ and d6. For example, when a position on the route is designated by a user operation, the posture state of the position can be displayed and confirmed as a still image on this screen (g31). For example, when two points on the route are specified, the moving state of the object 31 in the partial route between the two points can be displayed and confirmed with a moving image (animation) on this screen. Moreover, in g41, the interference state of the target object 31 can be displayed similarly to g21 (attitude space information display part) mentioned above.
[Attitude (angle)]
FIG. 14 shows an example of expression of an angle that defines the posture of the object 31. As shown in FIG. 14A, basically, X: first direction (forward direction of the object 31), Y: second direction (lateral direction of the object 31), Z: third direction (of the object 31) Vertical direction). As directions in which the operation of moving the object 31 by the carry-in device 32 is possible, for example, in the case of a crane device, there are θ: first posture angle (yaw angle) and φ: second posture angle (pitch angle). These (θ, φ) are taken as angles that define the posture of the object 31. θ corresponds to rotation around the Z axis, and φ corresponds to rotation around the Y axis.
FIG. 14B shows a coordinate system (Xw, Yw, Zw) after rotation of a predetermined angle (θ1) around the Z axis by the first posture angle (θ). This rotation corresponds to left and right swinging of the carry-in device 32 (for example, a crane).
FIG. 14C further shows a coordinate system (Xw, Yw, Zw) after rotation of a predetermined angle (φ1) around the Y axis by the second posture angle (φ). This rotation corresponds to swinging up and down of the loading device 32 (for example, a crane).
As described above, in this system (path planning function), the calculation is performed using the posture angle corresponding to the characteristic (anisotropy) of the operation (crane operation or the like) of the carry-in device 32. In the present embodiment, as described above, the X axis is fixed and the two angles (θ, φ) are variable. However, depending on the conditions of the carry-in device 32 and the like, a different posture angle (for example, a roll of rotation around the X axis). It is also possible to calculate using (angle).
This system manages the posture angle as described above in association with the position information as a part of the route information d6. For example, a certain posture (angle) is taken at a position corresponding to the distance from the starting point on the route and the absolute coordinates.
[Model for calculation]
FIG. 15 shows an example of a calculation model (3D object) created by the calculation model creation unit 103. For example, the object 31 may be a substantially L-shaped pipe. By simplifying the actual complex shape of the object 31 (for example, the shape of the 3D CAD model by D1) (not shown) by taking a spatial margin around it, the object as illustrated (calculation model) ) Create as 31a and save as d1 data. For example, a portion 1501 is a case where the element is converted into a rectangular element by taking a margin, and a portion 1502 is a case where the element is converted into an element having an octagonal cross section by taking the margin. The original shape is contained within each element region. Not limited to this, it can be converted into elements such as a cylinder or a sphere, or predetermined polygon / voxel data. For the carry-in device 32 and the structure 30 as well, a simple calculation model is created as appropriate. The degree of margin (degree of simplification) can be adjusted by user settings. For example, when the object 31 is a pipe that is bent in a complicated manner or has irregularities on the surface, the amount of calculation increases accordingly, so by converting to a model with a margin in this way and calculating The calculation time can be shortened.
[Move example]
FIG. 16 shows a simulation example of interference with a surrounding structure (30) due to movement (carrying in) of the object 31 using a calculation model (3D object). For example, an image in the case of moving (carrying in) the object (calculation model) 31a in FIG. 15 so as to pass through a surrounding structure (calculation model) 30a such as a substantially concave wall in FIG. (Corresponding to FIG. 13). Arrows indicate the direction of movement and the partial path. Reference numeral 1601 denotes the above-described center of gravity of the object 31a or another reference point. A point A 1602 indicates one point on the route (an example of a position for determining an interference state with the surrounding structure 30a).
FIG. 17 shows a state transition example corresponding to the movement example of FIG. FIG. 17A is the same as FIG. 16 and shows a state before passing. On the lower side, it is shown in the XY plane. (B) changed from the state of (a) by changing (rotating) the posture angle (φ) of the object 31a so as to pass through the surrounding structure 30a, but contacted at the concave right hand part ( It is in a stopped state due to interference. (C) is a state in which the posture angle (θ) is changed (rotated) from the state of (b) so as to be non-interfering, and the state advances forward so as to pass through the surrounding structure 30a without interference.
FIG. 18 is an explanatory diagram on the XY plane corresponding to the example of FIG. FIG. 18A shows a case where the motor stops with interference as in FIG. (B) is a case where the object 31a and the surrounding structure 30a are not interfered (contacted) by translating the object 31a in the Y direction from the state of (a). d is the distance of translation in the Y direction at that time, that is, the minimum amount of movement required to avoid interference.
FIG. 18C shows an example of another posture state in which interference between the object 31a and the surrounding structure 30a is avoided. Further, c represents the minimum margin distance between the object 31a and the surrounding structure 30a at that time. In the example as shown in (b), the object 31a and the surrounding structure 30a are in contact with each other, and it can be said that the object 31a and the surrounding structure 30a can be virtually passed, but as shown in (c), the object 31a and A posture / route that ensures a minimum margin distance c between the surrounding structure 30a and the surrounding structure 30a is preferable. Therefore, in this system, the posture / path is designed so as to secure the minimum margin distance c. This value c can also be set by the user.
FIG. 18D shows an example of a posture where it is impossible to avoid interference between the object 31a and the surrounding structure 30a.
In this system, in order to determine a path / posture that avoids interference, interference is performed by changing the posture angle of the object 31 when there is interference, such as a change from (b) to (c) in FIG. There are a method (procedure) for setting the state of no object and a method (procedure) for moving the object 31 with the same posture angle as shown in FIG. 18 (a) to (b). Both can be selected when planning candidates. When the optimal evaluation unit 114 determines (evaluates) the optimal route from the candidates, for example, priority is given to the one that translates rather than the one that changes the posture angle (high evaluation). Or conversely, it is good also as a priority (high evaluation) what changes attitude | position angle rather than what moves in parallel. The evaluation function (priority order, etc.) can be set according to the operation characteristics of the object 31 and the carry-in device 32. For example, due to the characteristics of the carry-in device 32, the rotation (θ) of the object 31 in the horizontal plane is the easiest, and then the object 31 can be easily translated (fixed posture), and the object 31 can be rotated in the vertical direction. If (φ) is not good, it is set and calculated so that priority (high evaluation) is given in this order.
[Example of interference state]
FIG. 19 shows an example of an interference state (point A setting space, map) corresponding to the examples as shown in FIGS. The interference state at a point (position) on the route is displayed like g21 and g41 in the above-described screen example. In FIG. 19A, the horizontal axis is the posture first angle (θ), and the vertical axis is the posture second angle (φ). This is a case where the interference state is determined by binary, r1 is a posture region without interference (non-interference) (for example, blue display), and r2 is a posture region with interference (for example, red display). The alternate long and short dash line is the boundary between them. Point b2 indicates an interference state (with interference) corresponding to the position of point a2 in FIG. Point b3 indicates an interference state (no interference) corresponding to the position of point a3 in FIG. It can be seen that the presence or absence of interference changes by continuously changing the posture angle (θ) at a certain position.
In FIG. 19B, the interference state (interference possibility) due to (θ, φ) is similarly shown in the case of multiple values instead of binary values. The white part of the gradation indicates the non-interference state, and the black part indicates the interference state. In particular, a threshold value t for determination is set, and the threshold value t is used as a boundary and the region is divided into r1 and r2. For example, the change from the point b2 to b4 corresponds to the minimum amount of translation d required for avoiding interference in the change from FIG. 18 (a) to FIG. 18 (b). A point b5 indicates a position corresponding to the minimum margin distance c when avoiding interference in FIG. A region including the point b6 indicates a region where interference cannot be avoided as in the example of FIG.
[Calculation processing method]
As a route / posture calculation processing method, it is particularly efficient by calculating from the end point (for example, a fixed posture carry-in end point) side to the start point (for example, an arbitrary posture carry-in start point) side.・ Calculate at high speed.
[Calculation time and system configuration example]
For applications that require real-time or short time regarding the calculation time (speed) of the route plan (for example, when displaying the route at any time on the work site) and for applications that are not required (for example, when designing before plant construction) Apply different system configuration and calculation methods.
In the former case, as described above, a parallel calculation configuration using GPGPU 70, cloud computing, or the like is used. The main calculation is performed at high speed using the GPGPU 70 (parallel operation) in the main calculation device 10, and the result is referred to by the portable terminal 20. For example, the users UA and UB in FIG. 1 can perform work while viewing the route on the screen at the site or remotely. Real-time display can improve work efficiency.
In the latter case, it is sufficient that an appropriate result is obtained even if a certain amount of time is required. Therefore, the configuration of the parallel operation using the GPGPU 70 or the cloud computing as described above is not essential. That is, for example, when the carry-in route planning system 1 (main computer 10) is a stand-alone system, a design / plan including routes and the like is executed in advance by a user operation such as a designer, and route information ( Corresponding GUI display data) is stored for later reference. For example, in FIG. 1, it is good also as a structure which integrated the function of the design apparatus 50 (CAD system etc.) and the carrying-in route planning system 1. FIG.
There are various usage examples (uses) of this system, for example, the following.
(1) Transport work: A route in a work for transporting the object 31 directly by hand is planned. In this case, the minimum margin distance c and the like may be set in consideration of the space where the person has the object 31.
(2) Construction of a building: A route for carrying in and out of construction work is planned with a building such as a plant as the structure 30 and parts constituting the building as the object 31. The state of the structure 30 changes according to the progress of construction.
(3) Demolition / removal of building: The route of carrying in / out in the work of dismantling the structure 30 and removing it as the object 31 is planned. The state of the structure 30 changes according to the progress of removal.
(4) Search for a disaster site: For example, a search route is planned in an internal search or investigation work when the structure 30 is broken due to a disaster or the like. For example, the user does not enter the structure 30 and searches for a remotely operable robot equipped with a camera or the like. The operator remotely operates the robot while confirming the image (space condition) of the robot viewpoint on the remote screen. In this case, the route may be calculated by regarding the object 31 and the carry-in device 32 as a robot. In this application, for example, the end point of the route changes or becomes unknown, but the operation can be performed by repeating the calculation of the partial route as described above. For example, the robot is provided with the space data acquisition device 60, and a partial path is appropriately calculated according to the spatial data (D4) acquired thereby, and the robot is advanced according to the partial path. The state of the structure 30 changes according to the progress and debris removal.
As described above, according to the present embodiment, it is possible to automatically and quickly calculate an efficient route in which the object 31 and the surrounding structure (30) do not interfere, the posture of the object 31, and the like. By reducing the inefficiency caused by the interference between the object 31 to be carried in / out and the structure 30 and improving the efficiency of the work in / out, for example, it is possible to reduce the cost of the plant construction (construction), shorten the period, or implement preventive maintenance. . For example, in a CAD / CAM system or the like, a route that allows efficient loading / unloading / installation can be planned. In particular, it is possible to obtain an optimum route including the point on which route the object 31 can be moved efficiently without interfering with the surrounding structure (30). . In particular, information such as an optimal route can be displayed in an easy-to-understand manner on the screen of the mobile terminal 20 viewed by a user such as an operator, thereby realizing effective work support.
The present invention can be used for various route planning applications including transportation, construction, and dismantling work.
DESCRIPTION OF SYMBOLS 1 ... Carry-in route planning system, 10 ... Main computer, 20 ... Portable terminal, 30 ... Structure, 31 ... Object, 32 ... Carry-in device, 40 ... Actual operation system, 50 ... Design device, 60 ... Spatial data acquisition device DESCRIPTION OF SYMBOLS 101 ... Setting part, 102 ... Data input part, 103 ... Calculation model preparation part, 104 ... Interference check data preparation part, 105 ... Display data preparation part, 111 ... Path planning part, 112 ... Attitude planning part, 113 ... interference check part, 114 ... optimum evaluation part, 121 ... data output part.
A carry-in route planning system configured to include a calculation device that performs information processing for planning a route for carrying an object in and out of a structure by calculation,
The calculation device has a path planning function for calculating an efficient path including the posture of the target object that does not interfere with the target object and surrounding structures;
The route planning function is:
A setting unit for setting condition information including a start point and an end point for calculating the route by a user operation;
An input unit for inputting data including three-dimensional model data of the structure and three-dimensional model data of the object;
Using the condition information and the input data, a route planning unit that plans a plurality of route candidates connecting the start point and the end point;
For each of the plurality of route candidates, a posture planning unit that plans a plurality of posture candidates according to the position of the object on the route;
About the route candidate and the posture candidate, an interference check unit that determines an interference state between the object and the surrounding structure;
Wherein based on the result of the determination of the interference condition, have a, and an output unit for outputting information of one or more efficient route, including the orientation of the object the object and its surrounding structures do not interfere,
When there is interference as an interference state between the target object and its surrounding structure at a position on the path, the path planning function is in a state without interference by translating the target object from the position with a minimum amount. Search for a position and a route, and if a route without interference due to the parallel movement is not found, search for a posture and a route in which there is no interference by changing the angle that defines the posture of the object from the position. A delivery route planning system characterized by this.
The delivery route planning system according to claim 1,
A portable terminal connected to the computing device via a communication network;
The portable terminal has a GUI display function for providing a GUI screen for easily handling the processing and information provided by the route planning function by a user operation,
The GUI display function displays information including an efficient route for carrying an object in and out of the structure on the screen of the portable terminal.
The computing device includes a CPU that performs control processing, a main memory, and a GPGPU that performs parallel arithmetic processing,
As the process of the path planning function, the CPU instructs the GPGPU to perform a parallel operation process related to a process of determining an interference state between the target object and its surrounding structures in the plurality of path candidates and posture candidates, A carry-in route planning system, characterized in that a processing for each route candidate and posture candidate is assigned to each of a plurality of computation cores of the GPGPU, a parallel computation process is executed, and the processing result is integrated into the main memory.
In the carrying-in route planning system according to claim 3,
The path planning unit performs a process of planning a plurality of path candidates in a state where the shape of the target object and the shape of the surrounding structure do not interfere with each other using the parallel processing of the GPGPU. Carry-in route planning system.
The posture planning unit uses a parallel calculation process of the GPGPU to plan a plurality of posture candidates for each of the plurality of route candidates so that the posture of the object does not interfere with surrounding structures. Carrying-in route planning system.
The route planning function selects, as an optimal route, a route with less posture variation by evaluating at least one route including the posture of the target object that does not interfere with the target object and surrounding structures. A delivery route planning system characterized by having an optimum evaluation unit.
The route planning function creates a three-dimensional model having a simple shape by taking a spatial margin around the shape of the object and the structure based on the input data, and calculating model data for calculating the route. A delivery route planning system characterized by having a calculation model creation unit for
The computing device stores the model data of the object and the structure in a memory based on the input data,
The computing device generates first data for processing including processing of the interference check unit of the path planning function based on the data of the memory model, and stores the first data for storage in the memory. A first data creation unit; and a second data creation unit that creates second data for displaying a GUI screen and stores the second data in the memory,
The route planning function stores route information as a result of processing including processing of the interference check unit of the route planning function using the first data in the memory,
The second data creation unit creates third data for display of the GUI screen reflecting the route information using the second data, stores the third data in the memory,
The said output part outputs the said 3rd data of the said memory, The carrying-in route planning system characterized by the above-mentioned.
The path planning function inputs data of a three-dimensional model of a loading apparatus that loads the object in the structure, sets a calculation model in which the loading apparatus is integrated as the object, A carry-in route planning system, characterized in that the efficient route is calculated using a converted calculation model.
The setting unit sets the posture of the object at the carry-in end point of the carry-in route by the user operation as the condition information,
The route planning function changes the posture for each position while moving the position of the object by a predetermined length from the loading end point to the loading start point on the loading path, and the object and surrounding structures Searching for a route including the posture of an object that does not interfere with the object, a carry-in route planning system.
The setting unit, as the condition information, sets a partial path from a temporary start point to an end point through the way from the transfer start point to the transfer end point of the entire transfer path by a user operation,
The route planning function calculates an efficient route including a posture of an object in which the object does not interfere with the surrounding structure, with the partial route as a calculation range.
A design device connected to the computing device via a communication network;
The design device manages design data including data of a three-dimensional shape including the object and the structure;
The input route of the calculation apparatus acquires the design data from the design apparatus as the input data.
A spatial data acquisition device connected to the computing device via a communication network;
The spatial data acquisition device performs processing for acquiring spatial data of a three-dimensional shape by imaging a space in the structure,
The input route of the said calculation apparatus acquires the spatial data of the said spatial data acquisition apparatus as said input data, The carrying-in route planning system characterized by the above-mentioned.
An actual operation device connected to the computing device via a communication network;
The actual operation device controls the operation of a loading device for loading the object in the structure,
Control information corresponding to the efficient route is transmitted from the computing device to the actual operation device, and operation control information corresponding to the control information is transmitted from the actual operation device to the carry-in device, whereby the carry-in device is transmitted. The carry-in route planning system, characterized in that the object is moved on the efficient route.
In the delivery route planning system according to claim 2,
As the first screen displayed by the GUI display function,
As information of an efficient route for carrying an object in and out of the structure, a starting point and an end point, a current position of the object, an attitude of the object corresponding to the position, and an attitude in a carrying-in or carrying-out route A loading route planning system characterized by displaying information of a specified angle.
As a second screen displayed by the GUI display function,
A loading route planning system characterized by displaying information including an image of a two-dimensional plane of the structure and an image of the object positioned on the efficient route superimposed on the plane. .
As a third screen displayed by the GUI display function,
Displaying information including a three-dimensional image of the structure and a three-dimensional image of the object located on the efficient route superimposed on the space. Path planning system.
In the screen displayed by the GUI display function,
Displaying information indicating an interference state between the object and the surrounding structure at a position on the path;
In the information indicating the interference state, the horizontal axis and the vertical axis take two angles that define the posture of the object, and the presence or absence of interference is displayed at a point determined by the two angles. Planning system.
The setting unit sets a minimum margin distance to be secured between the object and the surrounding structure by a user operation,
The interference planning unit of the path planning function determines the minimum margin distance between the object and the surrounding structure when determining an interference state between the object and the surrounding structure at a position on the path. A carry-in route planning system, characterized in that if it can be secured, it is determined that there is no interference, and if it cannot be secured, it is determined that there is interference.
JP2012006155A 2012-01-16 2012-01-16 Carry-in route planning system Active JP5855469B2 (en)
JP2012006155A JP5855469B2 (en) 2012-01-16 2012-01-16 Carry-in route planning system
EP13738048.1A EP2806324A4 (en) 2012-01-16 2013-01-15 Delivery route planning system
PCT/JP2013/050569 WO2013108749A1 (en) 2012-01-16 2013-01-15 Delivery route planning system
JP2013145497A JP2013145497A (en) 2013-07-25
JP5855469B2 true JP5855469B2 (en) 2016-02-09
ID=48799174
JP2012006155A Active JP5855469B2 (en) 2012-01-16 2012-01-16 Carry-in route planning system
EP (1) EP2806324A4 (en)
JP (1) JP5855469B2 (en)
WO (1) WO2013108749A1 (en)
KR101774919B1 (en) * 2015-08-21 2017-09-05 삼성중공업(주) Apparatus for simulation of loading
DE202016008565U1 (en) 2015-10-16 2018-06-26 Palfinger Ag Arrangement of a controller and a mobile control module
US10054447B2 (en) 2016-08-17 2018-08-21 Sharp Laboratories Of America, Inc. Lazier graph-based path planning for autonomous navigation
KR101767841B1 (en) 2016-08-24 2017-08-14 주식회사 포스코 Apparatus and method for controlling crane
JP2018095369A (en) * 2016-12-09 2018-06-21 株式会社タダノ crane
JP2019179496A (en) * 2018-03-30 2019-10-17 日本電産シンポ株式会社 Computer system and computer program
JPH044402A (en) * 1990-04-23 1992-01-08 Toshiba Corp Device for supporting preparation of equipment carrying in/out plan
JP3099387B2 (en) 1991-03-01 2000-10-16 株式会社日立製作所 Installation planning support method
JP5044991B2 (en) * 2006-05-25 2012-10-10 トヨタ自動車株式会社 Route creation apparatus and route creation method
BRPI0809249A2 (en) * 2007-03-21 2014-09-09 Commw Scient Ind Res Org Method for planning and implementing obstacles free route for excavating machinery.
JP2010055415A (en) * 2008-08-28 2010-03-11 Hitachi Industrial Equipment Systems Co Ltd Robot system
DE102010007458A1 (en) * 2010-02-10 2011-08-11 KUKA Laboratories GmbH, 86165 Method for collision-free path planning of an industrial robot
2012-01-16 JP JP2012006155A patent/JP5855469B2/en active Active
2013-01-15 WO PCT/JP2013/050569 patent/WO2013108749A1/en active Application Filing
2013-01-15 EP EP13738048.1A patent/EP2806324A4/en not_active Withdrawn
WO2013108749A1 (en) 2013-07-25
EP2806324A4 (en) 2016-01-06
EP2806324A1 (en) 2014-11-26
JP2013145497A (en) 2013-07-25
JP2007185947A (en) 2007-07-26 Computer-implemented method of defining composite tape course, computer program product of defining composite tape course and tape course generator
US6473083B1 (en) 2002-10-29 Computer graphics data generating apparatus, computer graphics animation editing apparatus, and animation path generating apparatus
JP2003216979A (en) 2003-07-31 Device for 3d computer modeling apparatus
JP2009512048A (en) 2009-03-19 Method, apparatus and program for transmitting a roof and building structure in a three-dimensional representation of a building roof based on the roof and building structure
JPH0927046A (en) 1997-01-28 Interference checking method
EP1703470B1 (en) 2009-09-09 Depth image-based modeling method and apparatus
2013-07-10 A711 Notification of change in applicant
Ref document number: 5855469