KR200177079Y1 - The origin equipment for robot system - Google Patents

Abstract

The present invention relates to an apparatus for performing the home position of an industrial robot. In particular, when the initial power is turned on by using uneven type devices having different distances between the sensor dogs, the relative position from the initial origin to each section is performed by using a conventional method. After calculating in advance, the robot moves to the jog to memorize the pulse amount of the sensor on / sensor off section for each section as a parameter so that the robot can be moved to the minimum position in a short time at any position to perform the home position. Is improved, and it also provides convenience because it can flexibly cope with the interference of obstacles.

Description

Homing Device of Robot System

The present invention relates to an industrial robot, and more particularly, to an origin performing apparatus of a robot system.

In general, industrial robots can be divided into rectangular coordinate robot, horizontal articulated robot, and vertical articulated robot. Dual horizontal articulated robots are mainly used for high-speed and high-speed tasks such as loading and unloading parts, assembling parts, palletizing goods, and sealing.

As shown in FIG. 1, the horizontal articulated robot is composed of horizontally moving A and B arms (11 and 12), a vertically moving Z axis, and a rotating W axis.

At this time, the robot must perform ORIGIN after starting the power and before starting work. That is, the operation of matching the mechanical origin position with the robot controller coordinate calculation reference point. At present, the encoder performs home position using encoder, sensor and sensor dog. All 4 axes (A, B, Z, W) are performed sequentially or simultaneously according to the order of the origin performance flow.

FIG. 2 shows the type of sensor dog, FIG. 2a is an incremental sensor dog, FIG. 2b is a semi-absolute sensor dog, and FIG. 2c is an ab point of FIG. This is the development view.

Conventional horizontal articulated and rectangular coordinate robots perform an origin operation by using an encoder (INCREMENTAL method), an origin sensor 14, and a sensor dog 13. That is, after turning on the power for the first time by rotating the motor in a certain direction to move the sensor dog 13 to the origin sensor position. At this time, immediately after the B contact home sensor 14 detects the sensor dog 13, the robot controller stops rotating the motor. At this time, the stop of the robot after detecting the sensor 14 is made after a few mm movement. Next, the sensor dog 13 is removed from the sensor 14 by reversing the rotational direction of the motor, and the motor is rotated until the Z phase of the motor encoder is detected. At this time, the position where the Z phase is detected becomes the origin position. The above origin is performed in all axes (AXIS) according to the origin flow of the robot controller.

At this time, the A.B arms 11 and 12 of the working radius of the horizontal articulated robot move within 115 to +115,135 to +135 in the horizontal direction. And, the position of the origin sensor is usually at 0 degree and moves the robot arm to the origin sensor position according to the origin performance signal. However, for the accuracy of the home position, the home performance speed is fixed at a low speed, so if the arm of the robot is far from the home sensor position, it takes considerable time to perform the home operation. And there is a problem only in one location, where the origin sensor is located.

The present invention is to solve the above problems, it is an object of the present invention to provide a homing device of the robot system to improve the homing speed by moving the robot to a minimum in any position.

The apparatus for performing the origin of the robot system according to the present invention for achieving the above object is characterized by performing the origin using a mechanism composed of sensor dogs of the concave-convex structure.

1 is a cross-sectional view showing a homing device of a general robot system.

2A is a cross-sectional view of the incremental sensor dog.

2b is a cross-sectional view of a semi-absolute sensor dog.

FIG. 2C is an exploded view of the sensor dog seen from the point A-B of FIG. 2B.

3 is a development view showing a win point performing apparatus of the robot system according to the present invention.

4 is a waveform diagram showing a simplified view of FIG.

FIG. 5 is a waveform diagram illustrating a process of performing an origin when initial power-on is performed in FIG. 3.

FIG. 6 is a waveform diagram illustrating a process of setting an origin when the current position is in an on section when the power is turned on.

FIG. 7 is a waveform diagram showing a process of setting the origin when the current position is in the off section when the power is turned on.

* Explanation of symbols for main parts of the drawings

11,12: A, B arm 13,31: sensor dog

