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