TWI408037B - 機械手臂的定位方法及校正方法 - Google Patents

機械手臂的定位方法及校正方法 Download PDF

Info

Publication number
TWI408037B
TWI408037B TW099142245A TW99142245A TWI408037B TW I408037 B TWI408037 B TW I408037B TW 099142245 A TW099142245 A TW 099142245A TW 99142245 A TW99142245 A TW 99142245A TW I408037 B TWI408037 B TW I408037B
Authority
TW
Taiwan
Prior art keywords
calibration plate
coordinate system
coordinate
control unit
photosensitive device
Prior art date
Application number
TW099142245A
Other languages
English (en)
Other versions
TW201223724A (en
Inventor
Po Huang Shieh
Shang Chieh Lu
Bor Tung Jiang
Kuo Tang Huang
Chin Kuei Chang
Original Assignee
Ind Tech Res Inst
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Ind Tech Res Inst filed Critical Ind Tech Res Inst
Priority to TW099142245A priority Critical patent/TWI408037B/zh
Priority to CN201010602964.5A priority patent/CN102485441B/zh
Priority to US13/013,690 priority patent/US8688274B2/en
Publication of TW201223724A publication Critical patent/TW201223724A/zh
Application granted granted Critical
Publication of TWI408037B publication Critical patent/TWI408037B/zh

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1692Calibration of manipulator
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39045Camera on end effector detects reference pattern

Description

機械手臂的定位方法及校正方法
本提案係有關一種機械手臂,且特別是有關於一種機械手臂的定位方法及校正方法。
近十幾年來,工業上常利用機械手臂來達成自動化的生產過程,然而,大部份機械手臂的應用仍侷限於處理具有重覆流程的案件,而處理這些案件必須由一位有經驗的操作員事先操作機械手臂,以教導機械手臂沿著固定的軌跡移動。但在小型化、多樣少量生產型態的電子產業中,這種利用操作員教導機械手臂的做法在自動化生產過程中將需要耗費很多的時間,進而增加生產製造上的成本。因此,習知技術發展出一種利用攝影裝置來引導機械手臂的方法以取代需操作員教導機械手臂之舊有的方法。但這種利用攝影裝置來引導機械手臂的方法還需另外結合立體視覺模組,以縮短校正機械手臂的時間。
在視覺導引的機械手臂(Vision Guided Robot,VGR)系統中,攝影裝置的校正與手眼(Hand-Eye)校正將顯的格 外重要。因此如何建立一套機械手臂的定位方法和校正方法,藉此方法取得機械手臂與物件的轉換矩陣及攝影裝置的扭曲誤差值將是未來所面臨重要的問題之一。
以美國專利第7161321號專利案(以下簡稱’321案)為例,於機械手臂校正時,係將一針狀物架設於機械手臂的前端。機械手臂另具有一驅動單元,並搭配一套位於機械手臂外部的一監控裝置以進行機械手臂的校正。監控裝置包括一攝影裝置、一顯示裝置及一控制單元,其中,攝影裝置設置於一固定處。’321案所揭露的校正方法是導引位於機械手臂上之針狀物移至攝影裝置的畫面中,並藉由攝影裝置擷取針狀物之尖點的畫面。之後,將尖點的畫面回傳至顯示裝置,並經由控制單元計算出機械手臂與顯示裝置間的轉換矩陣,再經由控制單元驅使機械手臂移動至顯示裝置的位置。
然而,’321案之監控裝置係配置於機械手臂外部之設備,在購買機械手臂時還需要額外添購監控裝置。是以,’321案所揭露的技術存在著高設備成本的問題。另外,’321案於每次校正機械手臂前,需將配置於機械手臂外部之監控裝置電性連接於機械手臂上,故在校正前需額外花費前置時間去電性連接監控裝置於機械手臂上,進而增加校正機械手臂的程序,並降低機械手臂的校正效率。此外,在校正機械手臂的過程中,攝影裝置擷取尖狀物的畫面後,需回傳至配置於機械手臂外部的監控裝置,並利用此監控裝置 計算出機械手臂與物件間的轉移矩陣,再依據其轉移矩陣導引機械手臂移動至顯示裝置的位置,並無法及時將轉移矩陣回傳至機械手臂,故於’321案中的校正方法將面臨校正時間過長的問題。因此於’321案中將面臨校正前的前置時間過久、高設備成本及校正時間過長的問題。
鑒於以上的問題,本提案提供一種機械手臂的定位方法及校正方法,經由將感光裝置配置於機械手臂前端,且依據感光裝置與校正板之間的空間關係,找出校正板與機械手臂的空間關係,藉以改善習知技術所面臨之高設備成本及校正時間過長的問題。
依據本提案一實施例的機械手臂的定位方法,其包括提供一機械手臂以及一校正板。機械手臂具有一控制單元,且機械手臂的前端具有一感光裝置,另外,感光裝置具有固定於其上的一感光裝置座標系。校正板之一板面上具有多個定位標記,並且校正板具有固定於其上的一校正板座標系。接下來執行一定位步驟,其定位步驟包括經由感光裝置利用光束交會演算法擷取一校正板影像,再將校正板影像回傳至控制單元,並且經由控制單元計算出感光裝置座標系與校正板座標系之一轉換矩陣以及一感光裝置校正板座標值。
依據本提案一實施例之機械手臂的定位方法,感光裝置具有一透鏡及一電荷耦合裝置(Charge Coupled Device,CCD),其中透鏡具有多個鏡頭扭曲值,求得感光裝置座標系與校正板座標系之一轉換矩陣以及一感光裝置校正板座標值之方法包括經由控制單元擷取每一定位標記之校正板座標系的一定位標記校正板座標值,經由這些控制單元擷取這些校正板影像中每一定位標記之這些感光面座標系的一定位標記感光面座標值。另外,以這些定位標記感光面座標值其中之一作為一基準點,經由這些控制單元計算其餘之定位標記感光面座標值與這些基準點之間的距離值。
並且,經由這些控制單元將這些定位標記校正板座標值、這些定位標記感光面座標值、這些距離值以及這些透鏡之一焦距值代入一光束交會演算公式以計算這些轉換矩陣之多個矩陣元素及這些感光裝置校正板座標值。
依據本提案一實施例之機械手臂的校正方法,其包括提供一機械手臂,具有一控制單元及一基座,基座具有固定於其上的一基座座標系,其中,機械手臂的前端具有一感光裝置,感光裝置具有固定於其上的一感光裝置座標系。並提供一校正板,校正板之一板面上具有多個定位標記,並校正板具有固定於其上的一校正板座標系。
接著經由控制單元驅使機械手臂以校正板座標系之一座標軸的一點為圓心旋轉,並且紀錄感光裝置之多個旋轉位置。再依據這些旋轉位置,進行前述機械手臂的定位方法中之定位步驟,並且經由控制單元計算這些旋轉位置在 校正板座標系之多個旋轉座標值,將這些旋轉座標值回傳至控制單元,並經由控制單元計算出圓心於校正板座標系之一圓心校正板座標值。另外,經由控制單元計算出圓心在基座座標系的一圓心基座座標值。之後,經由控制單元計算出校正板座標系與基座座標系之間的一平移矩陣。
接下來計算校正板座標系與基座座標系的旋轉矩陣,其包括經由控制單元驅使機械手臂依序沿校正板座標系之三正交軸各平移一次,並且紀錄感光裝置於校正板座標系的多個平移位置。之後,依據這些平移位置,進行機械手臂的定位方法中之定位步驟,以經由控制單元計算這些平移位置於校正板座標系之一平移座標值。依據這些平移座標值,經由控制單元計算出與校正板座標系三正交軸平行之三平移方向向量。之後,依據平移方向向量與基座座標軸之方向向量,經由控制單元計算出校正板座標系與基座座標系之間的一旋轉矩陣。
依據本提案一實施例之機械手臂的定位方法及校正方法,其係將感光裝置直接配置在機械手臂的前端,搭配校正板求得感光裝置在校正板座標系中的位置,即本提案係利用於機械手臂上的感光裝置搭配校正板,藉以取代習知技術中將感光裝置、控制單元和顯示裝置電性連接於機械手臂,搭配設置於機械手臂前端之一針狀物的校正方式。
在校正的過程中,由於感光裝置直接架設於機械 手臂上,感光裝置擷取影像後直接回傳至機械手臂之顯示裝置,故不需要額外架設顯示裝置,是以相較於習知技術而言,這種將感光裝置架設於機械手臂的方法能夠節省設置設備的成本。
依據本提案之一實施例之機械手臂的定位方法及校正方法,當機械手臂需校正時,可任意擺放校正板於一定位處,而不需如習知技術所揭露的針狀物需架設於機械手臂上,是以相較於習知技術而言,用校正板取代針狀物的方法能夠節省前置安裝的時間。
另外,當考量鏡面修正變形誤差值時,本提案係將扭曲誤差值一併帶入光束交會演算法,藉以利用感光裝置擷取影像,並經由控制單元同時計算出轉換矩陣和扭曲誤差值,是以相較於習知技術而言,考量鏡面修正變形誤差值能夠增加其校正之精確度。
以上之關於本提案內容之說明及以下之實施方式之說明係用以示範與解釋本提案之原理,並且提供本提案之專利申請範圍更進一步之解釋。
100‧‧‧機械手臂
110‧‧‧基座
111‧‧‧基座座標系
120‧‧‧控制單元
200‧‧‧感光裝置
210‧‧‧透鏡
220‧‧‧電荷耦合裝置
221‧‧‧感光面
222‧‧‧感光面座標系
222a‧‧‧定位標記感光面座標值
222c‧‧‧投影中心
230‧‧‧感光裝置座標系
300‧‧‧校正板
310‧‧‧定位標記
320‧‧‧校正板座標系
330‧‧‧校正板影像
330a‧‧‧感光裝置校正板座標值
330b‧‧‧定位標記校正板座標值
340‧‧‧定位標記A
410‧‧‧圓心
420‧‧‧第一旋轉位置
430‧‧‧第二旋轉位置
440‧‧‧第三旋轉位置
450‧‧‧第一平移位置
460‧‧‧第二平移位置
470‧‧‧第三平移位置
480‧‧‧第四平移位置
第1圖為本提案一實施例之機械手臂的定位方法及校正方法的定位步驟流程圖。
第2圖為本提案一實施例之機械手臂的定位方法及校正方 法的定位方法流程圖。
第3圖為本提案一實施例之機械手臂的定位方法及校正方法之具鏡頭扭曲修正的定位方法流程圖。
第4圖、第5圖及第6圖為本提案一實施例之機械手臂的定位方法及校正方法之感光裝置旋轉及平移的操作流程圖。
第7圖為本提案一實施例之機械手臂的定位方法及校正方法的檢驗方法流程圖。
第8圖為本提案一實施例之機械手臂的定位方法及校正方法之機械手臂校正裝置的平面示意圖。
第9A圖為本提案一實施例之機械手臂的定位方法及校正方法之感光裝置200的分解示意圖。
第9B圖為本提案一實施例之機械手臂的定位方法及校正方法之感光面221的示意圖。
第10A圖為本提案一實施例之機械手臂的定位方法及校正方法之校正板座標系320的示意圖。
第10B圖為本提案一實施例之機械手臂的定位方法及校正方法之感光面座標系222的示意圖。
第11A圖為本提案一實施例之機械手臂的定位方法及校正方法之感光裝置200的旋轉示意圖。
第11B圖為本提案一實施例之機械手臂的定位方法及校正方法之感光裝置200的平移示意圖。
依據提案一實施例所揭露的機械手臂校正系統,其係先提供一機械手臂校正系統。請參閱「第8圖」至「第9B圖」,機械手臂校正系統包括有一機械手臂100、一感光裝置200、一校正板300。其中,機械手臂100具有一基座110及一控制單元120。感光裝置200例如具有一透鏡210及一電荷耦合裝置220(Charge Coupled Device,CCD)且電荷耦合裝置220具有一感光面221,校正板300之板面上具有多個定位標記310。此外,基座110具有一基座座標系111,感光裝置200具有一感光裝置座標系230,感光面221具有一感光面座標系222,校正板300具有一校正板座標系320。
基於上述之機械手臂100、感光裝置200、校正板300,本提案便能夠進行一定位步驟,以求得感光裝置200與校正板300之間的相對位置。以下將對此定位步驟進行描述,請參閱「第1圖」及「第8圖」至「第10A圖」。首先,在步驟S101中,本提案係經由控制單元120移動機械手臂100,使得校正板300位於感光裝置200的光感應範圍內。之後,由於校正板300的影像會經由透鏡210而映射於電荷耦合裝置220,是以感光裝置200能夠擷取一校正板影像330。之後,在步驟S102中,本提案係依據校正板影像330,經由控制單元120計算感光裝置座標系230與校正板座標系320之一轉換矩陣以及一感光裝置校正板座標值330a。
以下將針對定位步驟S102進行舉例說明,請參閱「第2圖」及「第8圖」至「第9B圖」。首先,在步驟S201中,本提案係經由控制單元120擷取校正板300上之每一定位標記310之校正板座標系320的一定位標記校正板座標值330b。之後,在步驟S202中,本提案係經由控制單元120 擷取校正板影像330中每一定位標記310之感光面座標系222的一定位標記感光面座標值222a。然後,在步驟S203中,本提案係經由控制單元120將這些定位標記校正板座標值330b、這些定位標記感光面座標值222a以及透鏡210之一焦距值代入一光束交會演算公式以計算感光裝置座標系230與校正板座標系320之轉換矩陣之多個矩陣元素及感光裝置校正板座標值330a。
其中,在步驟S203所提及之光束交會演算公式為
其中,若選取校正板300上之任一定位標記310作為一定位標記A時,則上述演算公式中的xa與ya為定位標記A之感光面座標系222的定位標記感光面座標值222a,x0與y0為感光面座標系222之一投影中心222c,mij為感光裝置座標系230與校正板座標系320間之轉換矩陣的矩陣元素,其中,i:1~3、j:1~3、XA、YA與ZA為定位標記A之校正板座標系320的三個彼此正交的座標軸的定位標記校正板座標值330b,XL、YL與ZL為座標中心於校正板座標系320之彼此正交的座標軸的感光裝置校正板座標值330a。
以下將對求得轉換矩陣及感光裝置校正板座標值330a的詳細步驟進行舉例說明。首先,經由感光裝置200擷取一校正板影像330,再將感光裝置200擷取之校正板影像330回傳至控制單元120,並且以感光面座標系222描述校正板影像330上的每個定位標記310的位置。之後,在校正板300上選定一定位標記340,並且經由控制單元120擷取此定位標記340 在校正板座標系320中的定位標記校正板座標值,即(XA,YA,ZA)。之後,在校正板影像330上選取定位標記340的影像於感光面座標系222中的感光面座標值,即(xa,ya)。
接下來,經由控制單元120將(XA,YA,ZA)、(xa,ya)以及透鏡210之一焦距值f代入光束交會演算公式,以獲得一方程式。
接下來,逐一選取其餘的定位標記310,並將其餘定位標校正板座標值330b、其餘定位標記感光面座標值222a及透鏡210之焦距值代入光束交會公式,以獲得多個方程式。接著,經由控制單元120利用最小平方法迭代出感光裝置座標系230與校正板座標系320間之轉換矩陣的所有矩陣元素及感光裝置200之感光裝置校正板座標值。
以本實施例來說,校正板300上的定位標記310的數量為49個,是以經由這些定位標記310則會產生98個方程式。因此,本實施例便可以將此98個方程式利用控制單元120以最小平方法迭代出感光裝置座標系230與校正板座標系320間之轉換矩陣的多個矩陣元素及感光裝置200之感光裝置校正板座標值330a。
此外,在依據本提案的其他實施例中,本提案更可以依據透鏡210之多個鏡頭扭曲值來修正上述之光束交會演算公式,以更準確地求得感光裝置200與校正板300之間的相對位置。
以下將對此鏡頭扭曲值修正步驟進行描述。請參閱「第3圖」與「第8圖」至「第9B圖」。首先,在S301步驟中,本提案係經由控制單元120擷取每一定位標記310之校正板座標系320的一定位標記校正板座標值330b。之後,在S302步驟中,本提案係經由控制單元120擷取校正 板影像330中每一定位標記310之感光面座標系222的一定位標記感光面座標值222a。然後,在S303步驟中,本提案係以定位標記感光面座標值222a其中之一作為一基準點,經由控制單元120計算其餘之每一定位標記感光面座標值222a與基準點之間的距離值。之後,在S304步驟中,本提案係經由控制單元120將這些定位標記校正板座標值330b、這些定位標記感光面座標值222a、這些距離值以及透鏡210之一焦距值代入一光束交會演算公式以計算轉換矩陣之多個矩陣元素及感光裝置校正板座標值330a。
以下針對鏡頭扭曲值修正步驟進行詳細步驟之舉例說明。首先,經由感光裝置200擷取一校正板影像330,再將感光裝置200擷取之校正板影像330回傳至控制單元120,並以感光面座標系222描述校正板影像330上的每個定位標記310的位置。之後,在校正板300上選定一定位標記340,並且經由控制單元120擷取此定位標記340在校正板座標系320中的定位標記校正板座標值,即(XA,YA,ZA)。之後,在校正板影像330上選取定位標記340的影像於感光面座標系222中的感光面座標值,即(xa,ya)。
再來,經由一鏡頭扭曲值修正方法,以將原本的定位標記感光面座標值222a加上桶狀失真誤差修正值及切線失真誤差修正值,得到鏡頭扭曲值修正公式,鏡頭扭曲值修正公式為
其中,δx與δy為感光裝置200之一桶狀失真誤差修正值,△x與△y為感光裝置200之一切線失真誤差修正值。
接著將加入鏡頭扭曲值修正方法後的定位標記感光面座標 值222a代入光束交會演算公式,產生一具有鏡頭扭曲值修正方法之光束交會演算公式,具有鏡頭扭曲值修正方法之光束交會演算公式為 其中,
其中,若選取校正板300上之任一定位標記310作為一定位標記A時,則上述演算公式中的xa與ya為定位標記A之感光面座標系222的定位標記感光面座標值222a,x0與y0為感光面座標系222之一投影中心222c,r為定位標記A感光面座標值與基準點之間的距離值,mij為感光裝置座標系230與校正板座標系320間之轉換矩陣的矩陣元素,其中,i:1~3、j:1~3、XA、YA與ZA為定位標記A之校正板座標系320的三個彼此正交的座標軸的定位標記校正板座標值330b,XL、YL與ZL為座標中心於校正板座標系320之彼此正交的座標軸的感光裝置校正板座標值330a,K1、K2、K3、P1、P2與P3為鏡頭扭曲參數值,δx與δy為感光裝置200之一桶狀失真誤差修正值,△x與△y為感光裝置200之一切線失真誤差修正值。
再者,依據本提案之一實施例,本提案更可以利用上述之機械手臂之定位步驟,以進行一機械手臂的校正步驟。請參閱「第4圖」至「第6圖」,在本實施例中,機械手臂的校正步驟區分為兩部份,其分別為一求取平移矩陣的校正步驟以及一求取旋轉矩陣的校正步驟,其中平移矩陣的校正步驟包括S401~S405,旋轉矩陣的校正步驟包括S406~S409。
以下先針對平移矩陣的校正步驟進行詳細說明,請繼續參閱「第8圖」至「第11B圖」,首先,在步驟S401中,本提案係經由控制單元120驅使機械手臂100以校正板座標系320之一座標軸的一點為圓心410旋轉,並且紀錄感光裝置200之多個旋轉位置。之後,在步驟S402中,本提案係依據這些旋轉位置,進行上述之機械手臂的定位步驟,以經由控制單元120計算每一旋轉位置在校正板座標系320之旋轉座標值。然後,在步驟S403中,本提案係依據這些旋轉座標值,經由控制單元120計算出圓心410於校正板座標系320之一圓心校正板座標值。接著,在步驟S404中,本提案係經控制單元120計算出圓心410在基座座標系111的一圓心基座座標值。之後,在步驟S405中,本提案係依據圓心基座座標值及圓心校正板座標值,經由控制單元120計算出校正板座標系320與基座座標系111之間的一平移矩陣。
舉例來說,經控制單元120驅使機械手臂100以校正板座標系320之一座標軸的一點為圓心410旋轉,得到感光裝置200三個旋轉位置,分別為第一旋轉位置420、第二旋轉位置430與第三旋轉位置440。再藉由上述之機械手臂的定位方法求得這三個旋轉位置420~430於校正板座標系320的旋轉座標值(x1,y1,z1)、(x2,y2,z2)以及(x3,y3,z3)。接著利用三個旋轉座標值(x1,y1,z1)、(x2,y2,z2)以及(x3,y3,z3)求得圓心410於校正板座標系320之圓心校正板座標值(xp,yp,zp)。再來藉由控制單元120計算出圓心410位置於基座座標系111之圓心基座座標值(xq,yq,zq),則[(xp-xq)(yp-yq)(zp-zq)]為基座座標系111與校正板座標系320之平移矩陣。
接下來將對旋轉矩陣的校正步驟進行詳細說明,首先,在 步驟S406中,本提案係經由控制單元120驅使機械手臂100依序沿校正板座標系320之三正交軸各平移一次,並且紀錄感光裝置200於校正板座標系320的多個平移位置。之後,在步驟S407中,本提案係依據這些平移位置,進行上述機械手臂100之定位步驟,以經由控制單元120計算每一平移位置於校正板座標系320之一平移座標值。再來,在步驟S408中,本提案係依據些平移座標值,經由控制單元計算出與校正板座標系三正交軸平行之三平移方向向量。然後,在步驟S409中,本提案係依據這些平移座標值,經由控制單元120計算出與校正板座標系320三正交軸平行之三平移方向向量。
舉例來說,首先,經由控制單元120驅使機械手臂100依序沿校正板座標系320之三正交軸,u軸、v軸與w軸各平移一次,得到四個平移位置,分別為第一平移位置450,第二平移位置460,第三平移位置470,第四平移位置480,並且紀錄感光裝置200於校正板座標系320的4個平移位置,再依據上述之機械手臂的定位步驟,藉由控制單元120計算出這些平移位置450~470於校正板座標系320之平移座標值(u1,v1,w1)、(u2,v1,w1)、(u1,v3,w1)以及(u1,v1,w4)。之後,再經由控制單元120依據這些平移座標值計算出與校正板座標系320三正交軸平行之三個平移方向向量,其中,平移方向向量1為[(u2-u1),0,0],平移方向向量2為[0,(v3-v1),0],平移方向向量3為[0,0,w4-w1],並且,3個平移方向向量分別代表校正板座標系320之三正交軸之方向向量。最後,藉由控制單元120依據三個平移方向向量與基座三座標軸之方向向量間之關係計算出校正板座標系320與基座座標系111之間的一旋轉矩陣。
請參閱「第7圖」,依據本提案一實施例所揭露之機械手臂的校正方法,更包括一檢驗步驟。在步驟S501中,本提案係依據校正板座標系320與基座座標系111之一關係式、平移矩陣與旋轉矩陣,經由控制單元120計算校正板座標系320與基座座標系111之一相對位置。
其中,在步驟S501中所提及的關係式為PG=PR×R+T
其中,PG為一校正座原點座標值,PR為基座原點座標值,R為旋轉矩陣,T為平移矩陣。
依據本提案一實施例之機械手臂的定位方法及校正方法,其係將感光裝置200直接配置在機械手臂100的前端,搭配校正板300求得感光裝置200在校正板座標系320中的位置,即本提案係利用於機械手臂100上的感光裝置200搭配校正板300,藉以取代習知技術中將感光裝置、控制單元120和顯示裝置電性連接於機械手臂,搭配設置於機械手臂前端之一針狀物的校正方式。
在校正的過程中,由於感光裝置200直接架設於機械手臂100上,感光裝置200擷取影像後直接回傳至機械手臂100之控制單元120,故不需要額外架設監控裝置,是以相較於習知技術而言,這種將感光裝置200架設於機械手臂的方法能夠節省設置設備的成本。
依據本提案之一實施例之機械手臂的定位方法及校正方法,當機械手臂100需校正時,可任意擺放校正板300於一定位處,而不需如習知技術所揭露的針狀物需架設於機械手臂上,是以相較於習知技術而言,用校正板300取代針狀物的方法能夠節省前置安裝的時間。
另外,當考量鏡面修正變形誤差值時,本提案係將扭曲誤差值一併帶入光束交會演算法,藉以利用感光裝置200擷取影像,並經由控制單元120同時計算出轉換矩陣和扭曲誤差值,是以相較於習知技術而言,考量鏡面修正變形誤差值能夠增加其校正之精確度。
雖然本提案之實施例揭露如上所述,然並非用以限定本提案,任何熟習相關技藝者,在不脫離本提案之精神和範圍內,舉凡依本提案申請範圍所述之形狀、構造、特徵、數量及步驟順序當可做些許之變更,因此本提案之專利保護範圍須視本說明書所附之申請專利範圍所界定者為準。
100‧‧‧機械手臂
110‧‧‧基座
111‧‧‧基座座標系
120‧‧‧控制單元
200‧‧‧感光裝置
230‧‧‧感光裝置座標系
300‧‧‧校正板
310‧‧‧定位標記
320‧‧‧校正板座標系
340‧‧‧定位標記A

Claims (4)

  1. 一種機械手臂的定位方法,其包括:提供一機械手臂,具有一控制單元,該機械手臂的前端具有一感光裝置,該感光裝置具有固定於其上的一感光裝置座標系,該感光裝置包括一透鏡以及一電荷耦合裝置(Charge Coupled Device,CCD),該電荷耦合裝置具有一感光面,並具有固定於該感光面之一感光面座標系;提供一校正板,其一板面上具有多個定位標記,並該校正板具有固定於其上的一校正板座標系;及執行一定位步驟,其包括:經由該感光裝置擷取一校正板影像;及依據該校正板影像,經由該控制單元計算該感光裝置座標系與該校正板座標系之一轉換矩陣以及一感光裝置校正板座標值,計算該轉換矩陣的步驟包括:經由該控制單元擷取每一該定位標記之該校正板座標系的一定位標記校正板座標值;經由該控制單元擷取該校正板影像中每一該定位標記之該感光面座標系的一定位標記感光面座標值;及經由該控制單元將該些定位標記校正板座標值、該些定位標記感光面座標值以及該透鏡之一焦距值代入一光束交會演算公式以計算該轉換矩 陣之多個矩陣元素及該感光裝置校正板座標值,該光束交會演算公式為 其中,xa與ya為該定位標記之該感光面座標系的該定位標記感光面座標值,x0與y0為該感光面座標系之一投影中心,mij為該感光裝置座標系與該校正板座標系間之該轉換矩陣的矩陣元素,其中,i:1~3、j:1~3、XA、YA與ZA為該定位標記之該校正板座標系的該定位標記校正板座標值,XL、YL與ZL為該感光裝置於該校正板座標系的該感光裝置校正板座標值。
  2. 一種機械手臂的定位方法,其包括:提供一機械手臂,具有一控制單元,該機械手臂的前端具有一感光裝置,該感光裝置具有固定於其上的一感光裝置座標系,該感光裝置包括一透鏡以及一電荷耦合裝置(CCD),該透鏡具有多個鏡頭扭曲值,該電荷耦合裝置具有一感光面,並具有固定於該感光面之一感光面座標系;提供一校正板,其一板面上具有多個定位標記,並該校正板具有固定於其上的一校正板座標系;及執行一定位步驟,其包括: 經由該感光裝置擷取一校正板影像;及依據該校正板影像,經由該控制單元計算該感光裝置座標系與該校正板座標系之一轉換矩陣以及一感光裝置校正板座標值,計算該轉換矩陣以及該感光裝置校正板座標值的步驟包括:經由該控制單元擷取每一該定位標記之該校正板座標系的一定位標記校正板座標值;經由該控制單元擷取該校正板影像中每一該定位標記之該感光面座標系的一定位標記感光面座標值;以該些定位標記感光面座標值其中之一作為一基準點,經由該控制單元計算其餘之該定位標記感光面座標值與該基準點之間的一距離值;及經由該控制單元將該些定位標記校正板座標值、該些定位標記感光面座標值、該些距離值以及該透鏡之一焦距值代入一光束交會演算公式以計算該轉換矩陣之多個矩陣元素及該感光裝置校正板座標值,該光束交會演算公式則變為 其中,其中,xa、ya為該定位標記之該感光面座標系的該定位標記感光面座標值,x0、y0為該感光面座標系之一投影中心,r為每一該定位標記感光面座標值與該基準點之間的該距離值,mij為該感光裝置座標系與該校正板座標系間之該轉換矩陣的矩陣元素,其中,i:1~3、j:1~3、XA、YA與ZA為該定位標記之該校正板座標系的三個彼此正交的座標軸的該定位標記校正板座標值,XL、YL與ZL為一座標中心於該校正板座標系之彼此正交的座標軸的該感光裝置校正板座標值,K1、K2、K3、P1、P2與P3為鏡頭扭曲參數值,δx與δy為該感光裝置之一桶狀失真誤差修正值,△x與△y為該感光裝置之一切線失真誤差修正值。
  3. 一種機械手臂的校正方法,其包括:提供一機械手臂,具有一控制單元及一基座,該基座具有固定於其上的一基座座標系,該機械手臂的前端具有一感光裝置,該感光裝置具有固定於其上的一感光裝置座標系;提供一校正板,其一板面上具有多個定位標記,並該 校正板具有固定於其上的一校正板座標系;經由該控制單元驅使該機械手臂以該校正板座標系之一座標軸上的一點為一圓心旋轉,並且紀錄該感光裝置之多個旋轉位置;依據該些旋轉位置,進行如請求項1所述之該定位步驟,以經由該控制單元計算該些旋轉位置在該校正板座標系之多個旋轉座標值;依據該些旋轉座標值,經由該控制單元計算出該圓心於該校正板座標系之一圓心校正板座標值;經該控制單元計算出該圓心在該基座座標系的一圓心基座座標值;依據該圓心基座座標值及該圓心校正板座標值,經由控制單元計算出該校正板座標系與該基座座標系之間的一平移矩陣;經由該控制單元驅使該機械手臂依序沿該校正板座標系之三正交軸各平移一次,並且紀錄該感光裝置於該校正板座標系的多個平移位置;依據該些平移位置,進行如請求項1所述之該定位步驟,以經由該控制單元計算該些平移位置於該校正板座標系之一平移座標值;依據該些平移座標值,經由該控制單元計算出與該校正板座標系三正交軸平行之三平移方向向量;及 依據該三平移方向向量與該基座座標軸之方向向量,經由該控制單元計算出該校正板座標系與該基座座標系之間的一旋轉矩陣。
  4. 如請求項3所述之機械手臂的校正方法,其更包括一檢驗步驟,該檢驗步驟包括:依據該校正板座標系與該基座座標系之一關係式、該平移矩陣、該旋轉矩陣,經由該控制單元計算該校正板座標系與該基座座標系之一相對位置,該關係式為PG=PR×R+T其中,PG為一校正座原點座標值,PR為一基座原點座標值,R為該旋轉矩陣,T為該平移矩陣。
TW099142245A 2010-12-03 2010-12-03 機械手臂的定位方法及校正方法 TWI408037B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
TW099142245A TWI408037B (zh) 2010-12-03 2010-12-03 機械手臂的定位方法及校正方法
CN201010602964.5A CN102485441B (zh) 2010-12-03 2010-12-23 机械手臂的定位方法及校正方法
US13/013,690 US8688274B2 (en) 2010-12-03 2011-01-25 Robot positioning method and calibration method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW099142245A TWI408037B (zh) 2010-12-03 2010-12-03 機械手臂的定位方法及校正方法

Publications (2)

Publication Number Publication Date
TW201223724A TW201223724A (en) 2012-06-16
TWI408037B true TWI408037B (zh) 2013-09-11

Family

ID=46151033

Family Applications (1)

Application Number Title Priority Date Filing Date
TW099142245A TWI408037B (zh) 2010-12-03 2010-12-03 機械手臂的定位方法及校正方法

Country Status (3)

Country Link
US (1) US8688274B2 (zh)
CN (1) CN102485441B (zh)
TW (1) TWI408037B (zh)

Families Citing this family (40)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6108860B2 (ja) * 2013-02-14 2017-04-05 キヤノン株式会社 ロボットシステム及びロボットシステムの制御方法
JP2014180720A (ja) * 2013-03-19 2014-09-29 Yaskawa Electric Corp ロボットシステム及びキャリブレーション方法
WO2014161603A1 (en) * 2013-04-05 2014-10-09 Abb Technology Ltd A robot system and method for calibration
JP6468741B2 (ja) * 2013-07-22 2019-02-13 キヤノン株式会社 ロボットシステム及びロボットシステムの校正方法
CN103519902B (zh) * 2013-10-28 2015-09-09 杭州三坛医疗科技有限公司 无创式实时手术定位导航设备
CN104827480A (zh) * 2014-02-11 2015-08-12 泰科电子(上海)有限公司 机器人系统的自动标定方法
CN104482856A (zh) * 2014-12-17 2015-04-01 顾莹 一种医用诊断仪器上耗材的定位方法和系统
GB201509341D0 (en) 2015-05-29 2015-07-15 Cambridge Medical Robotics Ltd Characterising robot environments
JP6267157B2 (ja) * 2015-05-29 2018-01-24 ファナック株式会社 位置補正機能を有するロボットを備えた生産システム
US10547796B2 (en) * 2015-07-14 2020-01-28 Industrial Technology Research Institute Calibration equipment and calibration method of a mechanical system
JP6812095B2 (ja) * 2015-10-22 2021-01-13 キヤノン株式会社 制御方法、プログラム、記録媒体、ロボット装置、及び物品の製造方法
TWI557522B (zh) * 2015-11-05 2016-11-11 財團法人工業技術研究院 校正方法與校正設備
CN106144582A (zh) * 2016-08-30 2016-11-23 苏州康贝尔电子设备有限公司 一种用于led自动收料机的机械手固定座装配体
TWI614103B (zh) * 2016-10-21 2018-02-11 和碩聯合科技股份有限公司 機械手臂定位方法及應用其的系統
TWI617995B (zh) * 2016-11-04 2018-03-11 廣明光電股份有限公司 機器人視覺定位的驗證方法
US11285609B2 (en) * 2016-11-17 2022-03-29 Fuji Corporation Working position correcting method and working robot
CN108064197B (zh) * 2016-12-30 2021-04-06 深圳配天智能技术研究院有限公司 确定码垛点位置信息的方法、装置及机器人
JP6680720B2 (ja) * 2017-04-10 2020-04-15 ファナック株式会社 ロボットの動作軌跡を自動で生成する装置、システム、および方法
JP6815924B2 (ja) * 2017-04-19 2021-01-20 トヨタ自動車株式会社 キャリブレーション装置
JP6843251B2 (ja) * 2017-09-07 2021-03-17 川崎重工業株式会社 ロボットシステム及びその運転方法
TWI649659B (zh) 2017-10-27 2019-02-01 財團法人工業技術研究院 自動光學檢測影像分類方法、系統及含有該方法之電腦可讀取媒體
CN113059559B (zh) * 2020-01-02 2022-07-12 台达电子工业股份有限公司 机器人工具的校正方法与校正系统
CN108775882B (zh) * 2018-06-01 2019-06-14 山东科技大学 爬行机器人在圆柱类物体表面运动位置的描述方法
US11315231B2 (en) 2018-06-08 2022-04-26 Industrial Technology Research Institute Industrial image inspection method and system and computer readable recording medium
TWI706841B (zh) * 2019-03-22 2020-10-11 達明機器人股份有限公司 3d相機與機械手臂座標系統的校正裝置及方法
TWI699264B (zh) * 2019-07-05 2020-07-21 上銀科技股份有限公司 視覺導引機器手臂校正方法
US20220258352A1 (en) * 2019-07-19 2022-08-18 Siemens Ltd., China Robot hand-eye calibration method and apparatus, computing device, medium and product
TWI758626B (zh) * 2019-08-01 2022-03-21 達明機器人股份有限公司 機器手臂的視覺系統定位方法
JP2021037587A (ja) * 2019-09-03 2021-03-11 株式会社デンソー 部品挿入装置および部品の挿入方法
TWI708667B (zh) * 2019-09-27 2020-11-01 國立臺灣大學 運動裝置之位置與姿態校正裝置及系統與方法
CN113246116B (zh) * 2020-02-07 2022-08-23 复盛应用科技股份有限公司 机械臂校正方法
CN111591474B (zh) * 2020-02-28 2021-12-07 上海航天控制技术研究所 一种航天器在轨操作系统对准式手眼标定方法
CN113799115B (zh) 2020-06-11 2023-03-24 台达电子工业股份有限公司 机器手臂的坐标校正方法
TWI710441B (zh) * 2020-06-11 2020-11-21 台達電子工業股份有限公司 機器手臂的座標校正方法
TWI748626B (zh) * 2020-08-31 2021-12-01 財團法人工業技術研究院 工具中心點的校正方法、機械手臂的教導方法及應用其之機械手臂系統
CN112192370B (zh) * 2020-09-10 2021-12-21 天津津航技术物理研究所 一种用于光学元件空间曲面抛光的机械手定位方法
TW202224872A (zh) 2020-12-28 2022-07-01 財團法人工業技術研究院 機械手臂校正系統及機械手臂校正系統方法
US11508089B2 (en) * 2021-03-05 2022-11-22 Black Sesame Technologies Inc. LiDAR assisted wheel encoder to camera calibration
CN114252012B (zh) * 2021-12-22 2024-01-16 上海原能细胞生物低温设备有限公司 一种冻存盒孔位的获取方法
CN114147728B (zh) * 2022-02-07 2022-05-06 杭州灵西机器人智能科技有限公司 通用的机器人眼在手上标定方法和系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050102060A1 (en) * 2003-11-06 2005-05-12 Fanuc Ltd Device for correcting positional data of robot
TWI254662B (en) * 2003-05-29 2006-05-11 Fanuc Ltd Robot system
CN101524842A (zh) * 2009-01-09 2009-09-09 成都广泰实业有限公司 工业机器人校准方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4831549A (en) * 1987-07-28 1989-05-16 Brigham Young University Device and method for correction of robot inaccuracy
JP2686351B2 (ja) 1990-07-19 1997-12-08 ファナック株式会社 視覚センサのキャリブレーション方法
US5083073A (en) * 1990-09-20 1992-01-21 Mazada Motor Manufacturing U.S.A. Corp. Method and apparatus for calibrating a vision guided robot
US5297238A (en) * 1991-08-30 1994-03-22 Cimetrix Incorporated Robot end-effector terminal control frame (TCF) calibration method and device
JP3394278B2 (ja) * 1992-12-03 2003-04-07 ファナック株式会社 視覚センサ座標系設定治具及び設定方法
JP3394322B2 (ja) * 1994-05-19 2003-04-07 ファナック株式会社 視覚センサを用いた座標系設定方法
US6615112B1 (en) 1999-06-26 2003-09-02 Kuka Schweissanlagen Gmbh Method and device for calibrating robot measuring stations, manipulators and associated optical measuring devices
JP4191080B2 (ja) 2004-04-07 2008-12-03 ファナック株式会社 計測装置
JP3946716B2 (ja) * 2004-07-28 2007-07-18 ファナック株式会社 ロボットシステムにおける3次元視覚センサの再校正方法及び装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI254662B (en) * 2003-05-29 2006-05-11 Fanuc Ltd Robot system
US20050102060A1 (en) * 2003-11-06 2005-05-12 Fanuc Ltd Device for correcting positional data of robot
CN101524842A (zh) * 2009-01-09 2009-09-09 成都广泰实业有限公司 工业机器人校准方法

Also Published As

Publication number Publication date
CN102485441A (zh) 2012-06-06
US8688274B2 (en) 2014-04-01
TW201223724A (en) 2012-06-16
CN102485441B (zh) 2014-07-02
US20120143370A1 (en) 2012-06-07

Similar Documents

Publication Publication Date Title
TWI408037B (zh) 機械手臂的定位方法及校正方法
JP6701101B2 (ja) 複数の光チャネルを備えるマルチアパーチャ光学系を画像センサに対して相対的に位置決めするためのデバイス及び方法
JP6280525B2 (ja) カメラのミスキャリブレーションの実行時決定のためのシステムと方法
CN109859272B (zh) 一种自动对焦双目摄像头标定方法及装置
US20140100694A1 (en) System and method for camera-based auto-alignment
JP6210748B2 (ja) 三次元位置計測装置、及び三次元位置計測装置のキャリブレーションずれ判定方法
WO2016138744A1 (zh) 检测显示面板表面平坦度的装置及方法
JP2009269110A (ja) 組立装置
JP7189988B2 (ja) ビジョンシステムの3次元校正のためのシステム及び方法
CN111986267B (zh) 一种多相机视觉系统的坐标系统标定方法
CN111591474B (zh) 一种航天器在轨操作系统对准式手眼标定方法
KR102243694B1 (ko) 로봇의 위치 정보 복원 방법
JP7427370B2 (ja) 撮像装置、画像処理装置、画像処理方法、撮像装置の校正方法、ロボット装置、ロボット装置を用いた物品の製造方法、制御プログラムおよび記録媒体
KR102225139B1 (ko) 로봇의 위치 정보 복원 방법
CN110779933A (zh) 基于3d视觉传感阵列的表面点云数据获取方法和系统
JP2012057996A (ja) 画像測定装置及び画像測定方法
KR101549139B1 (ko) 카메라 모듈 조립 방법 및 장치
CN114494460A (zh) 标定方法、多相机探针装置及飞针测试机
WO2021120911A1 (zh) 一种板状工件的三维坐标校准方法
TWI706841B (zh) 3d相機與機械手臂座標系統的校正裝置及方法
TW201900358A (zh) 機器手臂校正座標的方法
Ribeiro et al. Photogrammetric Multi-Camera Calibration Using An Industrial Programmable Robotic Arm
CN114666480B (zh) 基于相位信息的组合成像系统入射光线逐像素标定方法及装置
TWI832770B (zh) 基於影像處理的機械手臂校正方法以及系統
CN114792344B (zh) 多相机位置标定方法、装置、系统及存储介质