本發(fā)明涉及工業(yè)機器人技術(shù)領(lǐng)域，更具體的說是涉及一種用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手。

背景技術(shù)：

現(xiàn)代工業(yè)中，許多產(chǎn)品(如電子與器件、五金器件零部件等)的生產(chǎn)在自動線上完成，各生產(chǎn)環(huán)節(jié)都涉及到產(chǎn)品的質(zhì)量檢測，一些企業(yè)投入大量人力，采用肉眼檢測的方式來控制產(chǎn)品質(zhì)量，但由于一些人為因素，產(chǎn)品質(zhì)量難以保證。為提高檢測效率和保證產(chǎn)品質(zhì)量，采用機器視覺技術(shù)代替人的視覺進行產(chǎn)品質(zhì)量的自動檢測是解決問題的有效方法。

機器視覺由于可快速獲取大量信息，且易于同設(shè)計信息和控制信息進行集成，因此在現(xiàn)代制造生產(chǎn)過程中，機器視覺被廣泛的用于質(zhì)量檢測、生產(chǎn)控制等。相對于人眼視覺，機器視覺具有很大的優(yōu)勢和發(fā)展前景，因此近年來機器視覺得以迅速發(fā)展，其廣泛應用于醫(yī)療、工業(yè)、農(nóng)業(yè)、軍事、交通等各個領(lǐng)域。在實際應用中，使用機械手采集圖像，可以提高圖像采集的質(zhì)量。在我國，直到90年代中后期機器視覺技術(shù)才逐漸被人們認識和了解，因此，有關(guān)機械手的技術(shù)也相對落后。目前，缺少一種可以真正在實際應用中采集高質(zhì)量圖片的機械手。

技術(shù)實現(xiàn)要素：

針對現(xiàn)有技術(shù)存在的不足，本發(fā)明的目的在于提供一種用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手，可以控制數(shù)字CCD相機和目標圖像同步移動，提高圖像采集的質(zhì)量。

為實現(xiàn)上述目的，本發(fā)明提供了如下技術(shù)方案：

一種用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手，包括依次連接的圖像采集模塊、控制模塊以及驅(qū)動模塊；

所述圖像采集模塊還連接數(shù)字CCD相機，用于接收采集到的目標圖像，并發(fā)送至所述控制模塊；

所述控制模塊用于根據(jù)接收到的目標圖像特征點的平均值、方差和移動敏感度，分別生成相應的期望運動軌跡和任務方程，再根據(jù)期望運動軌跡和任務方程輸出控制信號至所述驅(qū)動模塊；

所述驅(qū)動模塊用于響應于所述控制信號驅(qū)動所述數(shù)字CCD相機和所述目標圖像同步移動。

作為一種可實施方式，所述圖像采集模塊包括HY998芯片，所述HY998芯片的輸入端連接天線，所述HY998芯片通過所述天線和所述數(shù)字CCD相機無線連接，以接收所述數(shù)字CCD相機采集到的目標圖像；所述HY998芯片的輸出端連接所述控制模塊，以發(fā)送采集到的目標圖像至所述控制模塊；

其中，所述HY998芯片的I_O端通過彼此串聯(lián)的第一反相器和第二反相器連接所述控制模塊，所述HY998芯片的D端通過依次串聯(lián)的第一二極管、第三反相器以及第四反相器連接所述控制模塊，所述HY998芯片的I_O端和C端之間還通過第二二極管連接。

作為一種可實施方式，所述控制模塊為DSP，所述DSP的多個輸入端分別連接所述HY998芯片的I_O端、D端以及C端，所述DSP的輸出端連接所述驅(qū)動模塊。

作為一種可實施方式，所述驅(qū)動模塊包括第一D觸發(fā)器、第一三極管、第一繼電器，所述第一D觸發(fā)器的CP端和R端均連接所述控制模塊，所述第一D觸發(fā)器的Q端連接所述第一三極管的基極，所述第一三極管的發(fā)射極接地，所述第一三極管的集電極連接所述第一繼電器；

