WO2018120140A1 - Location marking device - Google Patents

Abstract

A location marking device, comprising a first sensor assembly (10) for detecting whether a robotic tool (701) has reached pre-configured first coordinates; a second sensor assembly (20) for detecting whether the robotic tool (701) has reached pre-configured second coordinates; and a control assembly (30) for determining whether the robotic tool (701) has reached a pre-configured location point. The location marking device uses the combined operations of the first sensor assembly (10) and second sensor assembly (20), and uses the first coordinates and second coordinates to accurately determine whether the robotic tool (701) has reached a certain location point, thereby achieving more accurate marking of a tool coordinate system of a robot (70) and ensuring precision of the trajectory of the robot (70).

Description

Position calibration device

[Technical Field]

The present invention relates to the field of robot technology, and in particular, to a position calibration device.

 【Background technique】

In modern manufacturing technology, industrial robots are gradually applied in the operations of making holes, riveting and assembling parts such as airplanes and automobiles. Through industrial robots, production efficiency can be greatly improved, product quality and consistency can be ensured, and production cycles can be shortened. The application of industrial robots has become a new trend in industrial automation. Industrial robots perform various tasks by installing different tools at the end, and the accuracy of the tool coordinate system of each tool directly affects the trajectory accuracy of the robot.

At present, the calibration of most industrial robot tool coordinate systems adopts the tool verification method, that is, the robot touches a certain position point with different postures, records the change matrix of the end coordinate system to the base coordinate system in different postures, and calculates the tool center point. Relative to the position of the end coordinate system. The detection methods of the detection robot touching a certain point in different postures mainly include: 1) visually determining whether the tool tip is in contact with the fixed point; 2) using a laser tracker to determine whether to contact the fixed point; 3) using an industrial camera Help determine if it is in contact with a fixed point. Among them, the first method will produce a large error due to various factors such as the light environment and the operator's vision; the second and third methods can improve the accuracy of the judgment, but the cost is very high, in many It is not practical in the case.

 [Summary of the Invention]

The technical problem mainly solved by the present invention is to provide a position calibration device capable of accurately calibrating the tool coordinate system of the robot and ensuring the trajectory accuracy of the robot.

In order to solve the above technical problem, a technical solution adopted by the present invention is to provide a position calibration device, including:

a first sensing component sensing whether the robot tool reaches a predetermined first coordinate;

a second sensing component sensing whether the robot tool reaches a predetermined second coordinate;

a control component electrically connected to the first sensing component and the second sensing component, wherein the first sensing component senses that the robot tool reaches a predetermined first coordinate, and the second transmission When the sensing component senses that the robot tool reaches a predetermined second coordinate, determining that the robot tool has reached a predetermined position point; wherein the first coordinate and the second coordinate together constitute a three-dimensional position of the position point coordinate.

The first coordinate is a two-dimensional coordinate of the three-dimensional coordinates of the position point, and the second coordinate is another one-dimensional coordinate of the three-dimensional coordinate of the position point.

Wherein at least one of the first sensing component and the second sensing component is a non-contact sensing component.

The first sensing component includes a photoelectric sensing component, and the photoelectric sensing component includes a light source emitter and a light sensor, and the light source emitter is spaced apart from the light sensor;

Wherein, the light source emitter emits a light beam having a diffusion angle smaller than a predetermined value, and when the light sensor does not sense the light beam, the control component determines that the robot tool reaches a predetermined first coordinate.

Wherein the second sensing component comprises a displacement sensor, one end of the displacement sensor being fixed relative to the light source emitter or the light sensor, when the robot tool reaches a predetermined first coordinate and along the light beam When the direction pushes the light source emitter or the light sensor to move to a predetermined position, the control component determines that the robot tool reaches a predetermined second coordinate.

Wherein, the device further comprises:

An upper base, the light source emitter is fixed to a center of an upper surface of the upper base, and is covered by a transparent casing; the displacement sensor is fixed to a center of a lower surface of the upper base;

Lower base

The guiding rod is vertically disposed between the lower surface of the upper base and the upper surface of the lower base, and one end of the guiding rod is fixed to the upper surface of the lower base.

The control component further includes a first indicator light and a second indicator light, and when it is determined that the robot tool reaches a predetermined first coordinate, controlling the first indicator light to emit light, and determining that the robot tool arrives The second indicator light is controlled to emit light when the second coordinate is predetermined.

The control component is electrically coupled to the control cabinet of the robot. When the control component determines that the robot tool reaches a predetermined first coordinate, the control component issues an instruction to the control cabinet of the robot. Controlling the robot tool to push the upper base to move along the beam direction, and when the control component determines that the robot tool reaches a predetermined second coordinate, the control component issues an instruction to the robot The cabinet controls the robot tool to stop moving.

