[發明專利]機器人關節標定算法

在審

• 申請號: 201410751524.4
• 申請日: 2014-12-10
• 公開（公告）號: CN105741259A
• 公開（公告）日: 2016-07-06
• 發明（設計）人: 不公告發明人
• 申請（專利權）人: 肖偉
• 主分類號: G06T7/00
• 分類號: G06T7/00
• 代理公司: 暫無信息
• 代理人: 暫無信息

1.機器人關節標定算法，包含：步驟1：打開左攝像頭，標定左攝像頭；步驟2：打開右攝像頭，標定右攝像頭；步驟3：標定左右攝像頭；步驟4：左攝像頭拍攝照片；步驟5：右攝像頭拍攝照片；步驟6：對左攝像頭拍攝的照片和右攝像頭拍攝的照片進行匹配算法；步驟7：在左攝像頭所拍攝的圖片中尋找關節的位置標定點A；步驟8：在右攝像頭所拍攝的圖片中尋找關節的位置標定點A；步驟9：計算關節的位置標定點A的坐標；步驟10：在左攝像頭所拍攝的圖片中尋找關節的位置標定點B；步驟11：在右攝像頭所拍攝的圖片中尋找關節的位置標定點B；步驟12：在左攝像頭所拍攝的圖片中尋找關節的位置標定點C；步驟13：在右攝像頭所拍攝的圖片中尋找關節的位置標定點C；步驟14：在左攝像頭所拍攝的圖片中尋找關節的位置標定點D；步驟15：在右攝像頭所拍攝的圖片中尋找關節的位置標定點D；步驟16：計算關節的位置標定點B的坐標；步驟17：計算關節的位置標定點C的坐標；步驟18：計算關節的位置標定點D的坐標；步驟19：通過關節的位置標定點A的坐標、關節的位置標定點B的坐標、關節的位置標定點C的坐標、關節的位置標定點D的坐標計算關節的位置、方位參數；步驟20：判斷是否所有關節都標定完畢，如果所有關節都標定完畢，則推出，如果還有關節沒有標定完，則跳回步驟1，標定下一個機器人關節。