Measurement system and method for positioning accuracy of a robotic arm

Abstract

A measurement system for positioning accuracy of a robotic arm includes the robotic arm, a computing device, a robotic arm controlling device, a first magnetic element and a second magnetic element. The robotic arm controlling device is electrically connected to the robotic arm and the computing device. The first magnetic element is disposed on a robotic arm. The second magnetic element is disposed on a fixed platform. One of the first magnetic element and the second magnetic element is electrically connected to the computing device. The robotic arm controlling device controls the robotic arm to move the first magnetic element above the second magnetic element to generate a magnetic field. The computing device is configured to calculate a plurality of movement error information of the first magnetic element in the magnetic field, and count the plurality of movement error information to obtain a positioning accuracy of the robot arm.

Claims

1. A measurement system for positioning accuracy of a robotic arm, comprising: the robotic arm; a first magnetic element, disposed on the robotic arm; a second magnetic element, disposed on a fixed platform; a robotic arm controlling device, electrically connected to the robotic arm; and a computing device, electrically connected to the robotic arm controlling device and one of the first magnetic element and the second magnetic element; wherein the robotic arm controlling device controls the robotic arm to move the first magnetic element above the second magnetic element to generate a magnetic field, so that the first magnetic element moves in the magnetic field of the second magnetic element; wherein the computing device calculates a plurality of movement error information of the first magnetic element in the magnetic field, and counts the plurality of movement error information to obtain a positioning accuracy of the robotic arm; wherein the first magnetic element is a magnetic probe, and the second magnetic element is an array Hall sensor and electrically connected to the computing device; wherein the plurality of movement error information are obtained by calculating differences between distances that the first magnetic element moves and the distances moved by the first magnetic element that the computing device calculates.

2. The measurement system for positioning accuracy of a robotic arm as claimed in claim 1, wherein the robotic arm comprises an operation end on which an end-effector is disposed, and the first magnetic element is fixed on the end-effector.

3. The measurement system for positioning accuracy of a robotic arm as claimed in claim 1, wherein the robotic arm includes a plurality of shaft bodies rotatably connected to one another, and the first magnetic element is disposed on the shaft body at an extreme end of the plurality of shaft bodies.

4. The measurement system for positioning accuracy of a robotic arm as claimed in claim 1, further comprising a display interface connected to the computing device to display a position of the first magnetic element in the magnetic field.

5. A measurement method for positioning accuracy of a robotic arm, comprising steps of: providing a first magnetic element, wherein the first magnetic element is disposed on the robotic arm; providing a second magnetic element, wherein the second magnetic element is disposed on a fixed platform; providing a computing device, wherein the computing device is electrically connected to one of the first magnetic element and the second magnetic element; providing a robotic arm controlling device, wherein the robotic arm controlling device is electrically connected to the robotic arm and the computing device; controlling the robotic arm by the robotic arm controlling device to move the first magnetic element above the second magnetic element to generate a magnetic field; controlling the robotic arm by the robotic arm controlling device, so that the first magnetic element moves in the magnetic field of the second magnetic element; calculating, by the computing device, a plurality of movement error information of the first magnetic element in the magnetic field according to a movement of the first magnetic element, and counting the plurality of movement error information to obtain a positioning accuracy of the robotic arm; wherein the first magnetic element is a magnetic probe, and the second magnetic element is an array Hall sensor and electrically connected to the computing device; wherein the plurality of movement error information are obtained by calculating differences between distances that the first magnetic element moves and the distances moved by the first magnetic element that the computing device calculates.

6. The measurement method for positioning accuracy of a robotic arm as claimed in claim 5, wherein the step of calculating the plurality of movement error information of the first magnetic element comprises steps of: moving the first magnetic element to a positioning point above the second magnetic element; and repetitively moving the first magnetic element away from and then back to the positioning point.

7. The measurement method for positioning accuracy of a robotic arm as claimed in claim 5, further comprising a step of: providing a display interface, wherein the display interface is connected to the computing device to display a position of the first magnetic element in the magnetic field.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1A is a schematic diagram of a measurement system for positioning accuracy of a robotic arm provided by an embodiment of the present invention;

