TWI721895B - Robot arm adjustment method and the adjustment system thereof - Google Patents

Abstract

A robot arm adjustment method includes inputting a tool coordinate system to the end of the robot arm, and storing the tool coordinate system in a control unit; the robot arm performs an alignment step according to the contour of the object, and the alignment step includes: using the end of the robot arm to contact the contour of the object, so as to obtain at least three teaching points from the object and sotre the three teaching points in the control unit; the geometric center of contour of the object can be calculated by three teaching points; and the Z axis of the tool coordinate system is shifted to align with the geometric center of the contour of the object.

Description

Mechanical arm adjustment method and its adjustment system

The invention relates to the technical field of mechanical arms, in particular to a mechanical arm adjustment method and an effect adjustment system.

When the robotic arm is performing a specific task, one of its end faces often needs to be parallel to the working plane, so that the end effector arranged on the end face can work smoothly. For example, the end effector may be a clamping jaw, which is used to clamp the shaft and insert the shaft into the insertion hole on the working plane of the orifice. The robot arm must make the shaft perpendicular to the insertion hole when inserted into the hole. The working plane, so the end face of the robot arm must be parallel to the working plane.

In addition, in order to improve the efficiency of machine tool pick-and-place alignment and alignment, most of the methods are to install sensors on the robot arm, through which the tool can reach the pick-and-place destination, but this method still has many advantages for the operator. Inconvenience, such as: installing a sensor requires a certain cost, installing a sensor requires a certain technology, and needs to connect to the controller and set related parameters, and install a sensor such as vision, which needs to be done beforehand. Image recognition learning and setting tasks, setting up enough light sources around the environment to facilitate image recognition, and then calculating the vector between the target point and the current position after capturing the image, and moving the robot arm to make the distance between the two points (target point and current position point) The vector length is zero to achieve alignment. However, such a complicated operating procedure can only complete the single function of alignment. If you want to perform pick-and-place operations, you still need to perform alignment correction first, and there is a lack of a complete set of quick teaching methods that include alignment and alignment.

In order to improve the above-mentioned problems, the main purpose of the present invention is to provide a mechanical arm adjustment method and adjustment system, which can achieve the functions of alignment and aligning the center of the pick and place by quickly teaching the points to overcome the problems caused by assembly or Mechanical errors, and to improve the problem that the robot arm must adjust the posture to hold the workpiece to smoothly pick and place the material at the pick and place.

Another object of the present invention is to provide a simple and quick-to-operate robotic arm calibration method and a calibration system thereof. Sensors can be optionally installed at the end of the robotic arm, which can save teaching time and equipment costs.

Another object of the present invention is to provide a method for adjusting a robotic arm and a system for adjusting it. At the end of the robotic arm, an auxiliary device or a sensor can be selected as required to achieve the accuracy of the adjustment.

A further object of the present invention is to provide a mechanical arm adjustment method and the adjustment method thereof, which can directly clamp workpieces or auxiliary tools for rapid alignment teaching without a sensor, and can use the inner and outer teaching methods Find the geometric center target, and teach the points quickly and conveniently. You only need to adjust the workpiece to be processed to touch the inside or outside of the contour. The operation is simple and time-saving. It can also avoid the point obtained due to misalignment of the contour line. Not the geometric center.

According to the above objective, the present invention provides a method for adjusting a robot arm, the steps of which include: inputting a tool coordinate system to the end of the robot arm, and storing the tool coordinate system in the control unit; performing an alignment step on the end of the robot arm, The alignment steps include: using the end of the robotic arm to contact the contour of the object, thereby obtaining at least three teaching points from the object and storing the three teaching points in the control unit; calculating according to the three teaching points Obtain the geometric center of the contour of the object; and move the Z axis of the tool coordinate system to align with the geometric center of the contour of the object.

