Interference determination device
By combining distance measurement, interval removal and determination units, the problem of the inability to detect interference between robots and other objects in the prior art is solved, and the determination efficiency is improved.
Patent Information
- Application Number
- CN202311129409.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2023-05-31
- Filing Date
- 2023-09-01
- Publication Date
- 2024-12-03
AI Technical Summary
The existing interference inspection device can only detect interference between robot parts and cannot detect interference between robots and other objects, resulting in inefficient judgment.
The distance measurement unit measures the distance of objects in the robot's working space, and the interval removal unit removes the point group data based on the point group data range and the number of points, extracts the point group data in the robot area, and determines whether the point group data is in the robot area to determine interference.
The amount of point group data used in the judgment is effectively reduced, and the efficiency of the robot interfering with other objects is improved.
Smart Images

Figure CN119057841A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to an interference determination device. Background Art
[0002] Conventionally, in the motion plan of a robot operating in a factory, a check is performed so that the robot's arm and the like do not interfere with each other. As a method for detecting whether there is interference, for example, the following method is sampled: point group data of three-dimensional coordinates corresponding to an object such as a robot is acquired, and the acquired point group data is used for the check. However, if all the point group data is used for processing, the load increases, so it is desired to efficiently reduce the point group data used in the processing.
[0003] As a method of reducing the processing load, for example, the following patent document 1 discloses an interference checking device for checking interference between multiple structural elements of a robot. The interference checking device classifies the robot into parts such as the head, chest, waist, right upper arm, right elbow, and right front hip, stores an interference matrix for determining parts that may interfere with each combination of parts according to the posture of the robot, and uses the interference matrix to check the interference of the robot.
[0004] The interference checking device refers to the interference matrix based on the posture of the robot assumed according to the action command value of the controller, and when there is a combination of parts that may interfere, determines whether the three-dimensional coordinates corresponding to these parts overlap with each other, thereby detecting interference.
[0005] Prior Art Literature
[0006] Patent Literature
[0007] Patent Document 1: Japanese Patent Application Publication No. 2011-131303
[0008] -Problems to be solved by the invention-
[0009] However, the interference checking device of Patent Document 1 is a device that checks for interference between parts of a robot, and does not check whether the robot interferes with other objects. Summary of the invention
[0010] Therefore, an object of the present invention is to provide an interference determination device that can efficiently reduce point group data used in determination when determining whether a robot and another object interfere with each other.
[0011] -Methods for solving the problem-
[0012] An interference determination device according to one embodiment of the present invention comprises: a distance measuring unit for measuring the distance to an object contained in a working space of a robot; a spacing elimination unit for performing spacing elimination on point group data obtained by the distance measuring unit based on the range and number of points of the point group data obtained by the distance measuring unit; an extraction unit for extracting point group data contained in a determination area including a robot area corresponding to a model of a robot arranged in the working space from the point group data after the spacing elimination by the spacing elimination unit; and a determination unit for determining that interference occurs between the robot and the object when the point group data extracted by the extraction unit is within the robot area.
[0013] According to this method, point group data corresponding to objects contained in the robot's working space are obtained, and based on the range and number of points of the point group data, the obtained point group data are interval-cut off. From the point group data after interval-cut off, the point group data contained in the judgment area including the robot area corresponding to the robot model is extracted. When the extracted point group data is inside the robot area, it is determined that the robot and the object are interfering.
[0014] Thus, the point group data corresponding to the object is thinned out, and the point group data required for interference determination is extracted from the thinned out point group data. Using the extracted point group data, it is possible to determine whether the robot interferes with other objects.
[0015] The interference determination device involved in other embodiments of the present invention comprises: a distance measuring unit, which measures the distance to an object contained in the working space of the robot; an interval elimination unit, which performs interval elimination on the point group data obtained by the distance measurement unit based on the range and the number of points of the point group data obtained by the distance measurement unit; and a determination unit, which determines that the robot interferes with the object when the point group data after the interval elimination by the interval elimination unit is within the robot area corresponding to the model of the robot configured in the working space.
[0016] According to this method, point group data corresponding to objects contained in the robot's working space is obtained, and the acquired point group data is interval-cut off based on the range and number of points of the point group data. When the point group data after interval-cut off is inside the robot area, it can be determined that the robot and the object are interfering.
[0017] Thus, it is possible to determine whether or not the robot interferes with other objects by using the point group data obtained by thinning out the point group data corresponding to the object.
[0018] In each of the above-mentioned methods, when the interval elimination unit performs interval elimination on the point group data based on the range and number of points of the point group data obtained by the distance measurement unit, it calculates the size of the space used to delimit the group of point group data to be eliminated, and performs interval elimination on the point group data according to each group delimited by the space.
[0019] According to this method, the space formed by the point cloud data can be defined with a uniform size, and the point cloud data can be thinned out for each defined space. Thus, the scattered point cloud data can be thinned out in a balanced manner.
[0020] In the above-mentioned embodiments, when the number of points in the entire point cloud data remaining after thinning out is greater than the target number of points, the thinning out unit may increase the size of the space and further thin out the point cloud data for each group defined by the increased space.
[0021] According to this aspect, even when the number of point cloud data after thinning out is larger than the target number of points, it is possible to adjust the number of points closer to the target number of points while repeatedly thinning out.
[0022] The interference determination device involved in other embodiments of the present invention comprises: a distance measuring unit, which measures the distance to an object contained in the working space of the robot; an extraction unit, which extracts point group data contained in a determination area including a robot area corresponding to a model of the robot configured in the working space, from the point group data obtained by the distance measuring unit; and a determination unit, which determines that the robot and the object interfere with each other when the point group data extracted by the extraction unit is within the robot area.
[0023] According to this method, point group data corresponding to objects contained in the robot's working space is obtained, and point group data contained in a judgment area including a robot area corresponding to the robot model is extracted from the obtained point group data. When the extracted point group data is inside the robot area, it can be determined that the robot and the object are interfering.
[0024] Thus, point group data required for interference determination can be extracted from point group data corresponding to the object, and whether or not interference occurs between the robot and the other object can be determined using the extracted point group data.
[0025] In each of the above aspects, a determination area may be provided for each link of the robot, and the determination unit may determine whether or not the robot interferes with the object for each link of the robot.
[0026] According to this aspect, when one link constituting the robot is determined to have interfered, determination on the remaining links can be omitted.
[0027] -Effects of the Invention-
[0028] According to the present invention, it is possible to provide an interference determination device that can efficiently reduce point cloud data used in determination when determining whether or not a robot interferes with another object. BRIEF DESCRIPTION OF THE DRAWINGS
[0029] Figure 1 This is a diagram illustrating a configuration of a welding robot system including an interference determination device according to an embodiment.
[0030] Figure 2 is an example Figure 1 A diagram showing a functional configuration of a control unit of an interference determination device shown in FIG.
[0031] Figure 3A This is a schematic diagram illustrating a cube for defining groups of point cloud data.
[0032] Figure 3B This is a schematic diagram illustrating the thinning out of point cloud data for each group defined by a cube.
[0033] Figure 4A This is a schematic diagram illustrating a cube for defining groups of point cloud data.
[0034] Figure 4B This is a schematic diagram illustrating the thinning out of point cloud data for each group defined by a cube.
[0035] Figure 5A Schematic diagram illustrating the relationship between the area for determination including the robot area and the point cloud data.
[0036] Figure 5B It is an example from Figure 5A Schematic diagram of point group data extracted from point group data.
[0037] Figure 6 This is a flowchart for explaining an example of the operation of the interference determination device.
[0038] -Explanation of symbols-
[0039] 1...interference determination device, 2...robot control device, 3...manipulator, 11...control unit, 12...storage unit, 13...communication unit, 14...photography unit, 15...distance measurement unit, 16...display unit, 21...control unit, 22...storage unit, 23...communication unit, 100...welding robot system, 111...coordinate system setting unit, 112...coordinate assigning unit, 113...interval elimination unit, 114...extraction unit, 115...determination unit, Ra...robot area, Rb...area for determination. DETAILED DESCRIPTION
[0040] With reference to the accompanying drawings, suitable embodiments of the present invention will be described. In addition, in each figure, the parts assigned the same symbol have the same or similar structure. In addition, since the accompanying drawings are schematic diagrams, the size and ratio of each structural element are different from the actual situation.
[0041] Figure 1 1 is a schematic structural diagram of a welding robot system including an interference determination device according to an embodiment. The welding robot system 100 includes, for example, an interference determination device 1, a robot control device 2, and a manipulator (robot) 3. The interference determination device 1 and the robot control device 2, and the robot control device 2 and the manipulator 3 are connected via a network, respectively. The interference determination device 1 and the robot control device 2 are connected via wireless communication such as WiFi (Wireless Fidelity), and the robot control device 2 and the manipulator 3 are connected via a communication cable, for example. In addition, the network may be wired (including a communication cable) or wireless.
[0042] Furthermore, the welding robot system 100 may include a teaching pendant. The teaching pendant is an operating device that can be connected to the robot control device 2 and is used when an operator teaches the robot hand 3 how to operate.
[0043] The robot 3 is a welding robot that performs arc welding on a workpiece to be welded according to the operation conditions set in the robot control device 2. The robot 3 includes, for example, a multi-joint arm provided on a base member fixed to the floor of a factory, and a welding torch (tool) connected to the front end of the multi-joint arm. In addition, it is assumed that the welding wire supplied to the welding torch is not included in the structure of the robot 3.
[0044] The robot control device 2 is a control unit that controls the operation of the manipulator 3 , and includes, for example, a control unit 21 , a storage unit 22 , and a communication unit 23 .
[0045] The control unit 21 is a processor, and controls the robot 3 by executing a welding program or the like stored in the storage unit 22 .
[0046] The communication unit 23 is a communication interface, and controls communication with the interference determination device 1 and the robot 3 connected via a network.
[0047] In addition, the robot control device 2 may also include a welding power supply unit. The welding power supply unit supplies welding current and welding voltage to the robot hand 3 according to predetermined welding conditions, for example, in order to generate an arc between the tip of the welding wire and the workpiece. The welding power supply unit may also be provided independently of the robot control device 2.
[0048] The interference determination device 1 is, for example, a portable terminal with a digital camera. The portable terminal includes portable terminals such as tablet terminals, smart phones, portable information terminals (PDAs), and notebook PCs (personal computers). The interference determination device 1 includes, for example, a control unit 11, a storage unit 12, a communication unit 13, a photographing unit 14, a distance measuring unit 15, and a display unit 16.
[0049] The control unit 11 is a processor, and controls each unit of the interference determination device 1 by executing a program stored in the storage unit 12 .
[0050] The storage unit 12 is a computer-readable recording medium that stores programs for implementing various functions of the interference determination device 1 and various data used in the programs. The various data include, for example, shape and size information of each type of the manipulator 3 and shape and size information of each type of tools mounted on the manipulator 3.
[0051] The communication unit 13 is a communication interface, and controls communication with the robot control device 2 connected via a network.
[0052] The imaging unit 14 is, for example, a 2D camera including a lens and an image sensor (imaging element), and converts light of a subject received by the lens into an electric signal (digital image data).
[0053] The distance measuring unit 15 is, for example, a 3D camera equipped with a distance measuring sensor. The distance measuring sensor is a sensor that can measure the distance to an object. As the distance measuring sensor, for example, a LiDAR (Light Detection and Ranging) sensor, a millimeter wave sensor, an ultrasonic sensor, etc. can be used.
[0054] In addition, the distance measuring unit 15 may be only one of a 3D camera and a distance measuring sensor. In the case of only a 3D camera, it is preferred to calculate the three-dimensional coordinate data corresponding to the object based on multiple images obtained by photographing the object from multiple different positions. In this case, a three-dimensional measurement method based on a known stereo method can be used.
[0055] Here, by including the distance measuring sensor in the interference determination device 1, the positional relationship between the image sensor and the distance measuring sensor can be fixed, and the timing of acquiring data through each sensor can be matched. Therefore, the processing efficiency of setting the specific position of the mark described later on the point group data can be improved. In addition, by equipping the interference determination device 1 with the image sensor and the distance measuring sensor, the operator operating the interference determination device 1 can move freely to take pictures at any position where the workpiece and the mark can be photographed at the same time, thereby improving the working efficiency.
[0056] Furthermore, the interference determination device 1 may also include a sensor having the function of an image sensor for capturing and acquiring an image and a sensor having the function of a distance measurement sensor for measuring and acquiring a distance. Thus, an image including the welding object and the distance to the welding object can be acquired from the same place at the same timing, thereby further improving the processing efficiency of setting a specific position of a mark described later on the point group data.
[0057] The display unit 16 is, for example, a display having a touch panel, and displays the image of the subject captured by the imaging unit 14 and receives inputs based on operation instructions from the operator. The display unit 16 may be, for example, a display device having a touch panel, and may be provided independently of the interference determination device 1 .
[0058] Figure 2 The figure is a diagram illustrating the functional structure of the control unit 11 of the interference determination device 1 according to the present invention. The control unit 11 of the interference determination device 1 has, as a functional structure, a coordinate system setting unit 111, a coordinate providing unit 112, a thinning unit 113, an extraction unit 114, and a determination unit 115, for example.
[0059] The coordinate system setting unit 111 sets a three-dimensional user coordinate system based on, for example, a marker included in an image captured by the photographing unit 14. The image captured by the photographing unit 14 includes, for example, workpieces and markers arranged in a space (hereinafter also referred to as a "working space") in which the manipulator 3 performs operations. The marker is an identifier that enables the interference determination device 1 to recognize that it exists in the working space, and an AR marker is preferably used. The marker can be arranged at any position in the working space.
[0060] Specifically, the coordinate system setting unit 111 can set a three-dimensional user coordinate system having a specific position of a marker (for example, a corner of a marker, the center of a marker, etc.) as an origin.
[0061] In addition, the origin of the user coordinate system is not limited to a specific position of the mark, and may be, for example, the origin of a camera coordinate system determined with the camera lens as a reference.
[0062] The coordinate assigning unit 112 assigns coordinates of the user coordinate system to the point cloud data obtained by the distance measuring unit 15 that measures the distance to the object included in the image captured by the imaging unit 14 .
[0063] The coordinate assigning unit 112 detects the specific position of the marker based on the image captured by the photographing unit 14, and sets the detected specific position of the marker on the point group data obtained by the distance measuring unit 15. The coordinate assigning unit 112 assigns the coordinates of the user coordinate system with the specific position of the marker set on the point group data as the origin (reference) to the point group data. Thus, the point group data is drawn in the user coordinate system.
[0064] The specific position of the mark set on the point group data may be automatically identified by data analysis, for example, or the specific position of the mark on the point group data may be specified by an operator through instructions.
[0065] The thinning unit 113 thins out the point group data obtained by the distance measuring unit 15 based on the range and number of points of the point group data obtained by the distance measuring unit 15, thereby reducing the amount of point group data. As an example, the thinning unit 113 thins out the point group data so that the value obtained by dividing the range of the point group data by the number of points of the point group data is used as the length of one side of a cube used to define groups of point group data, and each group defined by the cube has one point of point group data. Figure 3A as well as Figure 3B , and explain in detail.
[0066] Figure 3A as well as Figure 3B In the example, a cube with a side length of "0.1 mm" is illustrated as a cube for delimiting a group of point group data. The length of a side of the cube is calculated, for example, by "range of point group data / number of points of point group data". In this example, "5 m" is set as the range of the point group data extending in the x-axis direction of the user coordinate system, and "50,000 points" is set as the number of points of the point group data. Therefore, "0.1 mm" calculated by "5 m / 50,000 points" is calculated as the length of a side of the cube for delimiting a group of point group data.
[0067] The thinning unit 113 demarcates the point group data obtained by the distance measuring unit 15 using a cube whose side length is "0.1 mm" ( Figure 3A Next, the thinning out unit 113 thins out each point group data so that each point group data contained in each cube is 1 point ( Figure 3B). The one point remaining after the thinning can be, for example, a point closest to a predetermined location such as the center of a cube, or a randomly selected point. In addition, the number of points remaining after the thinning is not limited to one point, and can be arbitrarily set within a range that can efficiently reduce the point group data.
[0068] Furthermore, the space for defining the group of point cloud data is not limited to a cube, and may be other solids such as a rectangular parallelepiped.
[0069] When the number of points in the point group data as a whole remaining after thinning is greater than the target number of points, the thinning unit 113 can increase the size of the space and further thin out the point group data according to each group defined by the increased space. In this way, it is possible to adjust the number of points in the point group data as a whole remaining after thinning to be close to the target number of points. Figure 4A as well as Figure 4B , give specific instructions.
[0070] Figure 4A as well as Figure 4B In the example, a cube with a side length of "0.2 mm" is used as a cube for defining a group of point cloud data. Figure 3A as well as Figure 3B The length of one side of the cube shown, i.e., "0.1mm", is set to 2 times "0.2mm". The magnification when increasing the length of one side can be calculated, for example, by "number of points remaining after spacing out / target number of points". This example shows the following situation: "10,000 points" is set as the target number of points, and the number of points remaining after spacing out is "20,000 points". In this case, the magnification when increasing the length of one side is "2 times" calculated by "20,000 points / 10,000 points". Therefore, Figure 3A as well as Figure 3B The length of one side of the cube shown in the figure, 0.1 mm, is doubled to 0.2 mm. Figure 4A as well as Figure 4B The length of one side of the cube shown.
[0071] Figure 2 The extraction unit 114 shown extracts point group data included in the determination area including the robot area corresponding to the 3D model of the manipulator 3 from the point group data after thinning out by the thinning out unit 113. The 3D model of the manipulator 3 is assumed to be arranged in the work space displayed on the screen of the interference determination device 1. The position and posture of the 3D model of the manipulator 3 can be randomly determined based on the welding program, or can be arbitrarily specified by the operator indicating on the screen.
[0072] The robot area corresponding to the 3D model of the manipulator 3 can be determined based on, for example, shape and size information of the manipulator 3 corresponding to the type of the manipulator 3, posture information of the manipulator 3, and shape and size information of tools corresponding to the type of tools such as welding torches mounted on the manipulator 3. The type of the manipulator 3 and posture information of the manipulator 3 (for example, angle information of each axis) are preferably acquired from the robot control device 2.
[0073] The judgment region including the robot region is preferably set to a range that can absorb errors that may occur in the point group data obtained by the distance measuring unit 15, and to a size that has a margin relative to the size of the manipulator 3 when the welding torch is assembled. In this way, the judgment region can be set within a range that removes the influence of errors that may occur in the point group data, thereby improving the accuracy of interference judgment. The judgment region can also be set for each link of the manipulator 3.
[0074] Reference Figure 5A as well as Figure 5B , an image of point group data extracted from a determination region provided for each link of the robot 3 will be described. Figure 5A The diagram is a schematic diagram illustrating a robot region Ra corresponding to one link of the 3D model of the manipulator 3 , a determination region Rb including the robot region Ra, and a portion of point group data Da to Dg after thinning out by the thinning-out unit 113 .
[0075] The extraction unit 114 extracts the point group data Da, Db, and Dc included in the determination region Rb from the point group data Da to Dg thinned out by the thinning unit 113 .
[0076] Figure 5B Schematic diagram illustrating point cloud data Da, Db, and Dc extracted by the extraction unit 114 .
[0077] Figure 2 The determination unit 115 shown in the figure determines that the robot 3 interferes with an object existing in the work space when the point cloud data extracted by the extraction unit 114 exists inside the robot area. Figure 5B , and explain in detail.
[0078] The determination unit 115 determines whether any of the point cloud data Da, Db, and Dc extracted by the extraction unit 114 is within the robot area Ra. Figure 5B , the point cloud data Da is inside the robot area Ra. In this case, the determination unit 115 determines that the robot 3 interferes with an object existing in the work space.
[0079] When the determination area is provided for each link of the robot 3 , the determination unit 115 determines whether the robot 3 interferes with the object for each link of the robot 3 .
[0080] Reference Figure 6 , an example of the operation of the interference determination device 1 is described.
[0081] First, the distance measuring unit 15 of the interference determination device 1 measures the distance to an object included in the image of the work space captured by the imaging unit 14 (step S101 ).
[0082] Next, the thinning-out unit 113 of the interference determination device 1 thins out the point cloud data obtained by the measurement in step S101 described above, based on the range and number of points in the point cloud data (step S102 ).
[0083] Next, the extraction unit 114 of the interference determination device 1 extracts point group data included in the determination area including the robot area corresponding to the 3D model of the manipulator 3 virtually arranged in the work space on the screen from the point group data thinned out in the above step S102 (step S103).
[0084] Next, the determination unit 11 of the interference determination device 1 determines whether any of the point cloud data extracted in step S103 is within the robot area (step S104 ).
[0085] If the determination is yes (step S104 : Yes), the determination unit 115 determines that the robot 3 interferes with an object existing in the work space (step S105 ), and ends the present operation.
[0086] On the other hand, when the determination in step S104 is negative (step S104 : No), the determination unit 115 determines that the robot 3 does not interfere with the object existing in the work space (step S106 ), and ends the present operation.
[0087] Here, interference in this embodiment refers to interference with an object corresponding to the point cloud data when the robot 3 is performing welding operation, thereby hindering the welding operation of the robot 3 (obstruction in normal welding operation).
[0088] As described above, according to the interference determination device 1 involved in the embodiment, the point group data corresponding to the object contained in the working space of the manipulator 3 is obtained, and the obtained point group data is thinned out based on the range and number of points of the point group data. From the point group data after thinning out, the point group data contained in the determination area including the robot area corresponding to the model of the manipulator 3 is extracted. When the extracted point group data is inside the robot area, it can be determined that the manipulator 3 interferes with the object. Thus, the point group data corresponding to the object is thinned out, and the point group data required for interference determination is extracted from the point group data after thinning out. Using the extracted point group data, it can be determined whether the manipulator 3 interferes with other objects.
[0089] Therefore, according to the interference determination device 1 according to the embodiment, when determining whether or not a robot interferes with another object, it is possible to efficiently reduce the point cloud data used in the determination.
[0090] [Modifications]
[0091] In addition, the present invention is not limited to the above-mentioned embodiment, and can be implemented in various other forms within the scope not departing from the gist of the present invention. Therefore, the above-mentioned embodiment is only an example in all and is not to be interpreted as limiting.
[0092] For example, in the above-described embodiment, the case where the interference determination device 1 includes both the thinning unit 113 and the extracting unit 114 is described, but the present invention is also applicable when either one is omitted.
[0093] (Variation Example in Which the Extraction Unit 114 is Omitted)
[0094] The determination unit 115 in this variation determines that the manipulator 3 interferes with an object existing in the workspace when the point cloud data after thinning out by the thinning out unit 113 is inside the robot area Ra corresponding to the 3D model of the manipulator 3 virtually arranged in the workspace on the screen.
[0095] (Variation Example in Which Thinning-Out Section 113 Is Omitted)
[0096] The extraction unit 114 in this modification example extracts point group data included in the determination region Rb including the robot region Ra corresponding to the 3D model of the manipulator 3 virtually arranged in the work space on the screen, from the point group data obtained by the distance measurement unit 15 .
[0097] (Other Modifications)
[0098] In the above-mentioned embodiments, the welding robot is used for explanation, but the present invention is not limited to this. For example, the present invention can also be applied to industrial robots including robots for picking and other operations, and robots for performing certain operations or transportation such as independent conveyor carts. In this case, the welding program, welding object, and welding action used in the above-mentioned embodiments can be replaced with an operation program, a transportation program, an operation object, a transportation object, and an operation and transportation, respectively.
[0099] In addition, in the above-mentioned embodiment, a single interference determination device 1 is used to capture images of the workspace, but multiple interference determination devices 1 may be used to capture images of the workspace from different positions. Thus, the presence or absence of interference can be determined according to each position of the image. Therefore, the accuracy of determining interference can be improved.
Claims
1. An interference determination device, comprising: A distance measuring unit that measures the distance to an object contained in a working space of the robot; a thinning out unit that thins out the point group data obtained by the distance measurement unit based on the range and the number of points of the point group data obtained by the distance measurement unit; an extracting unit that extracts point group data included in a determination area including a robot area corresponding to the model of the robot arranged in the workspace, from the point group data thinned out by the thinning-out unit; and The determination unit determines that the robot interferes with the object when the point cloud data extracted by the extraction unit is within the robot area.
2. An interference determination device, comprising: A distance measuring unit that measures the distance to an object contained in a working space of the robot; a thinning-out unit that thins out the point group data obtained by the distance measurement unit based on the range and the number of points of the point group data obtained by the distance measurement unit; and The determination unit determines that the robot interferes with the object when the point cloud data after the thinning-out by the thinning-out unit is within a robot area corresponding to the model of the robot arranged in the work space.
3. The interference determination device according to claim 1 or 2, in, When thinning out the point group data based on the range and number of points of the point group data obtained by the distance measuring unit, the thinning out unit calculates the size of a space for defining groups of the point group data to be thinned out, and thins out the point group data for each group defined by the space.
4. The interference determination device according to claim 3, in, When the number of points of the entire point cloud data remaining after thinning out is greater than the target number of points, the thinning out unit increases the size of the space and further thins out the point cloud data for each group defined by the increased space.
5. An interference determination device, comprising: A distance measuring unit that measures the distance to an object contained in a working space of the robot; an extracting unit that extracts point group data included in a determination area including a robot area corresponding to a model of the robot arranged in the work space from the point group data obtained by the distance measuring unit; and The determination unit determines that the robot interferes with the object when the point cloud data extracted by the extraction unit is within the robot area.
6. The interference determination device according to claim 1 or 5, in, The determination area is set according to each link of the robot, The determination unit determines whether the robot interferes with the object for each link of the robot.
Citation Information
Patent Citations
Interference checking device
JP2011131303A
