Robot positioning method and calibration method
원문보기
IPC분류정보
국가/구분
United States(US) Patent
등록
국제특허분류(IPC7판)
G05B-019/18
G05B-019/04
출원번호
US-0013690
(2011-01-25)
등록번호
US-8688274
(2014-04-01)
우선권정보
TW-99142245 A (2010-12-03)
발명자
/ 주소
Shieh, Po-Huang
Lu, Shang-Chieh
Jiang, Bor-Tung
Huang, Kuo-Tang
Chang, Chin-Kuei
출원인 / 주소
Industrial Technology Research Institute
대리인 / 주소
Morris Manning & Martin LLP
인용정보
피인용 횟수 :
0인용 특허 :
8
초록▼
A robot positioning method includes the following steps. A optical sensing device is configured at a front end of a robot. Then, the optical sensing device captures a calibration plate image, and a relative position of the optical sensing device with respective to a calibration plate is calculated a
A robot positioning method includes the following steps. A optical sensing device is configured at a front end of a robot. Then, the optical sensing device captures a calibration plate image, and a relative position of the optical sensing device with respective to a calibration plate is calculated according to a Bundle Adjustment. A robot calibration method includes the following steps. An optical sensing device is driven to rotate around a reference axis of a calibration plate, so as to calculate a translation matrix between the calibration plate and the robot, and the optical sensing device is driven to translate along three orthogonal reference axes of the calibration plate, so as to calculate a rotation matrix between the calibration plate and the robot.
대표청구항▼
1. A robot positioning method, comprising: providing a robot, having a control unit, wherein an optical sensing device is disposed on a front end of the robot, and the optical sensing device has an optical sensing device coordinate system fixed thereon, wherein the optical sensing device comprises a
1. A robot positioning method, comprising: providing a robot, having a control unit, wherein an optical sensing device is disposed on a front end of the robot, and the optical sensing device has an optical sensing device coordinate system fixed thereon, wherein the optical sensing device comprises a lens and a charge coupled device (CCD), the CCD has an optical sensing surface and has an optical sensing surface coordinate system fixed on the optical sensing surface;providing a calibration plate, wherein multiple positioning marks are disposed on a surface of the plate, and the calibration plate has a calibration plate coordinate system fixed thereon; andperforming a positioning step, comprising:capturing by the optical sensing device a calibration plate image; andaccording to the calibration plate image, calculating by the control unit a transformation matrix between the optical sensing device coordinate system and the calibration plate coordinate system and an optical sensing device-calibration plate coordinate value;wherein the step of calculating the transformation matrix comprises:capturing by the control unit a positioning mark-calibration plate coordinate value of each positioning mark in the calibration plate coordinate system;capturing by the control unit a positioning mark-optical sensing surface coordinate value of each positioning mark in the calibration plate image in the optical sensing surface coordinate system; andsubstituting by the control unit the positioning mark-calibration plate coordinate values, the positioning mark-optical sensing surface coordinate values, and a focal length value of the lens into a Bundle Adjustment formula, to calculate multiple matrix elements of the transformation matrix and the optical sensing device-calibration plate coordinate value, wherein the Bundle Adjustment formula is as follows: xa-x0=-f[m11(XA-XL)+m12(YA-YL)+m13(ZA-ZL)m31(XA-XL)+m32(YA-YL)+m33(ZA-ZL)]ya-y0=-f[m21(XA-XL)+m22(YA-YL)+m23(ZA-ZL)m31(XA-XL)+m32(YA-YL)+m33(ZA-ZL)]where xa and ya are the positioning mark-optical sensing surface coordinate value of the positioning mark in the optical sensing surface coordinate system, x0 and y0 are a projection center of the optical sensing surface coordinate system, mij is the matrix element of the transformation matrix between the optical sensing device coordinate system and the calibration plate coordinate system, where i: 1 to 3 and j: 1 to 3 , XA, YA, and ZA are the positioning mark-calibration plate coordinate value of the positioning mark in the calibration plate coordinate system, and XL, YL and ZL are the optical sensing device-calibration plate coordinate value of the optical sensing device in the calibration plate coordinate system. 2. A robot calibration method, comprising: providing a robot, having a control unit and a base, wherein a base coordinate system is fixed on the base, an optical sensing device is disposed on a front end of the robot, and the optical sensing device has an optical sensing device coordinate system fixed thereon;providing a calibration plate, wherein multiple positioning marks are disposed on a surface of the plate, and the calibration plate has a calibration plate coordinate system fixed thereon;driving by the control unit the robot to rotate around one point on a coordinate axis of the calibration plate coordinate system as a center point, and recording multiple rotation positions of the optical sensing device;according to the rotation positions, performing the positioning step according to claim 1, wherein the control unit calculates multiple rotation coordinate values of the rotation positions in the calibration plate coordinate system;according to the rotation coordinate values, calculating by the control unit a center point-calibration plate coordinate value of the center point in the calibration plate coordinate system;calculating by the control unit a center point-base coordinate value of the center point in the base coordinate system;according to the center point-base coordinate value and the center point-calibration plate coordinate value, calculating by the control unit a translation matrix between the calibration plate coordinate system and the base coordinate system;driving by the control unit the robot to translate once sequentially along three orthogonal axes of the calibration plate coordinate system, and recording multiple translation positions of the optical sensing device in the calibration plate coordinate system;according to the translation positions, performing the positioning step according to claim 1, wherein the control unit calculates a translation coordinate value of each translation position in the calibration plate coordinate system;according to the translation coordinate values, calculating by the control unit three translation direction vectors in parallel with the three orthogonal axes of the calibration plate coordinate system; andaccording to the three translation direction vectors and direction vectors of base coordinate axes, calculating by the control unit a rotation matrix between the calibration plate coordinate system and the base coordinate system. 3. The robot calibration method according to claim 2, further comprising a checking step, wherein the checking step comprises: according to a relational expression, the translation matrix, and the rotation matrix between the calibration plate coordinate system and the base coordinate system, calculating by the control unit a relative position between the calibration plate coordinate system and the base coordinate system, wherein the relational expression is as follows: PG=PR×R+T where PG is an origin coordinate value in the calibration plate coordinate system, PR is an origin coordinate value in the base coordinate system, R is the rotation matrix, and T is the translation matrix. 4. A robot positioning method, comprising: providing a robot, having a control unit, wherein an optical sensing device is disposed on a front end of the robot, and the optical sensing device has an optical sensing device coordinate system fixed thereon, wherein the optical sensing device comprises a lens and a charge coupled device (CCD), the CCD has an optical sensing surface and has an optical sensing surface coordinate system fixed on the optical sensing surface;providing a calibration plate, wherein multiple positioning marks are disposed on a surface of the plate, and the calibration plate has a calibration plate coordinate system fixed thereon; andperforming a positioning step, comprising:capturing by the optical sensing device a calibration plate image; andaccording to the calibration plate image, calculating by the control unit a transformation matrix between the optical sensing device coordinate system and the calibration plate coordinate system and an optical sensing device-calibration plate coordinate value;wherein the step of calculating the transformation matrix comprises:capturing by the control unit a positioning mark-calibration plate coordinate value of each positioning mark in the calibration plate coordinate system;capturing by the control unit a positioning mark-optical sensing surface coordinate value of each positioning mark in the calibration plate image in the optical sensing surface coordinate system;using one of the positioning mark-optical sensing surface coordinate values as a reference point, and calculating by the control unit a distance value between each of the rest positioning mark-optical sensing surface coordinate values and the reference point; andsubstituting by the control unit the positioning mark-calibration plate coordinate values, the positioning mark-optical sensing surface coordinate values, the distance values, and a focal length value of the lens into a Bundle Adjustment formula to calculate multiple matrix elements in the transformation matrix and the optical sensing device-calibration plate coordinate value, wherein the Bundle Adjustment formula turns to: (xa+δx+Δx)-x0=-f[m11(XA-XL)+m12(YA-YL)+m13(ZA-ZL)m31(XA-XL)+m32(YA-YL)+m33(ZA-ZL)](ya+δy+Δy)-y0=-f[m21(XA-XL)+m22(YA-YL)+m23(ZA-ZL)m31(XA-XL)+m32(YA-YL)+m33(ZA-ZL)]where{δx=x_(k1r2+k2r4)δy=y_(k1r2+k2r4)Δx=(1+p3r2)[p1(r2+2x_2)+2p2xy_]Δy=(1+p3r2)[2p1xy_+p2(r2+2y_2)],xa and ya are the positioning mark-optical sensing surface coordinate value of the positioning mark in the optical sensing surface coordinate system, x0 and y0 are a projection center of the optical sensing surface coordinate system, r is the distance value between each positioning mark-optical sensing surface coordinate value and the reference point, mij is the matrix element in the transformation matrix between the optical sensing device coordinate system and the calibration plate coordinate system, where i: 1 to 3 and j: 1 to 3, XA, YA, and ZA are the positioning mark-calibration plate coordinate value of the positioning mark on three orthogonal coordinate axes of the calibration plate coordinate system, XL, YL, and ZL are the optical sensing device-calibration plate coordinate value of a coordinate center on the orthogonal coordinate axes of the calibration plate coordinate system, K1, K2, K3, P1, P2, and P3 are lens distortion parameter values, δx and δy are a barrel distortion error correction value of the optical sensing device, and Δx and Δy are a tangential distortion error correction value of the optical sensing device.
연구과제 타임라인
LOADING...
LOADING...
LOADING...
LOADING...
LOADING...
이 특허에 인용된 특허 (8)
Watanabe Atsushi,JPX, Calibration method for a visual sensor.
Red Walter E. (Provo UT) Davies Brady R. (Orem UT) Wang Xuguang (Provo UT) Turner Edgar R. (Provo UT), Device and method for correction of robot inaccuracy.
Wang Xuguang (Provo UT) Red Walter E. (Provo UT) Manley Peter H. (Alpine UT), Robot end-effector terminal control frame (TCF) calibration method and device.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.