WO2020105311A1 - 位置測定システム及び位置測定方法 - Google Patents

位置測定システム及び位置測定方法

Info

Publication number
WO2020105311A1
WO2020105311A1 PCT/JP2019/040312 JP2019040312W WO2020105311A1 WO 2020105311 A1 WO2020105311 A1 WO 2020105311A1 JP 2019040312 W JP2019040312 W JP 2019040312W WO 2020105311 A1 WO2020105311 A1 WO 2020105311A1
Authority
WO
WIPO (PCT)
Prior art keywords
position measuring
coordinate system
measurement
coordinate
measuring device
Prior art date
Application number
PCT/JP2019/040312
Other languages
English (en)
French (fr)
Inventor
純平 山口
正信 筒井
治樹 森
Original Assignee
三菱重工業株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 三菱重工業株式会社 filed Critical 三菱重工業株式会社
Priority to US17/282,009 priority Critical patent/US20210333092A1/en
Publication of WO2020105311A1 publication Critical patent/WO2020105311A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/002Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • G01B11/005Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates coordinate measuring machines
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/002Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/02Hand grip control means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • B25J13/089Determining the position of the robot with reference to its environment
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C3/00Measuring distances in line of sight; Optical rangefinders
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C3/00Measuring distances in line of sight; Optical rangefinders
    • G01C3/02Details
    • G01C3/06Use of electric means to obtain final indication
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40601Reference sensors