(2) FIG. 1B is a schematic diagram of a transformation matrix for obtaining a coordinate system between a robotic arm and a fixed platform provided by an embodiment of the present invention;

(3) FIG. 2 is a schematic diagram of a measurement system for positioning accuracy of a robotic arm provided by another embodiment of the present invention;

(4) FIG. 3 is a schematic diagram of a measurement system for positioning accuracy of a robotic arm provided by another embodiment of the present invention; and

(5) FIG. 4 is a schematic flowchart of a measurement method for positioning accuracy of a robotic arm provided by an embodiment of the present invention.

DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS

(6) FIG. 1A is a schematic diagram of a measurement system for positioning accuracy of a robotic arm provided by an embodiment of the present invention. FIG. 1B is a schematic diagram of a transformation matrix for obtaining a coordinate system between a robotic arm and a fixed platform provided by an embodiment of the present invention. Please refer to FIG. 1A and FIG. 1B, a measurement system 100 for positioning accuracy of a robotic arm in the embodiment includes a robotic arm 2, a computing device 111, a robotic arm controlling device 112, a first magnetic element 120, and a second magnetic element 130 to measure the positioning accuracy of an operation end 21 of the robotic arm 2.

(7) The robotic arm controlling device 112 is electrically connected to the robotic arm 2 and the computing device 111. The first magnetic element 120 is disposed on the robotic arm 2. The second magnetic element 130 is disposed on a fixed platform 3. One of the first magnetic element 120 and the second magnetic element 130 can be electrically connected to the computing device 111. In the embodiment, the robotic arm 2 is disposed an end-effector 22 on an operation end 21 thereof, and the first magnetic element 120 is a magnetic probe and disposed on the end-effector 22. On the other hand, the robotic arm 2 can include a plurality of shaft bodies 20 rotatably connected to one another, and the end-effector 22 is disposed on a shaft body at an extreme end of the plurality of shaft bodies 20. The second magnetic element 130 disposed on the fixed platform 3 is an array Hall sensor and electrically connected to the computing device 111. In the embodiment, the end-effector 22 shown in FIG. 1A is a gripper jaw, but is not limited thereto.

(8) In the embodiment, the computing device 111 is electrically connected to the second magnetic element 130 to receive a signal of a magnetic field generated by the first magnetic element 120 and the second magnetic element 130 and obtain a position of the first magnetic element 120 in the magnetic field through a program having an algorithm. The robotic arm controlling device 112 is electrically connected to the robotic arm 2 and the computing device 111 to receive instructions of the computing device 111 for controlling the movement of the robotic arm 2. The measurement system 100 for positioning accuracy of a robotic arm of the embodiment can further include a display interface 113. The display interface 113 is electrically connected to the computing device 111 to display the position of the first magnetic element 120 in the magnetic field. The computing device 111 can be a computer or a microcomputer, the robotic arm controlling device 112 can drive and control the robotic arm 2 and usually include an electric control box (not shown) and a guiding device (not shown) electrically connected to the electric control box, and the display interface 113 can be a screen, but are not limited thereto.

(9) The robotic arm controlling device 112 is configured to control the robotic arm 2 to move the first magnetic element 120 above the second magnetic element 130 to generate the magnetic field, so that the first magnetic element 120 moves above the second magnetic element 130. The computing device 111 is configured to calculate a plurality of movement error information of the first magnetic element 120 in the magnetic field and count the plurality of movement error information to obtain a positioning accuracy of the robotic arm 2. In the embodiment, a coordinate system of the end-effector 22 of the first magnetic element 120 includes three axes of X.sub.R, Y.sub.R, and Z.sub.R, and a coordinate system of the fixed platform 3 includes three axes of X.sub.M, Y.sub.M, and Z.sub.M. The robotic arm controlling device 112 can control the robotic arm 2 to reciprocate in the range of the magnetic field. For example, in FIG. 1A, the robotic arm controlling device 112 first controls the robotic arm 2 to move the first magnetic element 120 (the magnetic probe) to an initial position R0 of the coordinate system of the end-effector 22 above a center of the second magnetic element 130 (the array Hall sensor), and then the robotic arm controlling device 112 continuously controls the robotic arm 2 to repeatedly move the first magnetic element 120 away from and then back to the initial position R0. However, due to the movement error of the robotic arm 2, the first magnetic element 120 may not accurately return to the initial position R0 and move to a position near the initial position R0. Assuming that it has been moved n times and each time it moves to the position Mi of the coordinate system relative to the fixed platform 3 (where i=1 to n) and a single-time movement error information is AMi-R0, where A is a transformation matrix used to transfer the coordinate system of the end-effector 22 to the coordinate system of the fixed platform 3. Thus, the positioning accuracy of the operation end 21 of the robotic arm 2 can be obtained by calculating the plurality of movement error information of the first magnetic element 120 in the magnetic field by the computing device 111.