所述驅(qū)動模塊還包括第二D觸發(fā)器、第二三極管、第二繼電器，所述第二D觸發(fā)器的CP端和R端均連接所述控制模塊，所述第二D觸發(fā)器的Q端連接所述第二三極管的基極，所述第二三極管的發(fā)射極接地，所述第二三極管的集電極連接所述第二繼電器；

所述驅(qū)動模塊還包括電機，所述電機受控于第一繼電器繞一方向轉(zhuǎn)動，受控于第二繼電器繞另一方向轉(zhuǎn)動，以驅(qū)動所述數(shù)字CCD相機和所述目標圖像同步移動。

作為一種可實施方式，所述電機的供電端和變壓器的初級并聯(lián)，所述圖像采集模塊、所述控制模塊以及所述驅(qū)動模塊除所述電機以外的器件均通過電源模塊和變壓器的次級并聯(lián)；

其中，所述電源模塊包括組成半波整流電路的第三二極管和第四二極管、濾波電容、以及穩(wěn)壓芯片；所述第三二極管和第四二極管連接所述變壓器的次級，所述濾波電容連接所述第三二極管和第四二極管的輸出端，所述穩(wěn)壓芯片連接所述濾波電容。

作為一種可實施方式，所述驅(qū)動模塊除所述電機以外的器件均由濾波電容進行供電，所述圖像采集模塊和所述控制模塊均由穩(wěn)壓芯片進行供電。

作為一種可實施方式，所述變壓器的初級連接有可控開關(guān)，所述可控開關(guān)受控于所述DSP，在所述電機的速度跟不上目標圖像的移動速度時斷開所述變壓器的初級的電源。

本發(fā)明相比于現(xiàn)有技術(shù)的有益效果在于：

本發(fā)明提供了一種用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手，包括依次連接的圖像采集模塊、控制模塊以及驅(qū)動模塊；其中使用控制模塊根據(jù)目標圖像特征點的平均值、方差和移動敏感度，分別生成相應的期望運動軌跡和任務方程，再根據(jù)期望運動軌跡和任務方程輸出控制信號至所述驅(qū)動模塊，使數(shù)字CCD相機和目標圖像同步移動，以提高圖像采集的質(zhì)量。

附圖說明

圖1為本發(fā)明提供的用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手的框圖；

圖2為本發(fā)明提供的用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手的原理圖。

圖中：100、圖像采集模塊；200、控制模塊；300、驅(qū)動模塊；310、電源模塊。

具體實施方式

以下結(jié)合附圖，對本發(fā)明上述的和另外的技術(shù)特征和優(yōu)點進行清楚、完整地描述，顯然，所描述的實施例僅僅是本發(fā)明的部分實施例，而不是全部實施例。

參照圖1，本發(fā)明提供一種用于控制數(shù)字CCD相機圖像采集的速度反饋性機械手，包括依次連接的圖像采集模塊100、控制模塊200以及驅(qū)動模塊300；其中，圖像采集模塊100還連接數(shù)字CCD相機，用于接收采集到的目標圖像，并發(fā)送至控制模塊200；控制模塊200用于根據(jù)接收到的目標圖像特征點的平均值、方差和移動敏感度，分別生成相應的期望運動軌跡和任務方程，再根據(jù)期望運動軌跡和任務方程輸出控制信號至驅(qū)動模塊300；驅(qū)動模塊300用于響應于控制信號驅(qū)動數(shù)字CCD相機和目標圖像同步移動。這樣，可以提高圖像采集的質(zhì)量。其中，在控制模塊中，具體執(zhí)行以下操作。

將目標圖像特征點作為視覺伺服的特征向量，使數(shù)字CCD相機的運動速度和采集目標的運動速度同步，使用最小二乘法進行控制機械手的速度，以提高圖像采集的質(zhì)量。