14: origin sensor

Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings.

3 is an exploded view of an apparatus for performing homing of a robot system according to the present invention, and includes one sensor and a mechanism having uneven sensor dogs 31 attached thereto. That is, the origin of the sensor dog 31 is performed by using the irregularities having different intervals.

At this time, the instrument is circular but easy to understand the development view, Figure 4 is a simplified view of the development of the third.

In FIG. 4, when the intervals are divided by n (the intervals of the respective intervals are the same), the distance on / off is determined, and thus may be represented by Equation 1 below.

Here, P1 = ON is the pulse amount of the interval 1 to be turned on, n is the total interval, the total pulse is the total pulse to the n interval, 1 is the interval divided by interval 1 1 / n.

Therefore, using Equation 1, the pulse amount of the section to be turned on and the pulse amount of the section to be turned off can be known. At this time, the time to be turned on / off should have a certain ratio, but the fabrication of the sensor dog In consideration of tolerances, robot assembly, and the like, since the exact origin cannot be performed using only Equation 1, the following sequence may be used.

First, at initial power-on, the origin is performed using a conventional method. In this case, section 1 is the origin in FIG. 5 and is performed once before shipment.

Then, the robot moves to the jog, and the sensor on / sensor off section stores the pulse amount as a parameter for each section. At this time, the relative position from the initial origin to each section is calculated in advance by the system. Therefore, the origin can be set in a short time at any position thereafter.

FIG. 6 is a waveform diagram showing the origin performing process when the current position is in the on section (off section) when the power is turned on. The polling edge is detected while moving the robot left or right. When a falling edge is detected, an encoder (not shown) starts counting to detect a starting rising edge and stops counting when a rising edge is detected. At this time, the pulse amount stored in the parameter is examined to find a section matching the currently counted value. Then you can find out which section the origin was performed. Therefore, the relative position can be known.

FIG. 7 is a waveform diagram showing the origin performing process when the current position is in the off section (on section) when the power is turned on. The rising edge is detected while moving the robot left or right. When a rising edge is detected, the encoder starts counting to detect the falling edge, and when the falling edge is detected, the count stops. At this time, the pulse amount stored in the parameter is examined to find a section matching the currently counted value. Then, you can find out which section the origin was performed on and use it to know the relative position.

As described above, according to the origin performing apparatus of the robot system according to the present invention, since the origin is performed by using the irregularities having different distances between the sensor dogs, the origin can be performed by moving the robot to a minimum at any position. Speed is improved, and it is convenient because it can flexibly cope with obstacle interference.

Claims (4)

The robot system that matches the mechanical win point position with the robot controller coordinate calculation reference point by using an encoder, an origin sensor, and a sensor dog is a home system, and uses a mechanism composed of sensor dogs having an uneven structure to detect a sensor. The homing device of the robotic system. The apparatus of claim 1, wherein the sensor dog uses an anti-absolute sensor dog. 2. The encoder of claim 1, wherein the encoder performs an origin at initial power-on, calculates a relative position from the initial origin to each section in advance, and then moves the robot to a jog to parameterize the pulse amount of the sensor on / off section for each section. If the current position is in the on-section when the power is turned on, the robot detects the falling edge while moving the robot to the left or right, and starts counting when the falling edge is detected, and stops counting when the rising edge is detected. The robot system is characterized in that it proceeds in the order of detecting the relative position by finding a section matching the pulse amount stored in the parameter and the current counted value and detecting in which section the origin was performed. Origin running device. The method of claim 1, wherein the encoder performs an origin at initial power-on, calculates a relative position from the initial origin to each section in advance, and then moves the robot to a jog to parameterize the pulse amount of each section sensor on / off section. If the current position is in the off section when the power is turned on, the robot moves to the left or right side to detect the rising edge, starts counting when the rising edge is detected, and stops counting when the falling edge is detected. The robot system, characterized in that the step of detecting the relative position by detecting a section that matches the pulse amount stored in the parameter and the current count value, and by detecting which section the origin was performed. Originating device.