In a preferred embodiment of the present invention, the robot arm calibration method further includes performing an alignment step before performing the alignment step, wherein the alignment step includes: randomly finding three points on the plane of the object for which the alignment step is to be performed To calculate the normal vector of the user coordinate system; and align the normal vector of the tool coordinate system with the normal vector of the user coordinate system, where the normal vector of the tool coordinate system is opposite to the normal vector of the user coordinate system and Parallel to each other in space.

In a preferred embodiment of the present invention, the three coordinate values of three points found arbitrarily on the plane of the object are the coordinate values obtained by keeping the same point on the end in contact with the plane of the object at three points.

In a preferred embodiment of the present invention, the geometric center aligned with the contour of the object is obtained by using a three-point centering, a four-point centering a rectangular geometric center, or a multi-point determining a polygonal geometric center.

In a preferred embodiment of the present invention, the end of the robotic arm is an end effector.

In a preferred embodiment of the present invention, the end effector is a clamping jaw or a sensor.

In a preferred embodiment of the present invention, the mechanical arm calibration method further includes a straightening step, and the straightening step includes: reading the tool coordinate system from the control unit; selecting at least one of the alignment steps on the same side of the contour of the object Two of the three teaching points form the X direction vector of the contour; calculate the angle difference between the X direction vector of the tool coordinate system and the X direction vector of the contour, and use this angle difference as the rotation angle of the robot arm ; And the end of the robotic arm with this tool coordinate system is rotated according to the rotation angle so that the X-direction vector of the tool coordinate system is parallel to the X-direction vector of the contour.

In a preferred embodiment of the present invention, the clamping jaws can clamp a workpiece to be processed or an auxiliary tool with sharp points.

In the preferred embodiment of the present invention, the three teaching points are obtained by using the end of the robotic arm to contact the inside or outside of the contour of the object.

In a preferred embodiment of the present invention, the plane of the object can be located on the material tray, the spindle chuck of the machine tool, the tool change place of the tool changer, or the workpiece to be processed.

According to the above-mentioned robotic arm calibration method, the present invention also provides a robotic arm calibration system, which includes: a robotic arm with an end, which includes a control unit connected to the robotic arm for controlling the robotic arm to perform a processing process, wherein the control The unit includes: an input unit, arithmetic unit, an alignment unit, and an alignment unit. The input unit is used to input the tool coordinate system at the end of the robotic arm, and store the tool coordinate system in the control unit; the arithmetic unit, according to the desired alignment The three coordinate values of any three points on the plane of the object in the step are used to calculate the normal vector of the user coordinate system; the alignment unit aligns the normal vector of the tool coordinate system with the normal vector of the user coordinate system, where the normal vector of the tool coordinate system The direction of the normal vector and the normal vector of the user coordinate system are opposite and parallel to each other in space; and the alignment unit, the robot arm performs the alignment step according to the contour of the object, and uses the robot arm to contact the contour of the object to obtain the result from the object At least three teaching points are calculated based on these three teaching points to obtain the geometric center of the contour of the object and move the Z axis of the tool coordinate system to align with the geometric center of the contour of the object.

In the preferred embodiment of the present invention, the robotic arm can be an articulated robotic arm, a horizontal multi-joint robotic arm, a surgical frame robotic arm, or a parallel robotic arm.

In a preferred embodiment of the present invention, the end of the robotic arm is an end effector.

In a preferred embodiment of the present invention, the end effector is a clamping jaw or a sensor.

In a preferred embodiment of the present invention, the clamping jaws can clamp a workpiece to be processed or an auxiliary tool with sharp points.

In a preferred embodiment of the present invention, the sensor can be a contact force sensor or an electrical sensor.

In a preferred embodiment of the present invention, the robotic arm calibration system further includes a rotating unit for performing the normalization step. The control unit reads the tool coordinate system and selects the alignment step on the same side of the contour of the object. Two of the at least three teaching points in the X-direction vector of the contour are formed, and the angle difference between the X-direction vector of the tool coordinate system and the X-direction vector of the contour is calculated The angle difference is regarded as the rotation angle of the robot arm. The end of the robot arm rotates according to the rotation angle so that the X direction vector of the tool coordinate system is parallel to the X direction vector of the contour.