(10) As shown in FIG. 1B, the obtain of the transformation matrix A may be realized by that the robotic arm controlling device 112 controls the robotic arm 2 so that the first magnetic element 120 moves a distance of D.sub.XR (X.sub.RU, 0, 0) along the X.sub.R axis, moves a distance of D.sub.YR (0, Y.sub.RV, 0) along the Y.sub.R axis and moves a distance of D.sub.ZR (0, 0, Z.sub.RW) along the Z.sub.R axis. For the coordinate system of the fixed platform 3, the first magnetic element 120 moves a distance of U (X.sub.MU, Y.sub.MU, Z.sub.MU) along the X.sub.M axis, moves a distance of V (X.sub.MV, Y.sub.MV, Z.sub.MV) along the Y.sub.M axis, and moves a distance of W (X.sub.MW, Y.sub.MW, Z.sub.MW) along the Z.sub.M axis. Based on the distances D.sub.XR, D.sub.YR, and D.sub.ZR are known and the distances U, V, and W can be measured, the transformation matrix A of the end-effector 22 relative to the fixed platform 3 can be obtained.

(11) The measurement system 100 for positioning accuracy of the robotic arm of the embodiment can detect the positioning accuracy by the above detection method before the end-effector 22 of the robotic arm 2 performs a task. When it is found that the positioning accuracy of the robotic arm 2 is insufficient, the user can compensate the movement of the robotic arm 2 by the robotic arm controlling device 112. Further, when it is found that the positioning accuracy is too low to correct the movement of the robotic arm 2 by compensation, maintenance or replacement of the robot arm 2 can be considered.

(12) The measurement system 100 for positioning accuracy of the robotic arm of the embodiment is provided with the first magnetic element 120 and the second magnetic element 130 between the robotic arm 2 and the fixed platform 3, and the magnetic field generated by the first magnetic element 120 and the second magnetic element 130 can quickly and accurately measure the movement error information of the operation end 21 of the robotic arm 2 in the three-dimensional space, thereby providing compensation information. In addition, the measurement system and method for positioning accuracy of the robotic arm provided by the embodiments of the present invention can be used during the operation of the robotic arm 2 without causing pollution such as oil pollution.

(13) FIG. 2 is a schematic diagram of a measurement system for positioning accuracy of a robotic arm provided by another embodiment of the present invention. Please refer to FIG. 2, the measurement system 100a of the positioning accuracy of the embodiment is substantially the same as the embodiment of FIG. 1A, except that the first magnetic element 120a of the embodiment is an array Hall sensor disposed on the robotic arm 2 and electrically connected to the computing device 111, and the second magnetic element 130a is a magnetic probe disposed on the fixed platform 3. In addition, in the embodiment, the first magnetic element 120a being as an array Hall sensor is disposed on the shaft body 20, which is different from that the first magnetic element 120 being as a magnetic probe is coupled to the end-effector 22 in the embodiment of FIG. 1A. In the embodiment, the computing device 111 is electrically connected to the first magnetic element 120a and is configured to receive the signal of the magnetic field generated by the first magnetic element 120a and the second magnetic element 130a, and obtain a position of the second magnetic element 130a in the magnetic field through a program having an algorithm. The employed algorithm may include various mathematical formulas related variables for a specific solution, such as homogeneous transformation matrices or regression algorithms, or may include data training model methods such as neural network, back propagation, ANN, CNN, or RNN, but it is not limited thereto.