其中，根據(jù)圖像特征點的平均值、方差和移動敏感度等數(shù)學特征，分別設(shè)計對應的期望運動軌跡并建立多個任務方程，作為主任務和次任務計算攝像機速度。由于在基本的機械手臂運動學控制將機械臂的運動看做是機械手工具坐標系或末端坐標系相對于基坐標系的運動大部分情況下操作機械臂的目標是將其從當前位置移動到期望位置而如何移動機械手臂，沿哪條路徑移動機械手臂以及以何種速度、加速度移動機械手臂是需要進行軌跡規(guī)劃的。節(jié)空間規(guī)劃是對關(guān)節(jié)角度進行運動規(guī)劃。應用逆運動學理論，可以將當前機械手末端姿態(tài)與其期望姿態(tài)的中間點轉(zhuǎn)換成一組期望的關(guān)節(jié)角，得到經(jīng)過各個中間點并且終止于目標點的n個關(guān)節(jié)的光滑函數(shù)。圖像信息對于機器人的智能化非常重要。如何在機器人移動的過程中盡量能夠?qū)⒂杏玫膱D像信息保留在視野內(nèi)對機器人來說具有一定的意義。以射擊運動為例，當射擊運動員射擊多目標時，如果所有目標均在視野內(nèi)，那么射擊運動員可以較為快速的將目標逐一擊落。保證所有潛在目標在視野內(nèi)，可以提供這種快速的反應能力。同樣的，在視覺機器人控制中，不光用于視覺祠服的視覺信息是必需的，其他重要信息也應該盡量保留在視野里。根據(jù)圖像特征點的平均值、方差和移動敏感度等數(shù)學特征，分別設(shè)計對應的期望運動軌跡并建立多個任務方程，作為主任務和次任務計算攝像機速度。將次任務在主任務零空間方向上的速度加到實際控制速度上來能夠在不影響主任務的情況下，盡量完成次任務。

如果還有第三或更多任務，可以將它們依次投影到上一層任務的零空間中，這樣的分層任務算法層次清晰，主次明確，在不影響上一層任務的同時，完成下一層任務。根據(jù)這個原理，提取了一些能夠保證圖像信息一直處在視野內(nèi)的數(shù)學特征，設(shè)計成幾個主次任務，很好的實現(xiàn)了多目標同時處于視野內(nèi)的跟蹤問題。加權(quán)最小二乘法最早由Whitney于1969年提出應用廣泛。Chan等人于1995年將加權(quán)最小二乘法應用到冗余機械手的避免關(guān)節(jié)限位控制中并得到了很好的效果。這種方法根據(jù)權(quán)值來調(diào)整關(guān)節(jié)速度，而權(quán)值由關(guān)節(jié)位置離關(guān)節(jié)限位的距離決定。因此如果機械手臂在移動的過程中離關(guān)節(jié)限位很遠，就不會對關(guān)節(jié)速度產(chǎn)生約束，機械手就能夠精確的完成主任務；如果機械手臂的關(guān)節(jié)位置接近關(guān)節(jié)限位，那么權(quán)值的變化將抑制關(guān)節(jié)速度，這樣就利用冗余自由度來執(zhí)行主任務，同時能夠達到避免關(guān)節(jié)超出限位的目標。但是當多于冗余自由度的關(guān)節(jié)數(shù)達到關(guān)節(jié)限位時，該方法將犧牲主任務精度，以保證能夠避免關(guān)節(jié)超出關(guān)節(jié)限位。而采用的廣義最小二乘法與傳統(tǒng)的加權(quán)最小二乘法相比，它的權(quán)值倒數(shù)只有0或1，即權(quán)值與丑的梯度無關(guān)。當次任務接近限位時，即虛擬關(guān)節(jié)離開安全區(qū)域時，權(quán)值倒數(shù)將從1跳變?yōu)?限制虛擬關(guān)節(jié)繼續(xù)向限位移動。最終，實現(xiàn)數(shù)字CCD相機和目標圖像同步移動，以提高圖像采集的質(zhì)量。

上述的功能是通過以下的硬件結(jié)構(gòu)實現(xiàn)的。