In the preferred embodiment of the present invention, the three teaching points are obtained by using the end of the robotic arm to contact the inside or outside of the contour of the object.

In a preferred embodiment of the present invention, the plane of the object is located at the spindle chuck of the machine tool, the material tray, the tool-changing tool magazine, or the workpiece to be processed.

In a preferred embodiment of the present invention, the mechanical arm adjustment system can be applied to processing workpieces, picking and placing workpieces, or picking and placing tools.

1: Robotic arm adjustment system

2: control unit

22: Input unit

24: arithmetic unit

26: Alignment unit

28: Alignment unit

30: Rotating unit

32: storage unit

4: Robotic arm

42: end

5: Material tray hole

6: Workpieces and bars to be processed

7: Spindle chuck

Step S10-Step S16: Step process of the mechanical arm adjustment method

Step S122-Step S124: Alignment step flow

Step S142-Step S146: Alignment step flow

Step S162-Step S168: Step-to-correction process

FIG. 1 is a block diagram showing a system for adjusting a mechanical arm according to the technology disclosed in the present invention.

FIG. 2 is a flow chart showing the steps of a method for adjusting a robot arm according to the technology disclosed in the present invention.

3A is a schematic diagram showing that the end of the robotic arm contacts the teaching point inside the tray hole according to the technology disclosed in the present invention.

FIG. 3B is a schematic diagram showing that the end of the robotic arm contacts the teaching point on the outside of the spindle chuck according to the technology disclosed in the present invention.

3C is a schematic diagram showing that the end of the robotic arm touches the teaching point inside or outside the contour of the object to obtain the geometric center according to the technology disclosed in the present invention.

FIG. 4A is a schematic diagram showing two points taught on the inner side of each edge of the contour of a geometric figure according to the technology disclosed in the present invention.

FIG. 4B is a schematic diagram showing the teaching of the vertex inside the contour of the geometric figure according to the technology disclosed in the present invention.

FIG. 5 is a flowchart showing the steps of another embodiment of a method for adjusting a robot arm according to the technology disclosed in the present invention.

FIG. 6 is a schematic diagram showing that the end of the robot arm rotates according to the rotation angle according to the technology disclosed in the present invention.

Please refer to Figure 1 first. FIG. 1 is a block diagram showing a system for adjusting a mechanical arm according to the technology disclosed in the present invention. In Figure 1, the robotic arm calibration system 1 includes a control unit 2 and a robotic arm 4. The control unit 2 is connected to the robotic arm 4. The control unit 2 is used to control the robotic arm 4 to execute the processing process. The manufacturing process refers to using the control unit 2 to control the movement of the robotic arm 4 or to control the robotic arm 4 to perform command actions. In addition, the robotic arm 4 has an end 42 which can be an end effector. Specifically, the end effector can be a gripper or a sensor. In a preferred embodiment, the gripper can be used for processing. Workpieces or aids with sharp points. In another preferred embodiment, the sensor can be a contact force sensor or an electrical sensor. The robot arm 4 may be an articulated robot arm, a horizontal multi-joint robot arm, a surgical frame type robot arm, or a parallel robot arm.

The control unit 2 includes an input unit 22, an arithmetic unit 24, an alignment unit 26, and an alignment unit 28. The input unit 22 is used to input the tool coordinate system at the end 42 of the robotic arm 4 and store this tool coordinate system in the control Storage unit 32 in unit 2. The arithmetic unit 24 calculates the normal vector of the user coordinate system based on the three coordinate values of any three points on the plane of the object (not shown in the figure) to be aligned. The plane indicated in the figure) can be located at the machine tool spindle chuck, material tray, tool changer tool magazine, or the workpiece to be processed. The alignment unit 26 aligns the normal vector of the tool coordinate system of the end 42 of the robotic arm 4 with the normal vector of the user coordinate system, so that the normal vector of the tool coordinate system and the normal vector of the user coordinate system are in the opposite direction, but in the same direction. One The space is parallel to each other. In the alignment unit 28, the robot arm performs an alignment step according to the contour of an object (not shown in the figure), and uses the end 42 of the robot arm 4 to contact the contour of the object (not shown in the figure), so that the object (not shown in the figure) is touched by the contour of the object (not shown in the figure). (Shown in the figure) to obtain at least three teaching points, the alignment unit 28 calculates based on these teaching points to obtain the geometric center of the contour of the object (not shown in the figure), and move the Z axis of the tool coordinate system to Align the geometric center of the outline of the object.