(14) FIG. 3 is a schematic diagram of a measurement system for positioning accuracy of a robotic arm provided by another embodiment of the present invention. Please refer to FIG. 3, the measurement system 100b of the embodiment is substantially the same as the embodiment of FIG. 1A, except that the first magnetic element 120b of the embodiment is an array Hall sensor disposed on the robotic arm 2 and electrically connected to the computing device 111, and the second magnetic element 130a is a magnetic probe disposed on the fixed platform 3. In addition, in the embodiment, the first magnetic element 120b being as an array Hall sensor is coupled to the end-effector 22 as the same as the first magnetic element 120 being as a magnetic probe in the embodiment of FIG. 1A. Preferably, the end-effector 22 of the embodiment is a gripper jaw.

(15) FIG. 4 is a schematic flowchart of a measurement method for positioning accuracy of a robotic arm provided by an embodiment of the present invention. Please refer to FIG. 4, the measurement method for positioning accuracy of a robotic arm includes steps as follow.

(16) In step S401, a first magnetic element is provided, and the first magnetic element is disposed on the robotic arm. The robotic arm can be the robotic arm 2 in FIG. 1A. The first magnetic element can be the first magnetic element 120 in FIG. 1A, the first magnetic element 120a in FIG. 2, or the first magnetic element 120b in FIG. 3.

(17) In step S402, a second magnetic element is provided, and the second magnetic element is disposed on a fixed platform. The fixed platform can be the fixed platform 3 in FIG. 1A. The second magnetic element can be the second magnetic element 130 in FIG. 1A, the second magnetic element 130a in FIG. 2, or the second magnetic element 130b in FIG. 3.

(18) In step S403, a computing device and a robotic arm controlling device are provided, the computing device is electrically connected to one of the first magnetic element and the second magnetic element, and the robotic arm controlling device is electrically connected to the robotic arm and the computing device. In FIG. 1A, the computing device 111 is electrically connected to the second magnetic element 130. In FIGS. 2 and 3, the computing device 111 is electrically connected to the first magnetic elements 120a and 120b, respectively.

(19) In step S404, the robotic arm is controlled by the robotic arm controlling device to move the first magnetic element above the second magnetic element to generate a magnetic field. In FIG. 1A, the first magnetic element 120 moved by the robotic arm is a magnetic probe. In FIG. 2, the first magnetic element 120a moved by the robotic arm is an array Hall sensor. In FIG. 3, the first magnetic element 120b moved by the robotic arm is an array Hall sensor.

(20) In step S405, the robotic arm is controlled by the robotic arm controlling device, so that the first magnetic element moves above the second magnetic element. For example, in FIG. 1A, the robotic arm controlling device 112 controls the robotic arm 2, so that the first magnetic element 120 is moved to an initial location R0 above the second magnetic element 130, and the first magnetic element 120 is repetitively moved away from and then back to the initial location R0.

(21) In step S406, the computing device calculates a plurality of movement error information of the first magnetic element in the magnetic field according to the movement of the first magnetic element and counts the plurality of movement error information to obtain a positioning accuracy of the robotic arm. For example, in FIG. 1A, the computing device 111 calculates a plurality of movement error information of AMi-R0, counts the plurality of movement error information through the algorithm, and obtains a positioning accuracy of the robotic arm 2.

(22) The measurement system and method for positioning accuracy of the robotic arm of the embodiment is provided with the first magnetic element and the second magnetic element between the robotic arm and the fixed platform, and the magnetic field generated by the first magnetic element and the second magnetic element can quickly and accurately measure the movement error information of the operation end of the robotic arm in the three-dimensional space, thereby providing compensation information. In addition, the measurement system and method for positioning accuracy of the robotic arm according provided by the embodiments of the present invention can be used during the operation of the robotic arm without causing pollution such as oil pollution.

(23) Although the present invention has been disclosed as above with the embodiments, it is not intended to limit the present invention. Those ordinarily skilled in the art may make some modifications and retouching without departing from the spirit and scope of the present invention. Therefore, the protection scope of the present invention shall be determined by the scope of the attached claims.