CCD視覺對位和運動控制思路 UVW平臺XXY平臺
一、UVW平臺介紹
二、視覺對位計算方法
簡單說明一下視覺對位和運動控制思路:
1、通過UVW平臺供應(yīng)商提供的說明書,找到機械參數(shù),得到UVW三個軸的初始坐標(biāo)(基于UVW平臺原點坐標(biāo)系);
2、通過視覺標(biāo)定方法,確定相機坐標(biāo)系到UVW平臺坐標(biāo)系的轉(zhuǎn)換矩陣;確定標(biāo)志物模板基于UVW平臺原點坐標(biāo)系的坐標(biāo)值(x_m, y_m);
3、通過相機得到標(biāo)志物模板位置和待糾偏標(biāo)志物之間的x、y、θ偏移量(基于UVW平臺原點坐標(biāo)系);
4、按照上圖公式,輸入三個軸初始坐標(biāo),設(shè)置旋轉(zhuǎn)中心為(0,0),輸入θ偏移量,可得到UVW三軸新的坐標(biāo)值,以及待糾偏物體的新的坐標(biāo),以及三個電機對應(yīng)的給進量A1、A2、A3;
5、輸入上一步求得的UVW三軸新的坐標(biāo)值,另外通過上一步求得的待糾偏物體的新的坐標(biāo),計算得此時待糾偏物體到模板點位置的x2、y2偏移量;輸入x2、y2偏移量,則可以得到三個電機對應(yīng)的給進量B1、B2、B3;
6、將5和6步獲取的三個電機的給進量對應(yīng)相加,分別得到對應(yīng)電機給進量C1、C2、C3,并用此給進量驅(qū)動對應(yīng)電機即可。即是,將運動過程拆解,變成平移和旋轉(zhuǎn)部分,分別計算電機給進量。