In another embodiment of the present invention, the control unit 2 further includes a rotating unit 30 for performing the normalization step. The control unit 2 reads the tool coordinate system, and selects the previously used alignment unit 28 on the same side of the contour of the object. Two of the at least three teaching points in the performed alignment step are used to form the X-direction vector of the contour, and the angle difference between the X-direction vector of the tool coordinate system and the X-direction vector of the contour is calculated, and this angle difference is calculated The value is used as the rotation angle of the robot arm 4, and the end 42 of the robot arm 4 rotates according to the rotation angle so that the X direction vector of the tool coordinate system is parallel to the X direction vector of the contour.

Then please refer to Figure 2. FIG. 2 is a flow chart showing the steps of a method for adjusting a robot arm according to the technology disclosed in the present invention. In Fig. 2, step S10: input the tool coordinate system to the end of the robotic arm, and store the tool coordinate system in the control unit. In this step, the robotic arm 4 clamps the workpiece to be processed (not shown in the figure) or an auxiliary tool with a sharp point (not shown in the figure), and uses a variety of different postures to collide with a certain fixed point to obtain multiple groups Solve, and establish the tool coordinate system of this end after calculation. If the end 42 is a workpiece to be processed or an auxiliary tool with a sharp point, the tool coordinate system is the tool coordinate system of the workpiece to be processed or an auxiliary tool with a sharp point, that is to say, what is the end of the robotic arm 4? Component, the tool coordinate system is the tool coordinate system of the component.

Step S12: Perform an alignment step on the end of the robotic arm, which includes Step S122: randomly find three coordinate values of three points on the plane of the object to be aligned to calculate the normal vector of the user coordinate system. In this step, use the end 42 of the robotic arm 4 (regardless of whether there is a clamping object) on the plane to be aligned on the object (not shown in the figure) to teach any three non-collinear points to find the Three points are used to establish the user coordinate system, where any three points that are not collinear must be kept in contact with any three points on the plane of the object (not shown in the figure) at the same point on the end 42 to ensure that the user coordinate system is established accurately . The three coordinate values of these three points can be stored in the user coordinate system management file of the storage unit 32 in the control unit 2, and there is no need to recreate it every time when it is not a new pick-and-place situation. In the embodiment of the present invention, the object (or object) to be aligned may be a pick-and-place place such as a spindle or a tray of a machine tool. Then step S124: align the normal vector of the tool coordinate system with the normal vector of the user coordinate system, where the normal vector of the tool coordinate system and the normal vector of the user coordinate system have opposite directions and are parallel to each other in space. In this step, adjust the posture of the robotic arm 4 so that the normal vector of the tool coordinate system is aligned with the normal vector of the user coordinate system, and the alignment posture is to reverse the direction of the normal vector of the tool coordinate system and the normal vector of the user coordinate system. , And parallel in space. It should be noted that if the initial state of the tool coordinate system and the user coordinate system is the alignment state, the above alignment steps (step S12 and step S122-step S124) can be omitted, and the robot arm 4 alignment step can be performed directly S14.