參照圖2，圖像采集模塊包括HY998芯片IC4，HY998芯片IC4的輸入端連接天線W，HY998芯片IC4通過天線W和數(shù)字CCD相機無線連接，以接收數(shù)字CCD相機采集到的目標圖像；HY998芯片IC4的輸出端連接控制模塊200，以發(fā)送采集到的目標圖像至控制模塊200；其中，HY998芯片IC4的I_O端通過彼此串聯(lián)的第一反相器D1和第二反相器D2連接控制模塊200，HY998芯片IC4的D端通過依次串聯(lián)的第一二極管VD1、第三反相器D3以及第四反相器D4連接控制模塊200，HY998芯片IC4的I_O端和C端之間還通過第二二極管VD2連接。

參照圖2，控制模塊為DSP IC5，DSP IC5的多個輸入端分別連接HY998芯片IC4的I_O端、D端以及C端，DSP IC5的輸出端連接驅(qū)動模塊300。

參照圖2，驅(qū)動模塊300包括第一D觸發(fā)器A1、第一三極管VT1、第一繼電器K1，第一D觸發(fā)器A1的CP端和R端均連接控制模塊200，第一D觸發(fā)器A1的Q端連接第一三極管VT1的基極，第一三極管VT1的發(fā)射極接地，第一三極管VT1的集電極連接第一繼電器K1；驅(qū)動模塊300還包括第二D觸發(fā)器A2、第二三極管VT2、第二繼電器K2，第二D觸發(fā)器A2的CP端和R端均連接控制模塊200，第二D觸發(fā)器A2的Q端連接第二三極管VT2的基極，第二三極管VT2的發(fā)射極接地，第二三極管VT2的集電極連接第二繼電器K2；驅(qū)動模塊300還包括電機M，電機M受控于第一繼電器K1繞一方向轉(zhuǎn)動，受控于第二繼電器K2繞另一方向轉(zhuǎn)動，以驅(qū)動數(shù)字CCD相機和目標圖像同步移動。

除此之外，還需要注意的是，電機M的供電端和變壓器T的初級并聯(lián)，圖像采集模塊100、控制模塊200以及驅(qū)動模塊300除電機M以外的器件均通過電源模塊310和變壓器T的次級并聯(lián)；其中，電源模塊310包括組成半波整流電路的第三二極管VD3和第四二極管VD4、濾波電容C1、以及穩(wěn)壓芯片IC1；第三二極管VD3和第四二極管VD4連接變壓器T的次級，濾波電容C1連接第三二極管VD3和第四二極管VD4的輸出端，穩(wěn)壓芯片IC1連接濾波電容C1。驅(qū)動模塊300除電機M以外的器件均由濾波電容C1進行供電，圖像采集模塊100和控制模塊200均由穩(wěn)壓芯片IC1進行供電。這樣設(shè)置的作用是，可以將市電分成三部分來使用，其中，市電直接接電機可以給電機供電。市電經(jīng)過變壓器之后可以給一部分直流器件供電，經(jīng)穩(wěn)壓芯片IC1之后可以給另一部分直流器件供電。因此，只使用了一個交流源，同時給出了交流、直流三種不同的電壓。

另外，變壓器T的初級連接有可控開關(guān)S，可控開關(guān)S受控于DSP IC5，在電機M的速度跟不上目標圖像的移動速度時斷開變壓器T的初級的電源。這樣設(shè)置，可以保護電機M，是因為電機持續(xù)處于超載狀態(tài)，易發(fā)熱，從而影響使用壽命。

以上所述的具體實施例，對本發(fā)明的目的、技術(shù)方案和有益效果進行了進一步的詳細說明，應當理解，以上所述僅為本發(fā)明的具體實施例而已，并不用于限定本發(fā)明的保護范圍。特別指出，對于本領(lǐng)域技術(shù)人員來說，凡在本發(fā)明的精神和原則之內(nèi)，所做的任何修改、等同替換、改進等，均應包含在本發(fā)明的保護范圍之內(nèi)。