Optionally, the two ends of the guiding rod are respectively fixed to the upper surface of the upper base and the upper surface of the lower base;

The middle of the guiding rod is provided with a partition, and a reset spring is disposed on the sleeve for resetting the upper base after the position calibration is completed;

The guide bars have at least two.

Optionally, the upper surface of the upper base is provided with a hole or a groove having an inner diameter matching the outer diameter of the guide rod, and the other end of the guide rod penetrates the hole or the groove such that the upper base is at Sliding on the guide rod;

The guide rod is sleeved with a spring for resetting the upper base after the position calibration is completed;

The guide bars have at least two.

Wherein the device further comprises a housing for protecting the first sensing component and the second sensing component.

The invention provides a position calibration device, by using the cooperation of the first sensing component and the second sensing component, using the first coordinate and the second coordinate to accurately determine whether the robot reaches a certain position, thereby Accurately calibrate the robot's tool coordinate system to ensure the trajectory accuracy of the robot.

 [Description of the Drawings]

1 is a schematic structural view of an embodiment of a position calibration device of the present invention;

Figure 2 is a bottom cross-sectional view showing an embodiment of the position calibration device of the present invention;

3 is a schematic structural view of an embodiment of a position calibration device of the present invention;

4 is a schematic structural view of a control component of an embodiment of a position calibration device of the present invention;

Figure 5 is a cross-sectional view showing a guide rod of an embodiment of the position calibration device of the present invention;

Figure 6 is a schematic structural view of an embodiment of a position calibration device of the present invention;

Figure 7 is a schematic structural view of another embodiment of the position calibration device of the present invention;

Figure 8 is a block diagram showing another embodiment of the position calibration device of the present invention.

【detailed description】

The technical solutions in the embodiments of the present invention are clearly and completely described in the following with reference to the accompanying drawings in the embodiments of the present invention. It is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative efforts are within the scope of the present invention.

Referring to FIG. 1, an embodiment of a position calibration device of the present invention includes:

The first sensing component 10 senses whether the robot tool reaches a predetermined first coordinate;

a second sensing component 20 sensing whether the robot tool reaches a predetermined second coordinate;

The control component 30 is electrically connected to the first sensing component 10 and the second sensing component 20, and the first sensing component 10 senses that the robot tool reaches a predetermined first coordinate, and the second sensing component 20 senses When the robot tool reaches the predetermined second coordinate, it is determined that the robot tool has reached a predetermined position point; wherein the first coordinate and the second coordinate together constitute a three-dimensional coordinate of the position point.

In this embodiment, the first coordinate is one of two-dimensional coordinates in the three-dimensional coordinates of the position point, and the second coordinate is another one-dimensional coordinate in the three-dimensional coordinates of the position point. At least one of the first sensing component 10 and the second sensing component 20 is a non-contact sensing component.

In this embodiment, the first sensing component 10 includes a photoelectric sensing component, and the photoelectric sensing component includes a light source emitter 101 and a light sensor 102. The light source emitter 101 is spaced apart from the light sensor 102; wherein the light source emits The device 101 emits a light beam having a diffusion angle smaller than a predetermined value. When the light sensor 102 does not sense the light beam, the control unit 30 determines that the robot tool reaches the predetermined first coordinate.

The second sensing component 20 includes a displacement sensor. One end of the displacement sensor is fixed relative to the light source emitter 101. When the robot tool reaches a predetermined first coordinate and pushes the light source emitter 101 to move to a predetermined position along the beam direction, the control component 30 determines. The predetermined second coordinate is reached for the robot tool.

In an embodiment, the light source emitter 101 may also be a laser emitter or other sensor capable of positioning the first coordinate; the displacement sensor may also be a distance measuring or sensing sensor such as a light spot sensor or a pressure sensor.

Referring to FIG. 1 to FIG. 2, the embodiment of the position calibration apparatus of the present invention further includes:

The upper base 40, the light source emitter 101 is fixed to the center of the upper surface of the upper base 40, and is covered by a transparent casing 401; the displacement sensor 20 is fixed to the center of the lower surface of the upper base 40;

Lower base 50;

The guiding rod 60 is vertically disposed between the lower surface of the upper base 40 and the upper surface of the lower base 50, and one end of the guiding rod 60 is fixed to the upper surface of the lower base 50.

Optionally, the position of the light source emitter and the light sensor are interchangeable, that is, the light sensor is disposed at the center of the upper surface of the upper base 40, and the light source emitter is disposed at a position outside the upper base 40 corresponding to the light sensor. .