Step S14: align the end of the robot arm, which includes step S142: Use the end of the robot arm to contact the contour of the object, so as to obtain at least three teaching points from the object and store these teaching points in the control unit. In this step, the robotic arm 4 in the aligned posture continues to teach the points on the contour of the object, as shown in Figures 3A and 3B. If the clamped workpiece 6 is a cylindrical bar, place the bar 6 on the object. The outer or inner side of the contour of 5 (tray hole) and 7 (spindle chuck) is contacted to find the teaching point, and the geometric center position of the contour is obtained after calculation, as shown in Figure 3C. In Fig. 3C, points O ₁ , O ₂ and O ₃ indicate that the rod 6 is in contact with at least three outer teaching points outside the outline of the object 5 (tray hole, Fig. 3A) 7 (spindle chuck, Fig. 3B) Similarly, points I ₁ , I ₂ and I ₃ represent at least three inner teaching points of the inner side of the contour of the rod 6 contacting the object 5 (tray hole) and 7 (spindle chuck).

Next step S144: Calculate the geometric center of the contour of the object according to at least three teaching points. In this step, the three teaching points (points O ₁ , O ₂ and O ₃ or points I ₁ , I ₂ and I ₃ ) obtained in step S162 can be used to calculate the three-point centering.

It should be noted here that if the object is a rectangle or a polygon, the method for obtaining the geometric center of the rectangle or the polygon can refer to FIG. 4A and FIG. 4B and the description is as follows. The mechanical arm 4 clamps the auxiliary tool (ie, as the aforementioned bar 6), and forms a line with two teaching points on each side line or the inner and outer sides of the geometric figure outline, that is, the point M1 and the point in Fig. 4A M1', point M2 and point M2', point M3 and point M3', and point M4 and point M4', the above-mentioned teaching point data can be stored in the storage unit 32, and a virtual contour similar to the real contour can be automatically calculated, such as The M1-M1' line segment, M2-M2' line segment, M3-M3' line segment and M4-M4' line segment in FIG. 4A. It should be noted that because the robotic arm does not know where the bar is in contact with the contour of the object, it can only know that the center point of the bar passes through the Z axis of the tool coordinate system, so the robotic arm can only know the center point of the bar, so the above The point M1 and point M1', point M2 and point M2', point M3 and point M3', and point M4 and point M4' are the geometric center coordinates of the bar. Therefore, these points are connected to form a contour similar to the object. The geometric center of this similar figure is exactly the same position as the contour center. In Figure 4A, the outline of the object is quadrilateral, and two points are taught on one side, so there are four groups of teaching points (point M1 and point M1', point M2 and point M2', point M3 and point M3', and point M4). And point M4'), so there are a total of 8 points to calculate the geometric center of the quadrilateral; or as shown in Figure 4B, select the four points P1, P2, P3, P4 in the geometry to teach the vertex, The vertex positions of these four points are directly stored in the storage unit 32, and the above two methods can be applied to any polygon to obtain the geometric center of the polygon. Therefore, calculating the geometric center of the contour of the object may also include a four-point fixed rectangular geometric center or a multi-point fixed geometric center of a polygon. The geometric center of the object can be obtained by teaching points on the inside or outside of the contour of the object, which can avoid the defect that the point obtained by misaligning the contour line is not the geometric center.

Then, step S146: move the Z axis of the tool coordinate system to align with the geometric center of the contour of the object. Since the geometric center of the contour of the object has been obtained in step S144, the Z axis of the tool coordinate system of the end 42 of the robot arm 4 can be moved to align with the geometric center of the contour of the object. At this time, the robot arm 4 can be operated to align the object. Carry out the processing process.