Definitions

  • the present invention relates to a position measuring system and a position measuring method.
  • Patent Literature 1 discloses an assembling apparatus that attaches a clip to a stringer.
  • a plurality of support robots for gripping a stringer are arranged in a row on a conveyor, and a plurality of support robots in a state of gripping the stringer are moved to a place of a mounting robot that attaches clips by the conveyor.
  • An assembling apparatus for attaching a clip to a stringer is disclosed.
  • Patent Document 1 discloses that the position of a reflector provided in each robot is detected by one laser tracker, and the operation of each robot is controlled based on the detected position.
  • a plurality of laser trackers are installed from the viewpoint of efficiency, and the position coordinates of a plurality of support robots are measured. Is shared by multiple laser trackers. In this case, multiple laser trackers need to share a common coordinate system.
  • the acquisition of a common coordinate system by each laser tracker involves, for example, detecting three reflectors for coordinate system definition provided on an abutting plate installed on a conveyor in the same manner as a supporting robot by each laser tracker. , Each laser tracker defined the coordinate system from the detected three coordinate positions.
  • the above-described method of defining the coordinate system may reduce the accuracy of position measurement by each laser tracker. That is, the three reflectors for defining the coordinate system have a restriction that the mutual distance cannot be so large because it is necessary to prevent the mutual positions from largely changing due to a thermal factor or the like. Even in the laser tracker, the coordinate system defined by the positions of the three reflectors includes some errors. On the other hand, the mutual distance between the laser trackers and the mutual distance between the supporting robots are relatively long with respect to the mutual distances of the reflectors for defining the coordinate system.
  • the above-mentioned problem is not a problem specific to the system for handling a stringer disclosed in Patent Document 1, but a problem commonly appearing in a system in which a plurality of position measuring devices need to share a common coordinate system. Is.
  • An object of the present invention is to provide a position measuring system and a position measuring method capable of performing the above.
  • the first aspect of the present invention comprises one position measuring device for measuring a part of a plurality of measuring points, and another position measuring device for measuring the remaining measuring points, and the one position
  • the measuring device measures three coordinate definition targets for defining a coordinate system of measurement points, defines the coordinate system from the measurement results of the three coordinate definition targets, and uses the defined coordinate system. Performs measurement of the measuring points assigned to itself, and the other position measuring device is a correction vector based on the positional relationship between the position measuring device and itself, which is obtained in advance, and the position measuring device of one. And a coordinate system defined by the above-mentioned coordinate system, to provide a position measurement system for measuring the measurement point assigned to itself.
  • the position measurement of a plurality of measurement points is shared by one position measurement device and another position measurement device.
  • a plurality of other position measuring devices may be provided.
  • One position measuring device measures three coordinate definition targets for defining the coordinate system of the measurement point, and defines the coordinate system of the measurement point from the measurement result. Then, the defined coordinate system is shared with other position measuring devices.
  • the other position measuring device uses the coordinate system of the measuring point defined by the one position measuring device and the correction vector based on the positional relationship with the one position measuring device, which has been obtained in advance, to determine the position of the measuring point in itself. Create a coordinate system. Then, using the created coordinate system, other position measuring devices also measure the measurement points.
  • the information on the coordinate system defined by one position measuring device is shared with other position measuring devices, and one position measuring device and another position measuring device measure the measurement point based on this coordinate system. Since this is performed, the error in the coordinate system used by each position measuring device can be reduced and the position measurement accuracy of the measurement point can be improved compared to the case where each position measuring device defines its own coordinate system.
  • the inter-target distances of the three fixed targets are the inter-target distances of the coordinate definition targets used to define the coordinate system of the measurement points. It is preferable that it is set longer than the above.
  • the position measuring device and the other position measuring device each measure the position of the three fixed targets, whereby the position information of each position measuring device in the coordinate system based on the common fixed target can be obtained. .. Then, based on the position information obtained by each of them, a difference vector from one position measuring device to another position measuring device is obtained as a correction vector.
  • the inter-target distances of the three fixed targets are also set to be long, the inter-target distances of the coordinate definition targets used to define the coordinate system of the measurement point are set to three. It is possible to reduce the error (particularly the rotation angle) in the measurement period of the coordinate system of the position measuring device defined by the measurement result of the fixed target.
  • the coordinate origin is set by using the fixed target located closest to any of the position measuring devices among the three fixed targets, and the coordinate origin is set by using the other two fixed targets.
  • the coordinate system of the position measuring device may be defined by defining rotations in two directions, and the correction vector may be calculated using the coordinate system of the position measuring device.
  • the origin of the coordinate system of the position measuring device is defined using the fixed target closest to each position measuring device, the origin error in the coordinate system defined by each position measuring device can be reduced. .. This makes it possible to improve the accuracy of the correction vector.
  • the coordinate system of the measuring point may move with respect to one installation position of the position measuring device.
  • the installation position of the one position measurement device and the measurement point are relatively Even in the case of moving, the coordinate system of the measurement point used by each position measuring device can be obtained only by measuring the coordinate defining target with one position measuring device.
  • a second aspect of the present invention is a robot control device that controls a robot using the measurement result of the measurement point measured by the position measurement system described above.
  • a third aspect of the present invention is a position measuring method in which the measurement of a plurality of measuring points is shared by a plurality of position measuring devices, and 3 for defining a coordinate system of the measuring points by one position measuring device.
  • Measuring one coordinate-defining target, defining the coordinate system from the measurement results of the three coordinate-defining targets, and using the defined coordinate system, one of the position measuring devices assigns itself The step of performing the measurement of the measured point, the other position measuring device, the correction vector based on the positional relationship between the one position measuring device and itself obtained in advance, by the one position measuring device And a step of measuring the measurement point assigned to itself by using the defined coordinate system.
  • the present invention when it is necessary to share a common coordinate system among a plurality of position measuring devices, it is possible to reduce an error in the coordinate system between the position measuring devices.
  • FIG. 1 is a schematic configuration diagram schematically showing a support robot according to an embodiment of the present invention. It is a functional block diagram of a control device which controls an assembly device concerning one embodiment of the present invention. It is a schematic structure figure showing composition of a position measuring system concerning one embodiment of the present invention. 6 is a flowchart showing a procedure of a position measuring method according to an embodiment of the present invention.
  • a position measuring system and a position measuring method according to an embodiment of the present invention will be described below with reference to the drawings.
  • the case where the position measuring system and the position measuring method according to the present invention are applied to the control of the robot used in assembling the structure of the aircraft parts such as the fuselage and the main wing of the aircraft will be described as an example.
  • the present invention is not limited to this example, and can be widely applied when a plurality of position measuring devices share a common coordinate system to measure the position coordinates of a plurality of measurement points.
  • the assembling apparatus 1 includes a carrying device 2, a table 3, a plurality of support robots 4, an abutting plate 5, a mounting robot 6, a gripping robot 11, and the like.
  • the assembly device 1 takes out the stringer 10 which is a long member from the supply position 20 and conveys it to the attachment position 21. Then, the clip 22 is attached to the stringer 10 at the attachment position 21. The stringer 10 before the clip 22 is attached is temporarily placed at the supply position 20, and the attachment robot 6 and the gripping robot 11 are fixedly placed on the floor near the attachment position 21.
  • the stringer 10 is, for example, a structural member of an aircraft, has a length of about 5 m to 15 m, and has, for example, a multi-curve shape and a three-dimensional shape.
  • the clip 22 is a component for connecting an elongated frame connected to the plurality of stringers 10. Since the clip 22 is attached at an accurate position in the longitudinal direction of the stringer 10, when assembling one frame with respect to the plurality of stringers 10, it is possible to connect the plurality of stringers 10 without bending the frames. ..
  • the carrier device 2 As the carrier device 2, a commonly used one can be applied, and a table 3 described later is placed.
  • the carrying device 2 moves the table 3 from one end side to the other end side and from the other end side to the one end side.
  • One end side of the transfer device 2 is in the vicinity of the supply position 20 of the stringer 10, and the transfer device 2 moves the table 3 from the vicinity of the supply position 20 to the vicinity of the mounting robot 6.
  • the attachment robot 6 attaches the clips 22 to a plurality of work points that are set at intervals along the longitudinal direction of the stringer 10
  • the attachment robot 6 is transported.
  • the device 2 moves a predetermined amount.
  • the stringer 10 is transported by a predetermined amount while the support robot 4 holds the part shape of the stringer 10 in a predetermined holding shape, and the next working point is moved to the position of the mounting robot 6.
  • the carrying device 2 moves by a predetermined amount, and the next working point is moved to the position of the mounting robot 6. Then, by repeating such an operation, the clip 22 is attached over the entire length of the stringer 10.
  • a plurality of support robots 4 and abutting plates 5 are installed in a row on the table 3. As a result, the plurality of support robots 4 and the butting plate 5 move integrally on the transport device 2.
  • a plurality of support robots 4 are placed in a row on the table 3, and the abutting plates 5 are placed one at each end of the table 3, that is, on both sides of the plurality of support robots 4.
  • the number of support robots 4 placed on the table 3 and the distance between the support robots 4 are set in advance according to the stringer 10 to be assembled.
  • the number of support robots 4 that operate to grip the stringer 10 is determined according to the length of the stringer 10 that is actually gripped.
  • FIG. 1 shows that four of the five support robots 4 hold the stringer 10.
  • the butting plate 5 has, for example, a flat plate portion 16, and one end of the stringer 10 is butted against the surface of the flat plate portion 16.
  • the butting plate 5 has a configuration for restraining one end of the stringer 10. Accordingly, one end of the stringer 10 abutted against the abutting plate 5 can be set as a reference position for positioning when attaching the other clip 22.
  • the abutting plates 5 are placed one on each side of the table 3, that is, one on each side of the plurality of support robots 4. When the stringer 10 is brought into contact with the butting plate 5, only one of the two butting plates 5 is used.
  • the butting plate 5 is selected according to the reference position (direction) of the stringer 10.
  • the butting plate 5 is an example of a positioning member for defining the reference position, and the configuration is not limited to this example. That is, the positioning member has only to have a function of defining the reference position, and may be, for example, a flat plate member provided with a pin-shaped projection at a position for positioning. In this case, one end of the stringer is positioned by inserting a pin-shaped projection into a hole provided in advance in the stringer or a component fixed to the stringer.
  • At least three reflectors 14-1, 14-2, 14 constituting a coordinate system defining target for defining the coordinate system of the assembling apparatus 1 are provided on the flat plate portion 16 of the butting plate 5.
  • the laser tracker 50 irradiates the three reflectors 14-1, 14-2, 14-3 constituting the coordinate defining target 14 with laser light, and receives the reflected light, whereby the respective reflectors 14-1. , 14-2, 14-3 are measured.
  • the work coordinate system which is the reference coordinate system of the assembling apparatus 1 is specified from the position information of the three reflectors 14-1, 14-2, 14-3.
  • the support robot 4 includes a hand portion 8 configured to hold a stringer 10, an arm portion 9 provided at the tip of the hand portion 8, and a body portion that supports the arm portion 9. 12 and so on.
  • the arm portion 9 and the body portion 12 are configured to move the hand portion 8 so that the hand portion 8 can properly support the stringer 10.
  • the configuration of a commonly used robot can be applied.
  • the hand unit 8 is provided with measurement points 30 for measuring the position and orientation of the hand unit 8.
  • the measurement point 30 is composed of, for example, three reflectors 30a, 30b, 30c. The position of these reflectors is detected by the laser tracker 50.
  • the position information of the three reflectors measured by the laser tracker 50 is output to the supporting robot control unit 32 (FIG. 3) described later and used for controlling the supporting robot 4.
  • the attachment robot 6 includes a hand portion 17 for attaching the clips 22 to a plurality of working points set at intervals in the longitudinal direction of the stringer 10, and a tip portion of the hand portion 17. It has an arm portion 18 provided on the, and a body portion 19 that supports the arm portion 18 and the like. As shown in FIG. 1, one mounting robot 6 may be provided, or a plurality of mounting robots 6 may be provided. The mounting robot 6 may also have a function of clamping, punching, and driving the stringer 10 and the clip 22.
  • the hand portion 17 of the attachment robot 6 is also provided with measurement points (not shown) including three reflectors or the like for measuring the position and orientation, like the hand portion 8 of the support robot 4 described above.
  • the position / orientation of the mounting robot 6 measured by the laser tracker 50 is output to a mounting robot control unit 33 (FIG. 3), which will be described later, and used for controlling the mounting robot 6.
  • the gripping robot 11 has a hand part 37 configured to grip the stringer 10 and the clip 22, an arm part 38 provided with the hand part 37 at its tip, a body part 39 supporting the arm part 38, and the like.
  • the hand portion 37 has a configuration capable of moving the stringer 10 in the X direction, and has a configuration capable of positioning the Y coordinate and the Z coordinate of the stringer 10.
  • the hand unit 37 of the gripping robot 11 is also provided with measurement points (not shown) including three reflectors or the like for measuring the position and orientation. By detecting these measurement points by the laser tracker 50, it is possible to detect not only the position of the hand portion 37 but also the posture.
  • the position / orientation of the gripping robot 11 measured by the laser tracker 50 is output to a gripping robot control unit 34 (FIG. 3) described later and used for controlling the gripping robot 11.
  • the method of defining the coordinate system and the method of detecting the position and orientation of various robots such as the support robot 4 are not limited to the method using the above three reflectors, and for example, even if a 6DoF tracking device or the like is used.
  • the 6DoF tracking device has, for example, a laser tracker and a camera, and irradiates a laser beam on a reflector provided at the center of a coordinate system defining target and receives the reflected light to determine the position of the reflector.
  • one or a plurality of LEDs mounted on the surface of the target is imaged by a camera and image-processed to define a three-dimensional orthogonal coordinate system and detect the position and orientation of various robots. Good.
  • the control device 35 that controls the assembly device 1 includes, for example, a transfer device control unit 31, a support robot control unit 32, an attachment robot control unit 33, a gripping robot control unit 34, and the like.
  • the control device 35 includes, for example, a CPU (Central Processing Unit), a RAM (Random Access Memory), a ROM (Read Only Memory), and a computer-readable storage medium.
  • a series of processes for realizing various functions are stored in a storage medium or the like in the form of a program as an example, and the CPU reads the program into a RAM or the like to execute information processing / arithmetic processing. As a result, various functions are realized.
  • the program may be installed in a ROM or other storage medium in advance, provided in a state where the program is stored in a computer-readable storage medium, or delivered via wired or wireless communication means. May be applied.
  • the computer-readable storage medium is a magnetic disk, a magneto-optical disk, a CD-ROM, a DVD-ROM, a semiconductor memory, or the like.
  • the carrier device control unit 31 adjusts the position of the carrier device 2 so that a predetermined area of the stringer 10 moves to the attachment position 21.
  • the carrier device control unit 31 controls the movement of the carrier device 2 so that a plurality of work points provided at intervals in the longitudinal direction of the stringer 10 sequentially come to the mounting position of the mounting robot 6.
  • the carrier device control unit 31 may be included in, for example, a support robot control unit 32 described below. That is, the support robot control unit 32, which will be described later, may control the movement of the transport device 2.
  • the support robot control unit 32 moves the hand unit 8 based on the position information of the measurement points 30 of the hand unit 8 of the support robot 4 acquired by the laser tracker 50 described later.
  • the support robot controller 32 brings the end of the stringer 10 into contact with the butting plate 5.
  • the support robot control unit 32 moves the hand units 8 of the plurality of support robots 4 based on the original shape of the stringer 10.
  • the attachment robot control unit 33 moves the hand unit 17 based on the position information acquired by a laser tracker (not shown) or the like.
  • the attachment robot control unit 33 operates the hand unit 17 so as to attach another clip 22 to the stringer 10.
  • the mounting robot control unit 33 causes the hand unit 17 to clamp, punch, or stud the stringer 10 and the clip 22.
  • this function may be implemented by the gripping robot control unit 34, which will be described later, or the control unit of another robot.
  • the gripping robot control unit 34 also performs various controls such as the movement of the hand unit 37 based on the position information acquired by a laser tracker (not shown).
  • the laser tracker 50 receives the commands from the carrier device controller 31, the supporting robot controller 32, the mounting robot controller 33, and the gripping robot controller 34 to detect the position and orientation of various robots such as the supporting robot 4. The detected position and orientation may be transmitted to each of the control units 31 to 34. That is, the laser tracker 50 may also be a control target of the control units 31 to 34.
  • the position measuring system 100 includes a plurality of laser trackers (position measuring devices) 50.
  • laser trackers position measuring devices
  • the case where three laser trackers 50-1, 50-2, and 50-3 are provided is illustrated, but two or more laser trackers may be provided.
  • laser trackers 50-1, 50-2, 50-3 when it is necessary to distinguish the laser trackers 50-1, 50-2, 50-3 from each other, they are referred to as laser trackers 50-1, 50-2, 50-3 and need to be distinguished. If not, it will simply be called Laser Tracker 50.
  • the laser tracker 50 detects the coordinate position of the reflector by irradiating the reflector with laser light and receiving the reflected light from the reflector.
  • the position measuring system 100 is, for example, one in which a plurality of laser trackers 50 share the measurement of a plurality of measurement points 30 provided on the hand portion 8 of each supporting robot 4.
  • a plurality of laser trackers 50 share the measurement of a plurality of measurement points 30 provided on the hand portion 8 of each supporting robot 4.
  • each laser tracker 50-1, 50-2, 50-3 measures the positions of three fixed targets 40-1, 40-2, 40-3, respectively.
  • the three fixed targets 40 are installed apart from each other.
  • the mutual distances of the fixed targets 40 are set to be longer than the mutual distances of the coordinate definition targets 14 to be described later, and are also provided at positions that can be measured by any of the laser trackers 50.
  • the mutual distance between the fixed targets 40 is preferably set longer than the moving distance of the measurement point measured by the laser tracker 50, for example.
  • the length is set to be longer than the movement distance of the transport device from the movement of the stringer 10 to the completion of the series of operations from the attachment of the clip 22. In this way, by making the mutual distance of the fixed targets 40 as long as possible, it is possible to reduce the error in the position measurement by the laser tracker 50.
  • One of the three fixed targets 40 should be installed at a position close to any of the laser trackers 50.
  • measuring instrument coordinate system A For example, by detecting the position of the fixed target 40 for each of the three points by the laser tracker 50, defines the coordinate system of the space the laser tracker 50 is installed (x a, y a, z a).
  • this coordinate system is referred to as "measuring instrument coordinate system A".
  • the obtained measuring instrument coordinate system A (x a, y a, z a) the coordinate position of each laser tracker 50 in.
  • the position of the fixed target 40 installed at the position closest to any laser tracker 50 may be determined as the origin of the measuring instrument coordinate system A. This makes it possible to reduce the error in the coordinate position of the origin in each laser tracker 50.
  • the three fixed targets 40 when installing the three fixed targets 40, one of them should be installed at a position close to any of the laser trackers 50.
  • the fixed target 40-1 it is preferable to use the fixed target 40-1 as the fixed target for determining the origin.
  • the position coordinates of each laser tracker 50 in the measuring instrument coordinate system A can be specified.
  • the position coordinate of the laser tracker 50-1 in the measuring instrument coordinate system A (x a , y a , z a ) is A 1 (x a1 , y a1 , z a1 )
  • the position coordinate of the laser tracker 50-2 is A. 2 (x a2 , y a2 , z a2 )
  • the position coordinates of the laser tracker 50-3 are defined as A 3 (x a3 , y a3 , z a3 ).
  • the mutual positional relationship is calculated from the positional coordinates of each laser tracker 50-1, 50-2, 50-3.
  • one laser tracker is defined as a reference
  • the position vector of another laser tracker is calculated with respect to the laser tracker (one position measurement device) defined as the reference. ..
  • the difference vector between the reference position coordinate of the laser tracker 50 and the position coordinate of another laser tracker 50 is obtained.
  • This position vector (difference vector) is used as a correction vector described later.
  • the position vector A 1 A 2 -1 of the laser tracker 50-2 for the laser tracker 50-1 is calculated and the laser tracker 50-3 for the laser tracker 50-1 is calculated.
  • the position vector A 1 A 3 ⁇ 1 of is calculated.
  • the reference laser tracker 50 is, for example, a laser tracker in a position closest to the coordinate definition target 14 described later, or the laser tracker 50-1 in FIG. This makes it possible to reduce the error contained in the common spatial coordinate system used when the plurality of measurement points are shared by the plurality of laser trackers 50.
  • this coordinate system (x b , y b , z b ) is referred to as a “work coordinate system B” in order to distinguish it from the measuring instrument coordinate system A.
  • this coordinate system (x b , y b , z b ) is referred to as a “work coordinate system B” in order to distinguish it from the measuring instrument coordinate system A.
  • three reflectors 14-1, 14-2 and 14-3 are installed as targets for coordinate definition.
  • the laser tracker 50-1 serving as a reference measures each of the reflectors 14-1, 14-2, and 14-3, which are targets for coordinate definition, so as to be installed on the transport device 2 (a plurality of supports).
  • a work coordinate system B (x b , y b , z b ) common to the robot 4, the abutting plate 5, etc. is defined.
  • the laser tracker 50-1 shares the work coordinate system B defined from the measurement position of the coordinate defining target 14 with the other laser trackers 50-2 and 50-3. For example, the laser tracker 50-1 transfers the position coordinate B 1 (x b1 , y b1 , z b1 ) of itself (the laser tracker 50-1) in the work coordinate system B to the other laser trackers 50-2 and 50-3. To send.
  • the other laser trackers 50-2 and 50-3 define the work coordinate system B used by themselves using the correction vector obtained in advance and the work coordinate system B acquired from the laser tracker 50-1. Using the defined work coordinate system B, the measurement point 30 assigned to itself is measured.
  • the laser tracker 50-1 calculates the coordinate transformation matrix W 1 from the measuring instrument coordinate system A to the work coordinate system B, and the information of the coordinate transformation matrix W 1 is supplied to the other laser trackers 50-1 and 50-3. You may send it.
  • the coordinate conversion matrix W 1 is represented by the following equation (1).
  • C is a vector from the origin of the coordinate definition target 14 to the origin of the work coordinate system B, which is a known matrix.
  • the other laser trackers 50-2 and 50-3 calculate the coordinate conversion matrices W 2 and W 3 , respectively, using the correction vector obtained in advance and the coordinate conversion matrix W 1 of the laser tracker 50-1.
  • the coordinate conversion matrix W 2 of the laser tracker 50-2 and the coordinate conversion matrix W 3 of the laser tracker 50-3 are expressed by the following equations (2) and (3), respectively.
  • the other laser trackers 50-2 and 50-3 convert the measurement coordinates of each measurement point 30 measured by themselves using the above-mentioned coordinate conversion matrices W 2 and W 3 , so that in the work coordinate system B.
  • the measurement coordinates of each measurement point 30 are obtained.
  • the allocation of the measurement points to each laser tracker 50 may be set in advance, or the measurement points 30 may be allocated to each measurement point 30 based on the relative positional relationship between the moving distance of the carrier device 2 and each laser tracker 50.
  • the measurement may be performed using a laser tracker that is estimated to be close.
  • the support robot control unit 32 controls the position of the hand unit 8 of the support robot 4 based on the position information of each measurement point 30, that is, the position and inclination of the hand unit 8 of the support robot 4.
  • each laser tracker 50 measures the positions of the fixed targets 40-1, 40-2, 40-3 (SA1). As a result, the position coordinates of each laser tracker 50-1, 50-2, 50-3 in the measuring instrument coordinate system A are obtained. Subsequently, one of the laser trackers 50 (for example, the laser tracker 50-1) serving as a reference is defined, and another laser tracker (for example, the laser trackers 50-2, 50-3) is set to the laser tracker defined as the reference. The position vector is calculated as a correction vector (SA2). This correction vector is stored in, for example, a storage unit (not shown) included in each laser tracker 50.
  • the position of the coordinate defining target 14 is detected by the reference laser tracker 50 (for example, the laser tracker 50-1) (SA3), and the position coordinate B 1 of the laser tracker 50-1 in the work coordinate system B is obtained. (SA4).
  • the reference laser tracker 50-1 transmits the position coordinate B 1 to the other laser trackers 50-2 and 50-3. As a result, the position coordinates B 1 are shared by all the laser trackers 50 (SA5).
  • the other laser trackers 50-2 and 50-3 Upon receiving the position coordinates B 1 , the other laser trackers 50-2 and 50-3 obtain their own position coordinates B 2 and B 3 in the work coordinate system B by using the correction vector previously registered. .. For example, a coordinate conversion matrix for converting the measuring instrument coordinate system A to the work coordinate system B is obtained (SA6).
  • each laser tracker 50 obtains the coordinate transformation matrix
  • the measurement point 30 is measured using each coordinate transformation matrix (SA7), and the measurement result is output to the supporting robot control unit 32 (SA8). ..
  • step SA9 when the position of the coordinate definition target 14 has moved due to the movement of the transport device 2, the process returns to step SA3, and the position of the coordinate definition target 14 after the movement becomes the reference. Is again measured by the laser tracker 50-1 (SA3), and the work coordinate system B is updated (SA4). Then, the subsequent processing is performed using the updated work coordinate system B.
  • the information of the work coordinate system defined by the laser tracker (one position measuring device) 50-1 is used for other laser trackers. (Other position measuring devices) 50-2 and 50-3 are also shared, and each laser tracker 50 measures the measuring point 30 of the supporting robot 4 assigned to itself based on this work coordinate system B.
  • the error of the coordinate system used by each laser tracker 50 can be reduced as compared with the case where the workpiece coordinate system B is individually defined by the laser tracker 50 measuring the position of the coordinate defining target 14. As a result, the position measurement accuracy of the measurement point can be improved.
  • the distance between the three fixed targets 40-1, 40-2, 40-3 used by each laser tracker 50 to define the measuring instrument coordinate system A is defined as the coordinate defining target 14. Since it can be longer than the above, it is possible to reduce the error (in particular, the rotation angle) between the laser trackers included in the measuring instrument coordinate system A defined by each laser tracker 50. Thereby, the correction vector can be obtained with relatively high accuracy, and the error contained in the common work coordinate system B defined based on this can be reduced.
  • the origin of the measuring instrument coordinate system A is defined by using the fixed target 40 located closest to any of the laser trackers 50, the origin error in the measuring instrument coordinate system A defined by each laser tracker 50 is reduced. be able to. This makes it possible to further improve the accuracy of the correction vector.
  • the information of the work coordinate system B defined by one laser tracker 50-1 is shared by the other laser trackers 50-2 and 50-3, so that it is relative to the laser tracker 50-1. Even when the work coordinate system B moves, the work coordinate system B used by each laser tracker 50 can be obtained by only measuring the coordinate defining target 14 with one laser tracker 50.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Electromagnetism (AREA)
  • Human Computer Interaction (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

複数の位置測定器によって共通の座標系を共有する必要がある場合に、位置測定器間の座標系の誤差を低減することを目的とする。位置測定システム(100)は、複数のレーザートラッカー(50)によって複数の測定点(30)の位置測定を分担するものである。レーザートラッカー(50-1)は、測定点(30)の座標系を定義するための3つの座標定義用ターゲット(14)を測定し、3つの座標定義用ターゲット(14)の測定結果からワーク座標系を定義し、定義したワーク座標系を用いて自身に割り当てられた測定点(30)の測定を行う。他のレーザートラッカー(50-2)、(50-3)は、予め得ておいたレーザートラッカー(50-1)と自身との位置関係に基づく補正ベクトルと、レーザートラッカー(50-1)によって定義されたワーク座標系とを用いて、自身に割り当てられた測定点(30)の測定を行う。

Description

位置測定システム及び位置測定方法
 本発明は、位置測定システム及び位置測定方法に関するものである。
 航空機の胴体や翼などの航空機部品の構造体を製造する際、構造体を構成するストリンガー等の長尺部材に対して、例えばクリップなどの他の部品が取り付けられる場合がある。
 例えば、特許文献1には、ストリンガーに対してクリップを組み付ける組立装置が開示されている。特許文献1には、コンベヤー上にストリンガーを把持するための複数の支持ロボットを一列に配置し、ストリンガーを把持した状態の複数の支持ロボットをコンベヤーによってクリップを取り付ける取付けロボットの場所まで移動させることにより、ストリンガーにクリップを取り付ける作業を行わせる組立装置が開示されている。
 特許文献1には、1台のレーザートラッカーによって各ロボットに設けられたリフレクタの位置を検出し、検出した位置に基づいて各ロボットの動作を制御することが開示されている。
 ところで、特許文献1に開示されているように、複数の測定点の位置座標を測定する必要がある場合、効率性の面から複数のレーザートラッカーを設置し、複数の支持ロボットの位置座標の測定を複数のレーザートラッカーで分担することが行われている。
 この場合、複数のレーザートラッカーが共通の座標系を共有する必要がある。従来、各レーザートラッカーによる共通の座標系の取得は、例えば、コンベヤー上に支持ロボット等と同様に設置された突き当て板に設けられた座標系定義用の3つのリフレクタを各レーザートラッカーによって検出し、検出した3点の座標位置から各々のレーザートラッカーが座標系を定義していた。
特開2017-42881号公報
 しかしながら、上述のような座標系の定義方法では、各レーザートラッカーによる位置測定精度が低下するおそれがある。
 すなわち、座標系を定義するための3つのリフレクタは、相互位置が熱的要因などで大きく変化しないようにする必要があることから、相互距離をそれほど大きくできないという制約がある。レーザートラッカーにおいても、3つのリフレクタの位置から定義される座標系には少なからず誤差が含まれることとなる。
 他方、座標系を定義するための上記リフレクタの相互距離に対して、各レーザートラッカーの相互間距離や支持ロボットの相互間距離は比較的長い。そのため、各レーザートラッカーが定義した座標系間に誤差(特に、角度誤差)が含まれていた場合には、その座標系に基づいて測定された各支持ロボットの測定位置には、座標系に含まれる誤差が増大されて現れることとなり、測定精度を向上させることが難しいという問題があった。
 そして上記のような問題は、特許文献1に開示されたストリンガーを取り扱うシステムに特化した問題ではなく、複数の位置測定器において共通の座標系を共有する必要のあるシステムに共通して現れる問題である。
 本発明は、このような事情に鑑みてなされたものであって、複数の位置測定器によって共通の座標系を共有する必要がある場合に、位置測定器間の座標系の誤差を低減することのできる位置測定システム及び位置測定方法を提供することを目的とする。
 本発明の第一態様は、複数の測定点のうちの一部の測定を行う一の位置測定器と、残りの前記測定点の測定を行う他の位置測定器とを備え、一の前記位置測定器は、測定点の座標系を定義するための3つの座標定義用ターゲットを測定し、3つの前記座標定義用ターゲットの測定結果から前記座標系を定義し、定義した前記座標系を用いて自身に割り当てられた前記測定点の測定を行い、他の前記位置測定器は、予め得ておいた一の前記位置測定器と自身との位置関係に基づく補正ベクトルと、一の前記位置測定器によって定義された前記座標系とを用いて、自身に割り当てられた前記測定点の測定を行う位置測定システムを提供する。
 上記位置測定システムによれば、複数の測定点の位置測定が一の位置測定器と他の位置測定器に分担されて行われる。この場合において、他の位置測定器は複数台設けられていても良い。
 一の位置測定器は、測定点の座標系を定義するための3つの座標定義用ターゲットを測定し、その測定結果から測定点の座標系を定義する。そして、定義した座標系を他の位置測定器と共有する。他の位置測定器は、一の位置測定器によって定義された測定点の座標系と、予め得ておいた一の位置測定器との位置関係に基づく補正ベクトルとを用いて自身における測定点の座標系を作成する。そして、作成した座標系を用いて他の位置測定器も測定点の測定を行う。
 このように、一の位置測定器によって定義された座標系の情報を他の位置測定器とも共有し、この座標系に基づいて一の位置測定器及び他の位置測定器が測定点の測定を行うので、各位置測定器が各々の座標系を定義する場合に比べて、各位置測定器が用いる座標系の誤差を低減することができ、測定点の位置測定精度を向上させることができる。
 上記位置測定システムにおいて、互いに距離をあけて設置された3つの固定ターゲットを一の前記位置測定器及び他の前記位置測定器によって測定し、3つの前記固定ターゲットのそれぞれの測定結果に基づいて、他の前記位置測定器が用いる前記補正ベクトルを算出し、3つの前記固定ターゲットにおけるターゲット相互間距離は、前記測定点の座標系を定義するために用いられる前記座標定義用ターゲットのターゲット相互間距離よりも長く設定されていることが好ましい。
 このように、一の位置測定器及び他の位置測定器がそれぞれ3つの固定ターゲットの位置測定を行うことで、共通の固定ターゲットに基づく座標系における各位置測定器の位置情報を得ることができる。そして、この各自が得た位置情報に基づいて、一の位置測定器に対する他の位置測定器への差分ベクトルを補正ベクトルとして得る。このとき、3つの固定ターゲットにおけるターゲット相互間距離は、測定点の座標系を定義するために用いられる座標定義用ターゲットのターゲット相互間距離も長く設定されているので、各位置測定器が3つの固定ターゲットの測定結果によって定義する位置測定器の座標系の測定期間における誤差(特に、回転角度)を低減することが可能となる。
 上記位置測定システムにおいて、3つの前記固定ターゲットのうち、いずれの前記位置測定器からも最も近い位置にある前記固定ターゲットを用いて座標原点を設定し、他の2つの前記固定ターゲットを用いて直交する2方向の回転を定義することで位置測定器の座標系を定義し、該位置測定器の座標系を用いて前記補正ベクトルを演算することとしてもよい。
 このように、各位置測定器から最も近い位置にある固定ターゲットを用いて位置測定器の座標系の原点を定義するので、各位置測定器が定義する座標系における原点誤差を低減することができる。これにより、補正ベクトルの精度を向上させることが可能となる。
 上記位置測定システムにおいて、一の前記位置測定器の設置位置に対して前記測定点の座標系が移動することとしてもよい。
 上記位置測定システムによれば、一の位置測定器によって定義された測定点の座標系情報を他の位置測定器が共有するので、一の位置測定器の設置位置と測定点とが相対的に移動するような場合であっても、一の位置測定器によって座標定義用ターゲットを測定するだけで、各位置測定器が用いる測定点の座標系を得ることができる。
 本発明の第二態様は、上記記載の位置測定システムによって測定された前記測定点の測定結果を用いてロボットを制御するロボット制御装置である。
 本発明の第三態様は、複数の測定点の測定を複数の位置測定器で分担する位置測定方法であって、一の前記位置測定器によって、前記測定点の座標系を定義するための3つの座標定義用ターゲットを測定する工程と、3つの前記座標定義用ターゲットの測定結果から前記座標系を定義する工程と、定義した前記座標系を用いて、一の前記位置測定器が自身に割り当てられた前記測定点の測定を行う工程と、他の前記位置測定器が、予め得ておいた一の前記位置測定器と自身との位置関係に基づく補正ベクトルと、一の前記位置測定器によって定義された前記座標系とを用いて、自身に割り当てられた前記測定点の測定を行う工程とを有する位置測定方法である。
 本発明によれば、複数の位置測定器によって共通の座標系を共有する必要がある場合に、位置測定器間の座標系の誤差を低減することができるという効果を奏する。
本発明の一実施形態に係る組立装置を示す平面図である。 本発明の一実施形態に係る支持ロボットを模式的に示した概略構成図である。 本発明の一実施形態に係る組立装置を制御する制御装置の機能ブロック図である。 本発明の一実施形態に係る位置測定システムの構成を示した概略構成図である。 本発明の一実施形態に係る位置測定方法の手順を示したフローチャートである。
 以下に、本発明の一実施形態に係る位置測定システム及び位置測定方法について図面を参照して説明する。
 以下の説明では、航空機の胴体や主翼などの航空機部品の構造体を組み立てる際に用いられるロボットの制御に本発明に係る位置測定システム及び位置測定方法を適用する場合を例示して説明するが、本発明はこの例に限定されず、複数の位置測定器によって共通の座標系を共有して複数の測定点の位置座標を測定する場合に、広く適用することが可能である。
 まず、図1を参照して、本実施形態に係る組立装置1の構成について説明する。組立装置1は、搬送装置2と、テーブル3と、複数台の支持ロボット4と、突き当て板5と、取付けロボット6と、把持ロボット11などを備える。
 組立装置1は、長尺部材であるストリンガー10を供給位置20から取り出し、取付位置21まで搬送する。そして、取付位置21にてストリンガー10に対しクリップ22を取り付ける。供給位置20には、クリップ22を取り付ける前のストリンガー10が仮置きされており、取付位置21の近傍には、取付けロボット6及び把持ロボット11が床上に固定して載置されている。
 ストリンガー10は、例えば、航空機の構造用部材であり、約5mから15mの長さを有し、例えば、複曲線状であって立体的な形状を有する。クリップ22は、複数のストリンガー10に接続される長尺状のフレームを結合するための部品である。クリップ22がストリンガー10の長手方向に対し正確な位置で取り付けられることで、複数のストリンガー10に対して一本のフレームを組み付ける際、フレームを撓ませることなく複数のストリンガー10にわたって接続することができる。
 搬送装置2は、通常用いられるものを適用することができ、後述するテーブル3が載置される。搬送装置2は、テーブル3を一端側から他端側へ、他端側から一端側へ移動させる。搬送装置2の一端側は、ストリンガー10の供給位置20の近傍であり、搬送装置2は、テーブル3を供給位置20の近傍から取付けロボット6の近傍へ移動させる。
 取付けロボット6が、ストリンガー10の長手方向に沿って間隔をあけて設定された複数の作業点に対してクリップ22を取り付ける場合、ストリンガー10のある作業点におけるクリップ22の取り付けが完了した後、搬送装置2は所定量移動する。これにより、支持ロボット4がストリンガー10の部品形状を所定の保持形状に維持した状態で把持したまま、ストリンガー10が所定量搬送されることになり、取付けロボット6の位置に次の作業点を移動させることができる。そして、この作業点におけるクリップ22の取付けが完了すると、搬送装置2が所定量移動し、次の作業点が取付けロボット6の位置に移動させられる。そして、このような動作を繰り返すことで、ストリンガー10の長手方向全てにわたって、クリップ22の取り付けが行われる。
 テーブル3には、複数の支持ロボット4と突き当て板5が一列に設置される。これにより、複数の支持ロボット4と突き当て板5が一体的に搬送装置2上を移動する。支持ロボット4は、複数台がテーブル3上に一列に載置され、突き当て板5は、テーブル3の両端、すなわち、複数の支持ロボット4の両側に一つずつ載置される。テーブル3上に載置される支持ロボット4の台数や、支持ロボット4間の距離は、組み立ての対象となるストリンガー10に応じて、予め設定される。ストリンガー10を把持するため稼働する支持ロボット4の台数は、実際に把持するストリンガー10の長さに応じて決定される。図1では、5台の支持ロボット4のうち4台でストリンガー10を把持している様子を示している。
 突き当て板5は、例えば、平板部16を有し、平板部16の面上にストリンガー10の一端が突き当てられる。
 突き当て板5は、ストリンガー10の一端を拘束する構成を有する。これにより、突き当て板5に突き当てられたストリンガー10の一端を、他のクリップ22を取り付ける際の位置決めの基準位置とすることができる。
 突き当て板5は、テーブル3の両端に一つずつ、すなわち、複数の支持ロボット4の両側に一つずつ載置される。ストリンガー10を突き当て板5に接触させる際、二つの突き当て板5のうち一つの突き当て板5のみが用いられる。突き当て板5は、ストリンガー10の基準位置(方向)に応じて選択される。
 突き当て板5は、基準位置を定義するための位置決め部材の一例であり、構成はこの例に限定されない。すなわち、位置決め部材は、基準位置を定義するための機能を有していればよく、例えば、位置決めを行う箇所にピン状の突起が設けた平板上の部材であってもよい。この場合、ストリンガーもしくはストリンガーに固定されている部品に対して予め設けられた穴にピン状の突起を挿入することにより、ストリンガーの一端の位置決めが行われる。
 突き当て板5の平板部16には、図4に示すように、組立装置1の座標系を定義するための座標系定義用ターゲットを構成する少なくとも3つのリフレクタ14-1、14-2、14-3が設けられている。
 レーザートラッカー50は、座標定義用ターゲット14を構成する3つのリフレクタ14-1、14-2、14-3に対してレーザー光を照射し、その反射光を受光することによって、各リフレクタ14-1、14-2、14-3の位置を測定する。そして、3つのリフレクタ14-1、14-2、14-3の位置情報から組立装置1の基準座標系であるワーク座標系を特定する。そして、このワーク座標系を基準に後述する支持ロボット4、取付けロボット6、及び把持ロボット11が備えるハンド部8、17、37の位置及び姿勢を検出する。ワーク座標系の特定方法等についての詳細は後述する。
 支持ロボット4は、図1及び図2に示すように、ストリンガー10を把持する構成を有するハンド部8と、ハンド部8が先端に設けられた腕部9と、腕部9を支持する胴部12などを有する。腕部9及び胴部12は、ハンド部8がストリンガー10を適切に支持できるように、ハンド部8を移動させる構成を有する。腕部9及び胴部12については、通常用いられるロボットの構成を適用できる。
 ハンド部8には、ハンド部8の位置及び姿勢を測定するための測定点30が設けられている。測定点30は、例えば、3つのリフレクタ30a、30b、30cから構成されている。これらリフレクタの位置がレーザートラッカー50によって検出される。このように、3点のリフレクタの位置を検出することにより、ハンド部8の位置だけでなく、姿勢についても検出することが可能となる。レーザートラッカー50によって測定された3つのリフレクタの位置情報は、後述する支持ロボット制御部32(図3)に出力され、支持ロボット4の制御に用いられる。
 取付けロボット6は、図1に示すように、ストリンガー10の長手方向に間隔を置いて設定された複数の作業点に対してクリップ22の取り付けを行うためのハンド部17と、ハンド部17が先端に設けられた腕部18と、腕部18を支持する胴部19などを有する。取付けロボット6は、図1に示すように1台設けられていてもよいし、複数台設けられていてもよい。
 取付けロボット6は、ストリンガー10及びクリップ22をクランプしたり、穴明けしたり、打鋲したりする機能を併せ持っていてもよい。
 取付けロボット6のハンド部17にも、上述した支持ロボット4のハンド部8と同様に、位置及び姿勢を測定するための3つのリフレクタ等からなる測定点(図示略)が設けられている。これら測定点がレーザートラッカー50によって検出されことにより、ハンド部17の位置だけでなく、姿勢についても検出することが可能となる。レーザートラッカー50によって測定された取付けロボット6の位置姿勢は、後述する取付けロボット制御部33(図3)に出力され、取付けロボット6の制御に用いられる。
 把持ロボット11は、ストリンガー10及びクリップ22を把持する構成を有するハンド部37と、ハンド部37が先端に設けられた腕部38と、腕部38を支持する胴部39などを有する。ハンド部37は、ストリンガー10をX方向へ移動させることが可能な構成を有しており、かつ、ストリンガー10のY座標とZ座標を位置決めすることが可能な構成を有する。
 把持ロボット11が、ストリンガー10を適切に支持した後、取付けロボット6、把持ロボット11、又は、別のロボットがストリンガー10とクリップ22をクランプしたり、穴明けしたり、打鋲したりする。
 把持ロボット11のハンド部37にも、上述した支持ロボット4のハンド部8と同様に、位置及び姿勢を測定するための3つのリフレクタ等からなる測定点(図示略)が設けられている。これら測定点がレーザートラッカー50によって検出されことにより、ハンド部37の位置だけでなく、姿勢についても検出することが可能となる。レーザートラッカー50によって測定された把持ロボット11の位置姿勢は、後述する把持ロボット制御部34(図3)に出力され、把持ロボット11の制御に用いられる。
 上記座標系を定義する方法や支持ロボット4等の各種ロボットの位置姿勢を検出する方法は、上記3つのリフレクタを用いた方法に限定されることなく、例えば、6DoFトラッキングデバイス等を使用してもよい。6DoFトラッキングデバイスは、例えば、レーザートラッカーとカメラとを有しており、座標系定義用ターゲットの中央部に設けられたリフレクタにレーザー光を照射し、その反射光を受光することによってリフレクタの位置を測定するとともに、同ターゲットの表面に取り付けられた1または複数のLEDをカメラで撮像して画像処理することにより、3次元の直交座標系を定義したり、各種ロボットの位置姿勢を検出することとしてもよい。
 組立装置1を制御する制御装置35は、図3に示すように、例えば、搬送装置制御部31と、支持ロボット制御部32と、取付けロボット制御部33と、把持ロボット制御部34などを備える。
 制御装置35は、例えば、CPU(Central Processing Unit)、RAM(Random Access Memory)、ROM(Read Only Memory)、及びコンピュータ読み取り可能な記憶媒体等を備えている。そして、各種機能を実現するための一連の処理は、一例として、プログラムの形式で記憶媒体等に記憶されており、このプログラムをCPUがRAM等に読み出して、情報の加工・演算処理を実行することにより、各種機能が実現される。プログラムは、ROMやその他の記憶媒体に予めインストールしておく形態や、コンピュータ読み取り可能な記憶媒体に記憶された状態で提供される形態、有線又は無線による通信手段を介して配信される形態等が適用されてもよい。コンピュータ読み取り可能な記憶媒体とは、磁気ディスク、光磁気ディスク、CD-ROM、DVD-ROM、半導体メモリ等である。
 搬送装置制御部31は、ストリンガー10の所定の領域が取付位置21に移動するように搬送装置2の位置を調節する。搬送装置制御部31は、ストリンガー10の長手方向に間隔を置いて設けられた複数の作業点が取付けロボット6の取付位置に順次来るように搬送装置2の移動を制御する。搬送装置制御部31は、例えば、後述する支持ロボット制御部32に含まれていてもよい。すなわち、後述する支持ロボット制御部32が、搬送装置2の移動制御を行うこととしてもよい。
 支持ロボット制御部32は、後述するレーザートラッカー50によって取得された支持ロボット4のハンド部8の測定点30の位置情報に基づいて、ハンド部8を移動させる。支持ロボット制御部32は、ストリンガー10の端部を突き当て板5に当接させる。支持ロボット制御部32は、ストリンガー10の原形状に基づいて、複数の支持ロボット4のハンド部8を移動させる。
 取付けロボット制御部33は、支持ロボット制御部32等と同様に、図示しないレーザートラッカーなどによって取得された位置情報に基づいてハンド部17を移動させる。取付けロボット制御部33は、ストリンガー10に対し他のクリップ22を取り付けるようにハンド部17を動作させる。取付けロボット制御部33は、ハンド部17に対し、ストリンガー10とクリップ22にクランプや穴明けや打鋲させる。但し、本機能は、後述する把持ロボット制御部34、又は、別のロボットの制御部が実施してもよい。
 把持ロボット制御部34についても、図示しないレーザートラッカーなどによって取得された位置情報に基づいてハンド部37の移動などの各種制御を行う。
 レーザートラッカー50は、搬送装置制御部31、支持ロボット制御部32、取付けロボット制御部33、及び把持ロボット制御部34からの指令を受けて、支持ロボット4等の各種ロボットの位置姿勢等を検出し、検出した位置姿勢をこれら各制御部31~34に送信することとしてもよい。すなわち、レーザートラッカー50についても各制御部31~34の制御対象とされていてもよい。
 次に、本発明の一実施形態に係る位置測定システム100について図4を参照して説明する。本実施形態に係る位置測定システム100は、複数のレーザートラッカー(位置測定器)50を備えている。本実施形態においては、3台のレーザートラッカー50-1、50-2、50-3を備える場合を例示しているが、レーザートラッカーは2台以上設けられていればよい。以下の説明において、各レーザートラッカー50-1、50-2、50-3をそれぞれ区別する必要がある場合には、レーザートラッカー50-1、50-2、50-3と称し、区別する必要がない場合には、単にレーザートラッカー50と称する。他の構成についても同様の取り扱いとする。
 レーザートラッカー50は、リフレクタに対してレーザー光を照射し、リフレクタからの反射光を受光することにより、リフレクタの座標位置を検出するものである。
 本実施形態に係る位置測定システム100は、例えば、各支持ロボット4のハンド部8にそれぞれ設けられた複数の測定点30の測定を複数のレーザートラッカー50で分担するものである。
 ここで、複数のレーザートラッカー50によって複数の測定点30の位置測定を分担する場合、レーザートラッカー50間で共通の座標系を共有する必要がある。したがって、まずは、共通の座標系を各レーザートラッカー50で定義し、これらを共有する工程が必要である。
 以下、共有の座標系の定義方法について図4を参照して詳しく説明する。
 まず、各レーザートラッカー50-1、50-2、50-3は、それぞれ3つの固定ターゲット40-1、40-2、40-3の位置を測定する。ここで、3つの固定ターゲット40は、互いに距離をあけて設置されている。ここで、各固定ターゲット40の相互距離は、後述する座標定義用ターゲット14の相互距離よりも長くなるように設置され、かつ、いずれのレーザートラッカー50からも測定可能な位置に設けられている。
 各固定ターゲット40の相互距離は、例えば、レーザートラッカー50によって測定される測定点の移動距離よりも長く設定されていることが好ましい。本実施形態では、ストリンガー10の移動からクリップ22を取り付けるまでの一連の作業を完了させるまでの搬送装置の移動距離よりも長く設定されていることが好ましい。
 このように、固定ターゲット40の相互距離をできるだけ長くとることにより、レーザートラッカー50による位置測定の誤差を低減することができる。
 3つの固定ターゲット40のうちの一つは、いずれのレーザートラッカー50からも近い位置に設置されるとよい。
 例えば、各レーザートラッカー50によってそれぞれ3点の固定ターゲット40の位置を検出することにより、各レーザートラッカー50が設置されている空間の座標系(x,y,z)を定義する。以下、この座標系を「測定器座標系A」という。
 そして、測定器座標系A(x,y,z)における各レーザートラッカー50の座標位置を得る。ここで、測定器座標系Aを定義する際、いずれのレーザートラッカー50からも最も近い位置に設置された固定ターゲット40の位置を測定器座標系Aの原点として定めるとよい。これにより、各レーザートラッカー50における原点の座標位置における誤差を低減することが可能となる。換言すると、3つの固定ターゲット40を設置する際に、そのうちの一つについてはいずれのレーザートラッカー50からも近い位置に設置するとよい。図4に示した3つの固定ターゲット40の中では、原点を定めるための固定ターゲットとして固定ターゲット40-1を用いることが好ましい。
 このようにして測定器座標系Aが定まると、その測定器座標系Aにおける各レーザートラッカー50の位置座標を特定することができる。例えば、測定器座標系A(x,y,z)におけるレーザートラッカー50-1の位置座標をA(xa1,ya1,za1)、レーザートラッカー50-2の位置座標をA(xa2,ya2,za2)、レーザートラッカー50-3の位置座標をA(xa3,ya3,za3)と定義する。
 続いて、各レーザートラッカー50-1、50-2、50-3の位置座標から相互位置関係を算出する。例えば、複数のレーザートラッカー50のうち、一つのレーザートラッカーを基準として定め、基準として定めたレーザートラッカー(一の位置測定器)に対する他のレーザートラッカー(他の位置測定器)の位置ベクトルを算出する。換言すると、基準としたレーザートラッカー50の位置座標と他のレーザートラッカー50の位置座標との差分ベクトルを得る。この位置ベクトル(差分ベクトル)が後述する補正ベクトルとして用いられる。
 例えば、レーザートラッカー50-1を基準として定めた場合、レーザートラッカー50-1に対するレーザートラッカー50-2の位置ベクトルA -1を算出するとともに、レーザートラッカー50-1に対するレーザートラッカー50-3の位置ベクトルA -1を算出する。
 ここで、基準とするレーザートラッカー50は、例えば、後述する座標定義用ターゲット14に最も近い位置にあるレーザートラッカー、図4においては、レーザートラッカー50-1とすることが好ましい。これにより、複数のレーザートラッカー50によって複数の測定点を分担して測定する際に用いる共通の空間座標系に含まれる誤差を低減することが可能となる。
 次に、基準としたレーザートラッカー50によって座標定義用ターゲット14の位置を検出することにより、測定対象となる支持ロボット4が設置された共通の座標系(x,y,z)を定義する。以下、この座標系(x,y,z)を上記測定器座標系Aと区別するために「ワーク座標系B」という。
 例えば、突き当て板5の平板部16には、座標定義用ターゲットとして3つのリフレクタ14-1、14-2、14-3が設置されている。基準とされたレーザートラッカー50-1によって座標定義用ターゲットであるリフレクタ14-1、14-2、14-3のそれぞれを測定することにより、搬送装置2上に設置されている構成(複数の支持ロボット4、突き当て板5等)に共通のワーク座標系B(x,y,z)が定義される。
 レーザートラッカー50-1は、座標定義用ターゲット14の測定位置から定義したワーク座標系Bを他のレーザートラッカー50-2、50-3と共有する。例えば、レーザートラッカー50-1は、ワーク座標系Bにおける自身(レーザートラッカー50-1)の位置座標B(xb1,yb1,zb1)を他のレーザートラッカー50-2、50-3に対して送信する。
 他のレーザートラッカー50-2、50-3は、予め得ておいた補正ベクトルと、レーザートラッカー50-1から取得したワーク座標系Bとを用いて、自身が用いるワーク座標系Bを定義し、定義したワーク座標系Bを用いて自身に割り当てられた測定点30の測定を行う。
 レーザートラッカー50-1は、測定器座標系Aからワーク座標系Bへの座標変換行列Wを演算し、この座標変換行列Wの情報を他のレーザートラッカー50-1、50-3に対して送信してもよい。
 例えば、座標変換行列Wは、以下の(1)式で表される。
 W=BC   (1)
 ここで、Cは座標定義用ターゲット14の原点からワーク座標系Bの原点までのベクトルであり、既知の行列である。
 他のレーザートラッカー50-2、50-3は、予め得ておいた補正ベクトルと、レーザートラッカー50-1の座標変換行列Wを用いて、それぞれ座標変換行列W、Wを演算する。レーザートラッカー50ー2の座標変換行列W、レーザートラッカー50ー3の座標変換行列Wはそれぞれ以下の(2)式、(3)式で表される。
 W=(A -1-1=(A -1-1C  (2)
 W=(A -1-1=(A -1-1C  (3)
 そして、他のレーザートラッカー50-2、50-3は、上記座標変換行列W、Wを用いて、自身が測定した各測定点30の測定座標を変換することにより、ワーク座標系Bにおける各測定点30の測定座標を得る。
 各レーザートラッカー50に対する測定点の割り当てについては、予め設定しておいてもよいし、搬送装置2の移動距離と各レーザートラッカー50との相対的な位置関係に基づいて、各測定点30に最も近いであろうと推定されるレーザートラッカーを用いて測定を行うこととしてもよい。
 このようにして各レーザートラッカー50を用いて測定された各測定点30の位置座標の情報は、支持ロボット制御部32(図3参照)に送信される。支持ロボット制御部32は、各測定点30の位置情報、すなわち、支持ロボット4のハンド部8の位置及び傾きに基づいて、支持ロボット4のハンド部8の位置制御を行う。
 次に、本実施形態に係る位置測定システム100による位置測定方法について図5を参照して説明する。
 まず、組立装置1の動作開始時において、各レーザートラッカー50は固定ターゲット40-1、40-2、40-3の位置を測定する(SA1)。これにより、測定器座標系Aにおける各レーザートラッカー50-1、50-2、50-3の位置座標が得られる。
 続いて、基準となるいずれか一つのレーザートラッカー50(例えば、レーザートラッカー50-1)を定め、基準として定めたレーザートラッカーに対する他のレーザートラッカー(例えば、レーザートラッカー50-2、50-3)の位置ベクトルを補正ベクトルとして算出する(SA2)。この補正ベクトルは、例えば、各レーザートラッカー50が備える記憶部(図示略)に記憶される。
 次に、基準としたレーザートラッカー50(例えば、レーザートラッカー50-1)によって座標定義用ターゲット14の位置が検出され(SA3)、ワーク座標系Bにおけるレーザートラッカー50-1の位置座標Bが得られる(SA4)。
 基準のレーザートラッカー50-1は、他のレーザートラッカー50-2、50-3に対して位置座標Bを送信する。これにより、全てのレーザートラッカー50において、位置座標Bが共有される(SA5)。
 他のレーザートラッカー50-2、50-3は、位置座標Bを受信すると、先に登録しておいた補正ベクトルを用いて、ワーク座標系Bにおける自身の位置座標B、Bを得る。例えば、測定器座標系Aからワーク座標系Bに変換するための座標変換行列を得る(SA6)。
 このようにして、各レーザートラッカー50がそれぞれ座標変換行列を得ると、各座標変換行列を用いて測定点30の測定を行い(SA7)、支持ロボット制御部32に測定結果を出力する(SA8)。
 続いて、搬送装置2が動くことにより、座標定義用ターゲット14の位置が移動したか否かを判定する(SA9)。座標定義用ターゲット14の位置が移動していなければ(SA9:NO)、組立装置1の運転が停止されたか否かを判定する(SA10)。この結果、運転が停止された場合には(SA10:YES)、当該処理を終了する。
 一方、運転が停止されていなかった場合には(SA10:NO)、ステップSA7に戻り、繰り返し測定点30の測定を行う。
 一方、ステップSA9において、搬送装置2が移動することにより、座標定義用ターゲット14の位置が移動していた場合には、ステップSA3に戻り、移動後の座標定義用ターゲット14の位置が、基準となるレーザートラッカー50-1によって再度測定され(SA3)、ワーク座標系Bが更新される(SA4)。そして、更新されたワーク座標系Bを用いて以降の処理が行われる。
 以上説明したように、本実施形態に係る位置測定システム及び位置測定方法によれば、例えば、レーザートラッカー(一の位置測定器)50-1によって定義されたワーク座標系の情報を他のレーザートラッカー(他の位置測定器)50-2、50-3とも共有し、このワーク座標系Bに基づいて各レーザートラッカー50が自身に割り当てられた支持ロボット4の測定点30の測定を行うので、各レーザートラッカー50が座標定義用ターゲット14の位置を測定することによってワーク座標系Bを個別に定義する場合に比べて、各レーザートラッカー50が用いる座標系の誤差を低減することができる。この結果、測定点の位置測定精度を向上させることができる。
 更に、本実施形態によれば、各レーザートラッカー50が測定器座標系Aを定義するために用いる3つの固定ターゲット40-1、40-2、40-3の相互間距離を座標定義用ターゲット14よりも長くとることができるので、各レーザートラッカー50が定義する測定器座標系Aに含まれるレーザートラッカー間誤差(特に、回転角度)を低減することが可能となる。これにより、補正ベクトルを比較的高い精度で得ることができ、これに基づいて定義される共通のワーク座標系Bに含まれる誤差を低減することが可能となる。
 更に、いずれのレーザートラッカー50からも最も近い位置にある固定ターゲット40を用いて測定器座標系Aの原点を定義するので、各レーザートラッカー50が定義する測定器座標系Aにおける原点誤差を低減することができる。これにより、補正ベクトルの精度を更に向上させることが可能となる。
 本実施形態によれば、一のレーザートラッカー50-1によって定義されたワーク座標系Bの情報を他のレーザートラッカー50-2、50-3において共有するので、レーザートラッカー50-1に対して相対的にワーク座標系Bが移動するような場合であっても、一つのレーザートラッカー50によって座標定義用ターゲット14を測定するだけで、各レーザートラッカー50が用いるワーク座標系Bを得ることができる。
 以上、本発明について実施形態を用いて説明したが、本発明の技術的範囲は上記実施形態に記載の範囲には限定されない。発明の要旨を逸脱しない範囲で上記実施形態に多様な変更又は改良を加えることができ、該変更又は改良を加えた形態も本発明の技術的範囲に含まれる。上記実施形態を適宜組み合わせてもよい。
 上記実施形態で説明した位置測定方法の流れも一例であり、本発明の主旨を逸脱しない範囲内において不要なステップを削除したり、新たなステップを追加したり、処理順序を入れ替えたりしてもよい。
1 組立装置
2 搬送装置
3 テーブル
4 支持ロボット
5 突き当て板
6 取付けロボット
10 ストリンガー
11 把持ロボット
14 座標定義用ターゲット
14-1、14-2、14-3 リフレクタ
22 クリップ
30 測定点
31 搬送装置制御部
32 支持ロボット制御部
33 取付けロボット制御部
34 把持ロボット制御部
35 制御装置
40(40-1、40-2、40-3) 固定ターゲット
50(50-1、50-2、50-3) レーザートラッカー
100 位置測定システム

Claims (7)

  1.  複数の測定点のうちの一部の測定を行う一の位置測定器と、
     残りの前記測定点の測定を行う他の位置測定器と
    を備え、
     一の前記位置測定器は、測定点の座標系を定義するための3つの座標定義用ターゲットを測定し、3つの前記座標定義用ターゲットの測定結果から前記座標系を定義し、定義した前記座標系を用いて自身に割り当てられた前記測定点の測定を行い、
     他の前記位置測定器は、予め得ておいた一の前記位置測定器と自身との位置関係に基づく補正ベクトルと、一の前記位置測定器によって定義された前記座標系とを用いて、自身に割り当てられた前記測定点の測定を行う位置測定システム。
  2.  互いに距離をあけて設置された3つの固定ターゲットを一の前記位置測定器及び他の前記位置測定器によって測定し、3つの前記固定ターゲットの測定結果に基づいて、他の前記位置測定器が用いる前記補正ベクトルを算出し、
     3つの前記固定ターゲットにおけるターゲット相互間距離は、前記測定点の座標系を定義するために用いられる前記座標定義用ターゲットのターゲット相互間距離よりも長く設定されている請求項1に記載の位置測定システム。
  3.  3つの前記固定ターゲットのうち、いずれの前記位置測定器からも最も近い位置にある前記固定ターゲットを用いて座標原点を設定し、他の2つの前記固定ターゲットを用いて直交する2方向の回転を定義することで位置測定器の座標系を定義し、該位置測定器の座標系を用いて前記補正ベクトルを演算する請求項2に記載の位置測定システム。
  4.  一の前記位置測定器の設置位置に対して、前記測定点の座標系が移動する請求項1から3のいずれかに記載の位置測定システム。
  5.  他の前記位置測定器は複数台設けられている請求項1から4のいずれかに記載の位置測定システム。
  6.  請求項1から請求項5のいずれかに記載の位置測定システムによって測定された前記測定点の測定結果を用いてロボットを制御するロボット制御装置。
  7.  複数の測定点の測定を複数の位置測定器で分担する位置測定方法であって、
     一の前記位置測定器によって、前記測定点の座標系を定義するための3つの座標定義用ターゲットを測定する工程と、
     3つの前記座標定義用ターゲットの測定結果から前記座標系を定義する工程と、
     定義した前記座標系を用いて、一の前記位置測定器が自身に割り当てられた前記測定点の測定を行う工程と、
     他の前記位置測定器が、予め得ておいた一の前記位置測定器と自身との位置関係に基づく補正ベクトルと、一の前記位置測定器によって定義された前記座標系とを用いて、自身に割り当てられた前記測定点の測定を行う工程と
    を有する位置測定方法。
     
PCT/JP2019/040312 2018-11-21 2019-10-11 位置測定システム及び位置測定方法 WO2020105311A1 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
US17/282,009 US20210333092A1 (en) 2018-11-21 2019-10-11 Position measurement system and position measurement method

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018-218425 2018-11-21
JP2018218425A JP2020085596A (ja) 2018-11-21 2018-11-21 位置測定システム及び位置測定方法

Publications (1)

Publication Number Publication Date
WO2020105311A1 true WO2020105311A1 (ja) 2020-05-28

Family

ID=70774244

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/040312 WO2020105311A1 (ja) 2018-11-21 2019-10-11 位置測定システム及び位置測定方法

Country Status (3)

Country Link
US (1) US20210333092A1 (ja)
JP (1) JP2020085596A (ja)
WO (1) WO2020105311A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112146569A (zh) * 2020-08-27 2020-12-29 北京天瑞星光热技术有限公司 一种多立柱位置确定方法、装置及计算机设备

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113895646B (zh) * 2021-10-26 2023-08-04 成都飞机工业(集团)有限责任公司 面向飞机部件调姿对接的自动测量方法及装置
CN114252010B (zh) * 2021-12-10 2023-10-27 天津航天长征火箭制造有限公司 一种运载火箭舱段功能组件高精度柔性协调装配方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014033823A1 (ja) * 2012-08-28 2014-03-06 株式会社日立製作所 計測システム、計測方法
JP2015221489A (ja) * 2014-04-30 2015-12-10 ザ・ボーイング・カンパニーTheBoeing Company アセンブリ位置決めのための計測システム
JP2017226023A (ja) * 2016-06-20 2017-12-28 三菱重工業株式会社 ロボット制御システム及びロボット制御方法
JP2018109552A (ja) * 2016-12-29 2018-07-12 三菱電機株式会社 アライメント測定システム及びアライメント測定方法
WO2018185893A1 (ja) * 2017-04-05 2018-10-11 株式会社ニコン 未測定領域抽出装置、作業ガイダンス装置、および作業ガイダンス方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103591891B (zh) * 2013-11-20 2015-04-29 天津大学 室内空间测量定位系统的精密控制场精度溯源方法
US10126115B2 (en) * 2014-09-18 2018-11-13 Nec Corporation Triangulation device, triangulation method, and recording medium recording program therefor
GB2554687B (en) * 2016-10-04 2020-02-12 Rolls Royce Plc Computer implemented methods for determining a dimension of a gap between an aerofoil and a surface of an engine casing

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014033823A1 (ja) * 2012-08-28 2014-03-06 株式会社日立製作所 計測システム、計測方法
JP2015221489A (ja) * 2014-04-30 2015-12-10 ザ・ボーイング・カンパニーTheBoeing Company アセンブリ位置決めのための計測システム
JP2017226023A (ja) * 2016-06-20 2017-12-28 三菱重工業株式会社 ロボット制御システム及びロボット制御方法
JP2018109552A (ja) * 2016-12-29 2018-07-12 三菱電機株式会社 アライメント測定システム及びアライメント測定方法
WO2018185893A1 (ja) * 2017-04-05 2018-10-11 株式会社ニコン 未測定領域抽出装置、作業ガイダンス装置、および作業ガイダンス方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112146569A (zh) * 2020-08-27 2020-12-29 北京天瑞星光热技术有限公司 一种多立柱位置确定方法、装置及计算机设备

Also Published As

Publication number Publication date
JP2020085596A (ja) 2020-06-04
US20210333092A1 (en) 2021-10-28

Similar Documents

Publication Publication Date Title
WO2020105311A1 (ja) 位置測定システム及び位置測定方法
WO2020066102A1 (ja) ロボットの教示作業支援システム及び教示作業支援方法
JP5290324B2 (ja) 空間内において少なくとも1つのオブジェクトを最終姿勢に高精度で位置決めするための方法およびシステム
US7684898B2 (en) Method for calibrating a tool center point of tools for industrial robots
USRE45391E1 (en) Method and an apparatus for performing a program controlled process on a component
JP5129910B2 (ja) ロボットを較正する方法及び装置
JP6498568B2 (ja) 組立体製造装置及び組立体製造方法
JP7145851B2 (ja) 作業システム
US10302425B2 (en) Measurement system and method for measuring an angle
HUT50447A (en) Method and apparatus for surface coating workpieces in large series
JP6563271B2 (ja) 組立体製造装置及び組立体製造方法
JPWO2018092243A1 (ja) 作業位置補正方法および作業ロボット
JP6629001B2 (ja) 組立体製造装置及び組立体製造方法
CN110978056B (zh) 机器人运动的平面校准系统及方法
US11365959B2 (en) Three-dimensional measuring system, and three-dimensional measuring method
Kinugawa et al. PaDY: Human-friendly/cooperative working support robot for production site
CN107530843A (zh) 组装体制造装置以及组装体制造方法
JP2019058968A (ja) 計測システム
JPWO2018092236A1 (ja) 作業ロボットおよび作業位置補正方法
JP6031368B2 (ja) ワークとの相関位置決め方法
US11858147B2 (en) Substrate transfer robot and method of detecting optical-axis deviation of substrate hold hand
CN116067302A (zh) 基于激光扫描的管件三维尺寸全域扫描检测系统及方法
JP7296252B2 (ja) ロボット制御システムおよび方法
WO2021060227A1 (ja) 高さ補正システム
WO2021060228A1 (ja) 高さ補正システム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19886886

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19886886

Country of ref document: EP

Kind code of ref document: A1