Referring to FIG. 3 to FIG. 4, the control component 30 further includes a first indicator light 301 and a second indicator light 302. When it is determined that the robot tool 701 reaches the predetermined first coordinate, the first indicator light 301 is controlled to emit light, and the robot is determined to be When the tool 701 reaches the predetermined second coordinate, the second indicator light 302 is controlled to emit light.

Referring to FIG. 1 to FIG. 4, the control component 30 is electrically coupled to the control cabinet 80 of the robot. When the control component 30 determines that the robot tool 701 reaches the predetermined first coordinate, the control component 30 issues an instruction to the control cabinet 80 of the robot to control. The robot tool 701 pushes the upper base 40 to move in the direction of the beam. When the control assembly 30 determines that the robot tool 701 has reached the predetermined second coordinate, the control unit 30 issues an instruction to the control cabinet 80 of the robot to control the robot tool 701 to stop moving.

In the present embodiment, the light source emitter 101 at the center of the upper surface of the upper base 40 emits a light beam having a diffusion angle smaller than a predetermined value, passes through the transparent casing 401, is received by the light sensor 102, and is formed on the transparent casing 401. A light spot. The robot 70 moves from the direction to the calibration device from any direction, so that the light beam emitted from the robot tool 701 to the light source emitter 101 approaches, and when the robot tool 701 will contact the light spot (the naked eye determines that the robot tool 701 is in contact with the light spot, it is not necessarily Contacting) blocks the light beam. When the light sensor does not sense the light beam, the control component 30 determines that the robot tool 701 reaches the predetermined first coordinate, controls the first indicator light 301 to emit light, and issues an instruction to the IO of the robot control cabinet 80. The end moves the upper base 40 in the direction of the beam by the control robot tool 701; when the displacement sensor 101 detects that the robot tool 701 pushes the upper base 40 to move by a predetermined distance, the control component 30 determines that the robot tool 701 reaches the predetermined second coordinate, The second indicator light 302 is controlled to emit light, and an instruction is issued to the IO end of the robot control cabinet 80 to control the robot tool 701 to stop moving to complete the position calibration. The movement of the robot tool 701 in the direction of the beam reaches the second coordinate in order to eliminate possible gaps between the robot 70 and the upper base 40. After each calibration is completed, the guide bar 60 resets the upper base 40 and waits for the next calibration.

Alternatively, control component 30 can send control commands via the PLC of robot control cabinet 80.

Alternatively, the robot control cabinet 80 may be disposed on the robot 70, and the control assembly 30 may also be disposed on the upper base 40 or the lower base 50 of the calibration device.

Referring to Figures 1, 2 and 5, there are at least two guide rods 60. In the present embodiment, four guide rods 60 are provided, and are evenly distributed around the displacement sensor 20, and the ends of the guide rods 60 are fixed. The upper surface of the upper base 40 and the upper surface of the lower base 50. The guide rod 60 includes an intermediate fixing rod and an outer spring. The middle portion of the fixing rod is provided with a partition to provide a space for the upper base 40 to move; and an external spring is used to reset the upper base 40 after the position calibration is completed.

Referring to Figures 1 and 6, the position calibration device further includes a housing 90, the upper base 40, the guide rod 60 and the lower base 50 are disposed within the housing 90, for the first sensing assembly 10 and the second sensing assembly 20 To protection.

Referring to FIG. 7, another embodiment of the position calibration device of the present invention includes:

a first sensing component 10, a second sensing component 20, a control component 30, an upper base 400, a lower base 50, and a guide bar 600, wherein the first sensing component 10, the second sensing component 20, and the control component 30 The structure and function of the lower base 50 are the same as those of the first sensing component, the second sensing component, the control component and the lower base in the above embodiment of the position calibration device, and are not described herein again.

In the present embodiment, four guide bars 600 are disposed, and are evenly distributed around the displacement sensor 20; the lower surface of the upper base 400 is provided with a hole or slot 402 having an inner diameter matching the outer diameter of the guide bar 600, the hole or The slot 402 extends through the upper base 400; one end of the guide rod 600 is fixed to the upper surface of the lower base 50, and the other end of the guide rod 600 penetrates the upper base 400 to slide the upper base 400 on the guide rod 600. The guide rod 600 is sleeved with a spring for resetting the upper base 400 after the position calibration is completed.