Since the clamping polygonal workpiece to be processed is picked and placed, such as a rectangle, if the geometric center of the contour has been aligned, there is still no guarantee that there is no difference in the rotation angle between the workpiece to be processed and the pick and place. Therefore, in another embodiment of the present invention In the example, it is also necessary to find the angle difference between the X direction vector of the tool coordinate system and the X direction vector of the pick and place (ie contour) as the rotation angle to perform the normalization step. In addition, it should be noted that steps S10 to S12 and step S14 in FIG. 5 are the same as those in FIG. 2. Also, refer to FIG. 6 when describing FIG. 5. In addition, the teaching points in the polygon alignment technology can be used for the straightening step, so the straightening step is not performed until the alignment step is performed. The normalization step S16 includes step S162: the control unit reads the tool coordinate system. In this step, since in the aforementioned alignment step, the robotic arm 4 gripping aid has obtained at least three teaching points from the contour of the object, and these teaching points are stored in the storage unit 32 of the control unit 2. Therefore, during the normalization step, there is no need to find the teaching points again, and at least three teaching points can be read from the storage unit 32. Step S164: Select two of the at least three teaching points in the alignment step on the same side of the contour of the object to form the X-direction vector of the contour. In this step, two of the at least three teaching points are selected, and the vector formed by the two points represents the object 5 (such as the tray hole in Figure 3A) and 7 (the spindle chuck in Figure 3B). The X-direction vector of the contour of ). It should be noted that, in this embodiment, the tray hole 5 and the spindle chuck 7 are not limited to the states shown in FIGS. 3A and 3B. Then step S166: Calculate the angle difference between the X direction vector of the tool coordinate system and the X direction vector of the contour, and use this angle difference as the rotation angle of the robot arm. In this step, the arithmetic unit 24 calculates the vector formed by the two points selected in step S164 to represent the contour of the object The angle difference between the X direction vector of the tool coordinate system and the X direction vector of the tool coordinate system, then this angle difference is regarded as the rotation angle θ of the robot arm 4.

Step S168: the end of the robotic arm with the tool coordinate system is rotated according to the rotation angle so that the X direction vector of the tool coordinate system is parallel to the X direction vector of the contour. In this step, when picking and placing, the X-direction vector of the tool coordinate of the end 42 of the robotic arm 4 will be rotated according to this rotation angle θ, that is, the arrow in Figure 6 indicates the direction, first make the Z axis of the tool coordinate system Align the geometric center, and then make the X-direction vector of the tool coordinate system parallel and the same direction as the X-direction vector of the contour of the object to complete the pick and place smoothly. If the pick and place are the same workpiece 6 to be processed, the rotation angle can be automatically read for use, and there is no need to re-teach each time.

According to the above embodiments, the mechanical arm adjustment method and the adjustment method disclosed in the present invention can be applied to processing workpieces, picking and placing workpieces, or picking and placing tools, and in the state without auxiliary tools or sensors It can directly clamp the workpiece to be processed for rapid alignment teaching. The goal of finding the geometric center can be achieved by using the inner and outer teaching points, and the teaching point is fast and convenient. You only need to adjust the workpiece to be processed to touch the inner or outer side of the contour. The operation is simple and time-saving, and it can also avoid the point not being the geometric center due to misalignment of the contour line.

Step S10: Input the tool coordinate system to the end of the robot arm, and store the tool coordinate system in the control unit

Step S12: Align the end of the robotic arm

Step S14: Align the end of the robotic arm

Step S122-Step S124: Alignment step flow

Step S142-Step S146: Alignment step flow

Claims (20)

