CROSS LASER CALIBRATION DEVICE AND CALIBRATION SYSTEM USING THE SAME
20230129623 · 2023-04-27
Assignee
Inventors
- Sheng-Chieh HSU (Taipei City, TW)
- Sheng-Han HSIEH (Tainan City, TW)
- Mou-Tung HSIEH (Hsinchu City, TW)
- Tien-Yun CHI (Taichung City, TW)
- Kuo-Feng HUNG (Taoyuan City, TW)
Cpc classification
B25J9/10
PERFORMING OPERATIONS; TRANSPORTING
G05B2219/39025
PHYSICS
International classification
Abstract
A cross laser calibration device used to calibrate a tool center point is provided. The calibration device includes a coordinate orifice plate, a set of cross laser sensors and a rotational and translational movement mechanism. The coordinate orifice plate has an orifice center point. The set of cross laser sensors is arranged on the coordinate orifice plate to generate cross laser lines intersecting at the orifice center point. The set of cross laser sensors is driven by the second motor to rotate around the center point of the second motor, wherein the orifice center point has an off-axis setting relative to the center point of the second motor.
Claims
1. A cross laser calibration device, comprising: a coordinate orifice plate having an orifice center point; a set of cross laser sensors arranged on the coordinate orifice plate to generate cross laser lines intersecting at the orifice center point; and a rotational and translational movement mechanism used to drive the coordinate orifice plate and the set of cross laser sensors, wherein the rotational and translational movement mechanism comprises: a first motor used to drive a uni-axis actuator to generate a translational movement in a first direction; a second motor fixed on the uni-axis actuator to generate a rotational movement perpendicular to the first direction; and a connecting rod connected between the second motor and the coordinate orifice plate, wherein the orifice center point has an off-axis setting relative to a center point of the second motor.
2. The calibration device according to claim 1, wherein the set of cross laser sensors is driven by the second motor to revolve and rotate around the center point of the second motor to determine coordinates of a first point by which a tool intersects a sensing plane of the cross laser lines relative to the center point of a coordinate system of the second motor.
3. The calibration device according to claim 2, wherein the set of cross laser sensors is driven by the second motor to rotate around the center point of the second motor for one circle, and the tool intersects the cross laser lines along with a rotation of the cross laser lines to generate a first set of blocking signals and a first set of rotation angles of the second motor corresponding to the first set of blocking signals for a calculation of the coordinates of the first point by which the tool intersects the sensing plane of the cross laser lines relative to the center point of the coordinate system of the second motor.
4. The calibration device according to claim 3, wherein after the coordinate orifice plate and the set of cross laser sensors are driven by the first motor to translate the uni-axis actuator upward or downward, the set of cross laser sensors is driven by the second motor to rotate around the center point of the second motor for one circle, and the tool intersects the cross laser lines along with the rotation of the cross laser lines to generate a second set of blocking signals and a second set of rotation angles of the second motor corresponding to the second set of blocking signals for a calculation of coordinates of a second point on the tool by which the tool intersects the sensing plane of the cross laser lines relative to the center point of the coordinate system of the second motor.
5. The calibration device according to claim 3, wherein the first point on the tool sequentially intersects the cross laser lines at a first blocking point, a second blocking point, a third blocking point and a fourth blocking point; the calibration device describes equations of a movement trajectory of the first blocking point, the second blocking point, the third blocking point and the fourth blocking point using relative movement and obtains the coordinates of the first point by resolving the equation of the movement trajectory.
6. The calibration device according to claim 4, wherein the second point on the tool sequentially intersects the cross laser lines at a first blocking point, a second blocking point, a third blocking point and a fourth blocking point; the calibration device describes equations of a movement trajectory of the first blocking point, the second blocking point, the third blocking point and the fourth blocking point using relative movement and obtains the coordinates of the second point by resolving the equation of the movement trajectory.
7. A calibration system used to calibrate a tool center point of a robotic arm, wherein the calibration system comprises: a coordinate orifice plate having an orifice center point; a set of cross laser sensors arranged on the coordinate orifice plate to generate cross laser lines intersecting at the orifice center point; and a rotational and translational movement mechanism used to drive the coordinate orifice plate and the set of cross laser sensors, wherein the rotational and translational movement mechanism comprises: a first motor used to drive a uni-axis actuator to generate a translational movement in the first direction; a second motor fixed on the uni-axis actuator to generate a rotational movement perpendicular to the first direction; and a connecting rod connected between the second motor and the coordinate orifice plate, wherein, the orifice center point has an off-axis setting relative to a center point of the second motor; and a processing unit used to receive an initial position information of the robotic arm and two rotation angle signals of the first motor and the second motor and to control the first motor and the second motor to rotate.
8. The calibration system according to claim 7, wherein the set of cross laser sensors is driven by the second motor to revolve and rotate around the center point of the second motor to determine coordinates of a first point by which a tool intersects a sensing plane of the cross laser lines relative to the center point of a coordinate system of the second motor.
9. The calibration system according to claim 8, wherein when the robotic arm moves the tool to be within a sensing range of the cross laser lines, the set of cross laser sensors is driven by the second motor to rotate around the center point of the second motor for one circle, and the tool intersects the cross laser lines along with a rotation of the cross laser lines to generate a first set of blocking signals and a first set of rotation angles of the second motor corresponding to the first set of blocking signals for a calculation of the coordinates of the first point by which the tool intersects the sensing plane of the cross laser lines relative to the center point of the coordinate system of the second motor.
10. The calibration system according to claim 9, wherein after the coordinate orifice plate and the set of cross laser sensors are driven by the first motor to translate the uni-axis actuator upward or downward, the cross laser sensor is driven by the second motor to rotate around the center point of the second motor for one circle, and the tool intersects the cross laser lines along with the rotation of the cross laser lines to generate a second set of blocking signals and a second set of rotation angles of the second motor corresponding to the second set of blocking signals for a calculation of coordinates of a second point on the tool by which the tool intersects the sensing plane of the cross laser lines relative to the center point of the coordinate system of the second motor.
11. The calibration system according to claim 10, wherein the processing unit calculates coordinates of an initial tool center point according to the coordinates of the first point on the tool relative to the center point of the coordinate system of the second motor, the coordinates of the second point on the tool relative to the center point of the coordinate system of the second motor, and the initial position information of the robotic arm.
12. The calibration system according to claim 11, wherein after setting the coordinates of the initial tool center point to a controller of the robotic arm, the robotic arm is moved for enabling the initial tool center point of the tool to be located at the orifice center point and then calibrates an attitude angle of the tool.
13. The calibration system according to claim 12, wherein the attitude angle of the tool is perpendicular to the sensing plane of the cross laser lines.
14. The calibration system according to claim 13, wherein the first motor drives the uni-axis actuator to translate the set of cross laser sensors downward for moving the tool from a position blocking the cross laser lines to a position not blocking the cross laser lines; the calibration system calibrates the coordinates of the initial tool center point according to a translated distance to obtain final coordinates of the tool center point.
15. The calibration system according to claim 9, wherein the first point on the tool sequentially intersects the cross laser lines at a first blocking point, a second blocking point, a third blocking point and a fourth blocking point; the calibration system describes equations of a movement trajectory of the first blocking point, the second blocking point, the third blocking point and the fourth blocking point using relative movement and obtains the coordinates of the first point by resolving the equation of the movement trajectory.
16. The calibration system according to claim 10, wherein the second point on the tool sequentially intersects the cross laser lines at a first blocking point, a second blocking point, a third blocking point and a fourth blocking point; the calibration system describes equations of a movement trajectory of the first blocking point, the second blocking point, the third blocking point and the fourth blocking point using relative movement and obtains the coordinates of the second point by resolving the equation of the movement trajectory.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0009]
[0010]
[0011]
[0012]
[0013]
[0014]
[0015]
[0016] In the following detailed description, for purposes of explanation, numerous specific details are set forth in order to provide a thorough understanding of the disclosed embodiments. It will be apparent, however, that one or more embodiments may be practiced without these specific details. In other instances, well-known structures and devices are schematically shown in order to simplify the drawing.
DETAILED DESCRIPTION
[0017] Technical solutions for the embodiments of the present application are clearly and thoroughly disclosed with accompanying drawings. Obviously, the embodiments disclosed below are only some rather than all of the embodiments of the present disclosure. All embodiments obtained by anyone ordinarily skilled in the art of the present application according to the disclosed embodiments of the present disclosure are within the scope of protection of the present disclosure if the obtained embodiments are obvious.
[0018] Besides, the disclosed features, structures or characteristics can be combined in one or more embodiments in any suitable way. In the following disclosure, many detailed descriptions are provided for the embodiments of the present application to be better and fully understood. However, anyone ordinarily skilled in the art of the disclosure will understand that technical solution for the present application can be implemented without one or more of the details disclosed below or can be implemented using other methods, devices, or steps. In some circumstances, generally known methods, devices, implementations, or operations of the technical solution capable of implementing the present disclosure are not necessarily illustrated or disclosed in greater details lest the aspects of the present application might be distracted.
[0019] Refer to
[0020] In an embodiment, the cross laser calibration device 110 includes a coordinate orifice plate 111, a set of cross laser sensors 113, and a rotational and translational movement mechanism 130. The cross laser sensors 113 are arranged on the coordinate orifice plate 111. The coordinate orifice plate 111 is arranged on the rotational and translational movement mechanism 130. The rotational and translational movement mechanism 130 can synchronously drive the coordinate orifice plate 111 and the set of cross laser sensors 113 to rotate or translate. In the present embodiment, the orifice center point O.sub.s of the coordinate orifice plate 111 and the cross laser lines 114 generated by the set of cross laser sensors 113 can form a cross laser coordinate system (X.sub.s, Y.sub.s, Z.sub.s), and the second motor of the rotational and translational movement mechanism 130 has a coordinate system (X.sub.m, Y.sub.m, Z.sub.m) whose origin is the center point O.sub.m of the second motor. The cross laser calibration device 110 is driven by the second motor to revolve and rotate around the center point O.sub.m of the second motor. The cross laser calibration device 110 calibrates the coordinates of the tool center point (that is, the coordinates of the terminal E) of the robotic arm 101 using an off-axis setting relationship between the cross laser coordinate system (X.sub.s, Y.sub.s, Z.sub.s) and the coordinate system (X.sub.m, Y.sub.m, Z.sub.m) whose origin is the center point O.sub.m of the second motor.
[0021] In some embodiments, the tool 102 refers to any objects arranged on the robotic arm 101, such as clamper, welding gun, cutter or grinder, and the tool center point refers to the terminal E on the end of the tool 102.
[0022] Refer to
[0023] Refer to
[0024] In the present embodiment, the connecting rod 139 is connected between the second motor 138 and the coordinate orifice plate 111. The second motor 138 can synchronously drive the connecting rod 139 and the coordinate orifice plate 111 to perform a rotational movement. Since the structure of the coordinate orifice plate 111, the length of the connecting rod 139, and the distance by which the orifice center point O.sub.s is deviated from the center point O.sub.m of the second motor 138 are already known at the design stage, the coordinates of the orifice center point O.sub.s of the coordinate orifice plate 111 relative to the center point O.sub.m of the coordinate system of the second motor 138 can be obtained through the conversion of coordinate systems.
[0025] Refer to
[0026] Refer to
[0027] Refer to
[0028] Firstly, in step S30, a robotic arm 101 is moved for enabling a tool 102 to be located within a sensing range of the cross laser lines 114.
[0029] In step S32, the cross laser sensors 113 are driven by a second motor 138 to rotate for one circle for the calculation of the coordinates of a first point P1 on the tool 102 relative to the center point Om of the coordinate system of the second motor 138.
[0030] In step S34, after the uni-axis actuator 132 is driven by a first motor 131 to translate the cross laser sensors 113 upward or downward, the cross laser sensors 113 are driven by the second motor 138 to rotate for one circle for the calculation of the coordinates of a second point P2 on the tool 102 relative to the center point Om of the coordinate system of the second motor 138.
[0031] In step S36, the coordinates of an initial tool center point To are calculated according to the coordinates of the two points (P1 and P2) on the tool 102 and the initial position information of the robotic arm 101. In step S38, after the coordinates of the initial tool center point To are set to the controller of the robotic arm 101, the robotic arm 101 is moved for enabling the initial tool center point To of the tool 102 to be located at the orifice center point Os on the cross laser lines 114, then the attitude angle of the tool 102 is calibrated, so that the tool 102 is perpendicular to the sensing plane of the cross laser sensor 113.
[0032] In step S40, the uni-axis actuator 132 is driven by the first motor 131 to translate the cross laser sensors 113 downward for moving the tool 102 from a position blocking the cross laser lines 114 to a position not blocking the cross laser lines 114, and the coordinates of the initial tool center point To are calibrated along the vertical axis according to the translated distance to obtain the final coordinates of the tool center point (that is, the final coordinates of the terminal E).
[0033] Referring to
[0034] In
[0035] Then, as indicated in
[0036] As indicated in
[0037] As indicated in
[0038] Through the above process, the processing unit 120 can obtain the first set of blocking signals and the rotation angle signals (Ø.sub.1, Ø.sub.2, Ø.sub.3, Ø.sub.4) of the second motor 138 and calculate the coordinates of the first point P1 on the tool 102 relative to the center point O.sub.m of the coordinate system of the second motor 138 according to the first set of rotation angle signals (Ø.sub.1, Ø.sub.2, Ø.sub.3, Ø.sub.4) of the second motor 138.
[0039] Referring to
O.sub.t0=[r cos θr sin θ].sup.T; [0041] the position of the first blocking point O.sub.t1 is expressed as:
O.sub.t1=[r cos(θ+Ø.sub.1)r sin(θ+Ø.sub.1)].sup.T; [0042] the position of the second blocking point O.sub.t2 is expressed as:
O.sub.t2=[r cos(θ+Ø.sub.2)r sin(θ+Ø.sub.2)].sup.T; [0043] the position of the third blocking point O.sub.n is expressed as:
O.sub.t3=[r cos(θ+Ø.sub.3)r sin(θ+Ø.sub.3)].sup.T; and [0044] the position of the fourth blocking point O.sub.to is expressed as:
O.sub.t4=[r cos(θ+Ø.sub.4)r sin(θ+Ø.sub.4)].sup.T.
[0045] Since the x coordinates of O.sub.t1 and O.sub.t4 relative to the center point O.sub.m of the coordinate system of the second motor 138 are the same (both are on the X.sub.s axis), the azimuth of the first point P1 on the tool 102 (that is, initial point O.sub.t0) relative to the center point O.sub.m of the coordinate system of the second motor 138 can be obtained, wherein angle θ.sub.1 is expressed as:
θ.sub.1=tan.sup.−1((cos Ø.sub.1−cos Ø.sub.3)/(sin Ø.sub.1−sin Ø.sub.3)) Equation [1]
[0046] Since the y coordinates of O.sub.t2 and O.sub.t4 relative to the center point O.sub.m of the coordinate system of the second motor 138 are the same (both are on the Y.sub.s axis), the azimuth of the first point P1 on the tool 102 (that is, initial point O.sub.t0) relative to the center point O.sub.m of the coordinate system of the second motor 138 can be obtained, wherein angle θ.sub.2 is expressed as:
θ.sub.2=tan.sup.−1((−sin Ø.sub.2+sin Ø.sub.4)/(cos Ø.sub.2−cos Ø.sub.4)) Equation [2]
[0047] Since the azimuth of the initial point O.sub.t0 relative to the center point O.sub.m of the coordinate system of the second motor 138 can be obtained according to equation [1] and equation [2], the final azimuth can be obtained as: θ=(θ.sub.1+θ.sub.2)/2. That is, the azimuth θ of the first point P1 on the tool 102 relative to the center point O.sub.m of the coordinate system of the second motor 138 is calculated and obtained.
[0048] Given that the x coordinates of O.sub.t1 and O.sub.s relative to the center point O.sub.m of the coordinate system of the second motor 138 are the same (both are on the X.sub.s axis), the y coordinates of O.sub.t2 and O.sub.s relative to the center point O.sub.m of the coordinate system of the second motor 138 are the same (both are on the Y.sub.s axis), the x coordinates of O.sub.t3 and O.sub.s relative to the center point O.sub.m of the coordinate system of the second motor 138 are the same (both are on the X.sub.s axis), and the y coordinates of the O.sub.t4 and O.sub.s relative to the center point O.sub.m of the coordinate system of the second motor 138 (both are on the Y.sub.s axis), equation [3] to equation [6] can be obtained as follows:
r.sub.1=d.sub.x/cos(θ+Ø.sub.1)Equation [3],
wherein d.sub.x represents the x axis deviation of the orifice center point O.sub.s relative to the center point O.sub.m of the coordinate system of the second motor 138;
r.sub.2=d.sub.y/sin(θ+Ø.sub.2) Equation [4],
wherein d.sub.y represents the y axis deviation of the orifice center point O.sub.s relative to the center point O.sub.m of the coordinate system of the second motor 138;
r.sub.3=d.sub.x/cos(θ+Ø.sub.3) Equation [5]; and
r.sub.4=d.sub.y/sin(θ+Ø.sub.4) Equation [6].
[0049] Since the distance of the initial point O.sub.t0 relative to the center point O.sub.m of the coordinate system of the second motor 138 can be obtained according to equation [3] to equation [6], the final distance, that is, the distance r of the first point P1 on the tool 102 relative to the center point O.sub.m of the coordinate system of the second motor 138 can be obtained as: r=(r.sub.1+r.sub.2+r.sub.3+r.sub.4)/4.
[0050] Likewise, after the first motor 131 drives the uni-axis actuator 132 to translate the cross laser sensors 113 upward or downward, the position of the point by which the tool 102 intersecting the sensing plane of the cross laser sensors 113 changes (as indicated in
[0051] Referring to
[0052] Referring to
[0053] The cross laser calibration device and the calibration system using the same disclosed in above embodiments of the present disclosure are capable of calibrating the tool center point of the tool on the robotic arm of different makes. During calibration process, the processing unit does not need to perform two-way communication with the controller of the robotic arm, so that the cross laser calibration device of the present embodiment can be shared by the robotic arms of different manufactures. Furthermore, since the calibration process is the same regardless of the manufactures of the robotic arms, calibration becomes more convenient and calibration cost is reduced.
[0054] It will be apparent to those skilled in the art that various modifications and variations can be made to the disclosed embodiments. It is intended that the specification and examples be considered as exemplary only, with a true scope of the disclosure being indicated by the following claims and their equivalents.