Referring to FIG. 8, optionally, the lower surface of the upper base 400 is provided with a hole or slot 402 having an inner diameter matching the outer diameter of the guide rod 600, and the hole or groove 402 in the upper base 400 is deep but does not penetrate the upper base 400. One end of the guiding rod 600 is fixed to the upper surface of the lower base 50, and the other end of the guiding rod 600 is deeped into the upper base 400 to slide the upper base 400 on the guiding rod 600, and the length of the hole or slot 402 of the upper base 400 The difference in length from the portion of the guide bar 600 that is located in the hole or slot 402 is greater than the distance that the upper base 400 moves in the direction of the beam.

The embodiment of the present invention provides a position calibration device, by using the cooperation of the first sensing component and the second sensing component, using the first coordinate and the second coordinate to accurately determine whether the robot reaches a certain position, Thereby the robot's tool coordinate system is more accurately calibrated to ensure the trajectory accuracy of the robot.

The above is only the embodiment of the present invention, and is not intended to limit the scope of the invention, and the equivalent structure or equivalent process transformations made by the description of the invention and the drawings are directly or indirectly applied to other related technologies. The fields are all included in the scope of patent protection of the present invention.

Claims (11)

1. A position calibration device, comprising:

   a first sensing component sensing whether the robot tool reaches a predetermined first coordinate;

   a second sensing component sensing whether the robot tool reaches a predetermined second coordinate;

   a control component electrically connected to the first sensing component and the second sensing component, wherein the first sensing component senses that the robot tool reaches a predetermined first coordinate, and the second transmission When the sensing component senses that the robot tool reaches a predetermined second coordinate, determining that the robot tool has reached a predetermined position point; wherein the first coordinate and the second coordinate together constitute a three-dimensional position of the position point coordinate.
2. The device of claim 1 wherein:

   The first coordinate is one of two-dimensional coordinates in the three-dimensional coordinates of the position point, and the second coordinate is another one-dimensional coordinate in three-dimensional coordinates of the position point.
3. Device according to claim 1 or 2, characterized in that

   At least one of the first sensing component and the second sensing component is a contactless sensing component.
4. The device according to claim 3, characterized in that

   The first sensing component includes a photoelectric sensing component, and the photoelectric sensing component includes a light source emitter and a light sensor, and the light source emitter is spaced apart from the light sensor;

   Wherein, the light source emitter emits a light beam having a diffusion angle smaller than a predetermined value, and when the light sensor does not sense the light beam, the control component determines that the robot tool reaches a predetermined first coordinate.
5. The device according to claim 4, characterized in that

   The second sensing component includes a displacement sensor, one end of the displacement sensor being relatively fixed to the light source emitter or the light sensor, when the robot tool reaches a predetermined first coordinate and is pushed at the beam path When the light source emitter or the light sensor moves to a predetermined position, the control component determines that the robot tool reaches a predetermined second coordinate.
6. The device according to claim 5, wherein the device further comprises:

   An upper base, the light source emitter is fixed to a center of an upper surface of the upper base, and is covered by a transparent casing; the displacement sensor is fixed to a center of a lower surface of the upper base;

   Lower base

   The guiding rod is vertically disposed between the lower surface of the upper base and the upper surface of the lower base, and one end of the guiding rod is fixed to the upper surface of the lower base.
7. The device of claim 6 wherein:

   The control component further includes a first indicator light and a second indicator light. When it is determined that the robot tool reaches the predetermined first coordinate, the first indicator light is controlled to emit light, and it is determined that the robot tool reaches a predetermined state. In the second coordinate, the second indicator light is controlled to emit light.
8. The device of claim 7 wherein:

   The control component is electrically coupled to the control cabinet of the robot, and when the control component determines that the robot tool reaches a predetermined first coordinate, the control component issues an instruction to the control cabinet of the robot to control the The robot tool pushes the upper base to move along the beam direction. When the control component determines that the robot tool reaches a predetermined second coordinate, the control component issues an instruction to the control cabinet of the robot. Controlling the robot tool to stop moving.
9. The device of claim 6 wherein:

   The two ends of the guiding rod are respectively fixed to the upper surface of the upper base and the upper surface of the lower base;

   The middle of the guiding rod is provided with a partition, and a reset spring is disposed on the sleeve for resetting the upper base after the position calibration is completed;

   The guide bars have at least two.
10. The device of claim 6 wherein:

    The lower surface of the upper base is provided with a hole or a groove having an inner diameter matching the outer diameter of the guide rod, and the other end of the guide rod penetrates the hole or groove such that the upper base is at the guide rod Slide up

    The guide rod is sleeved with a spring for resetting the upper base after the position calibration is completed;

    The guide bars have at least two.
11. The device of claim 1 wherein:

    The device also includes a housing for protecting the first sensing component and the second sensing component.