A method for adjusting a robot arm, the steps include: inputting a tool coordinate system to an end of a robot arm, and storing the tool coordinate system in a control unit; performing an alignment step on the end of the robot arm, Including: using the end of the robotic arm to contact an outline of an object, thereby obtaining at least three teaching points from the object and storing the teaching points in the control unit; calculating according to the teaching points Obtaining a geometric center of the contour of the object; and moving a Z axis of the tool coordinate system to align with the geometric center of the contour of the object. The method for calibrating a robotic arm according to claim 1, further comprising performing a pair of alignment steps before performing the alignment step, and the alignment step includes: arbitrarily finding on a plane of the object for which the alignment step is to be performed. The three coordinate values of three points are calculated to calculate a normal vector of a user coordinate system; and the normal vector of the tool coordinate system is aligned with the normal vector of the user coordinate system, wherein the method of the tool coordinate system The vector is opposite to the normal vector of the user coordinate system and parallel to each other in a space. The mechanical arm adjustment method according to claim 2, wherein the three coordinate values are obtained by keeping the same point on the end in contact with the three-point contact of the plane of the object. The mechanical arm adjustment method according to claim 1, wherein the geometric center aligned with the contour of the object is obtained by using a three-point centering, a four-point centering rectangular geometric center, or multiple points determining a polygonal geometric center . The method for adjusting a mechanical arm according to claim 1, wherein the end of the mechanical arm is an end effector. The method for calibrating a mechanical arm according to claim 5, wherein the end effector is a gripper or a sensor. The method for calibrating a mechanical arm according to claim 1, further comprising a straightening step, wherein the straightening step comprises: reading the tool coordinate system from the control unit; selecting the pair on the same side of the contour of the object Two of the teaching points in the calibration step form an X-direction vector of the contour; calculate an angle difference between an X-direction vector of the tool coordinate system and the X-direction vector of the contour, and The angle difference is taken as a rotation angle of the robotic arm; and the end of the robotic arm having the tool coordinate system rotates according to the rotation angle so that the X direction vector of the tool coordinate system is parallel to the X direction of the contour vector. The method for adjusting a mechanical arm according to claim 6, wherein the clamping jaw can clamp a workpiece to be processed or an auxiliary tool with a sharp point. The method for adjusting a robot arm according to claim 1, wherein the teaching points are obtained by contacting an inner side or an outer side of the contour of the object by the end of the robot arm. The mechanical arm adjustment method according to claim 2, wherein the plane of the object can be located at a material tray, a machine tool spindle chuck, a tool changer tool magazine, or a workpiece to be processed. A robot arm adjustment system includes: a robot arm with an end, including a control unit connected to the robot arm for controlling the robot arm to perform a processing process, the control unit including: an input unit for Input a tool coordinate system at the end of the robotic arm, and store the tool coordinate system in a storage unit of the control unit; An arithmetic unit calculates a normal vector of a user coordinate system based on the three coordinate values of any three points on a plane of an object to perform a pair of positive steps; a pair of positive units calculates the normal vector of the tool coordinate system The normal vector is aligned with the normal vector of the user coordinate system, wherein the normal vector of the tool coordinate system and the normal vector of the user coordinate system have opposite directions and are parallel to each other in a space; and an alignment unit for Perform an alignment step on the object, use the end of the robotic arm to contact an outline of the object, so as to obtain at least three teaching points on the object, and calculate based on the teaching points to obtain the object's A geometric center of the contour and a Z axis of the tool coordinate system are moved to align with the geometric center of the contour of the object. The robot arm adjustment system according to claim 11, wherein the robot arm can be an articulated robot arm, a horizontal multi-joint robot arm, a surgical frame type robot arm, or a parallel robot arm. The mechanical arm adjustment system according to claim 11, wherein the end is an end effector. The mechanical arm adjustment system according to claim 13, wherein the end effector is a gripper or a sensor. The mechanical arm adjustment system according to claim 14, wherein the clamping jaw can clamp a workpiece to be processed or an auxiliary tool with a sharp point. The mechanical arm adjustment system according to claim 14, wherein the sensor can be a contact force sensor or an electric sensor. The mechanical arm adjustment system according to claim 11, further comprising a rotating unit for performing a normalization step, and the control unit reads the tool coordinate system, which is on the same side of the contour of the object Select two of the teaching points in the alignment step to form the contour An X direction vector, an angle difference between an X direction vector of the tool coordinate system and the X direction vector of the contour is calculated, and the angle difference is regarded as a rotation angle of the robot arm, and the end of the robot arm Rotating according to the rotation angle makes the X-direction vector of the tool coordinate system parallel to the X-direction vector of the contour. The mechanical arm adjustment system according to claim 11, wherein the teaching points are obtained by contacting an inner side or an outer side of the contour of the object with the end of the mechanical arm. The mechanical arm adjustment system according to claim 11, wherein the plane of the object is located at a machine tool spindle chuck, a material tray, a tool changer tool magazine, or a workpiece to be processed. A system for adjusting a mechanical arm according to any one of claims 11-19, which is applied to a workpiece, a pick-and-place workpiece, or a pick-and-place tool.

Images