排爆機器人控制與無線通訊系統(tǒng)

圖4 機械手軌跡規(guī)劃示意圖

　　位于中間層的控制是機械手抓取運動控制中最關(guān)鍵的部分。它實際上是一個補間器。機械手的運動控制可分為姿態(tài)控制與手位置控制。腰、大臂、小臂、手爪的控制，是由主控計算機通過機械手運動學(xué)位移問題進行反向運動求解，得出腰、大臂、小臂、手爪的位置，然后給出各關(guān)節(jié)位置指令傳至上述關(guān)節(jié)的嵌入式系統(tǒng)控制計算機，完成帶有速度反饋環(huán)的位置控制。四個關(guān)節(jié)的運動速度通過機械手的軌跡規(guī)劃來決定，從而避免機械手的蛇形運動。由于有觸覺傳感器，手爪可以自動控制，也可以是在圖像信號的指引下作精細“柔軟控制”。抓取可疑爆炸物時，控制手爪夾持力約大于可疑爆炸物脫落重力，不至用力過大而夾壞可疑爆炸物，從而完成專家指定的動作。

　　位于最下層是控制級位置控制器與速度調(diào)節(jié)器均采用成熟的PID（包括P、PI、PD）控制。當(dāng)PID控制其選擇合適的參數(shù)時，具有一定魯棒性，簡單、實用。當(dāng)PID無法實現(xiàn)有效控制時，可改進之或結(jié)合其它方法，如前饋控制。運動控制包括機械手各個關(guān)節(jié)運動控制和行走運動，初步統(tǒng)計控制回路有13路，如圖5所示。

圖5 自動控制原理圖

　　嵌入式控制計算機根據(jù)上位計算機傳來的位置與速度信號，對各個伺服機構(gòu)進行位置與速度設(shè)定，按控制規(guī)律（如PID）對伺服電機進行控制，使實際位置按預(yù)計的速度跟蹤或運動到目標(biāo)位置。

　　機器人的手眼協(xié)調(diào)系統(tǒng)：機器人的手眼協(xié)調(diào)系統(tǒng)是本系統(tǒng)最大亮點之一。由于于補間器算法需要知道目標(biāo)物與機器人基坐標(biāo)（一般是機械人的腰關(guān)節(jié)底座），相對空間座標(biāo)才能求解。而本系統(tǒng)目標(biāo)物是在未知環(huán)境里。這相對坐標(biāo)必須由于手眼協(xié)調(diào)系統(tǒng)來求解。排爆機器人機械手上裝有雙目系統(tǒng)，利用雙目系統(tǒng)和目標(biāo)物可構(gòu)成“測矩三角型”，原理示意如圖6。測矩三角型求得距離誤差較大，需要利用激光測距的“光斑”輔助測矩，從而獲得坐標(biāo)物的空間座標(biāo)。隨著機器人的雙目接近目標(biāo)物，目標(biāo)物與基坐標(biāo)的相對坐標(biāo)精度提高，經(jīng)過數(shù)次雙目逼近目標(biāo)物之后，最終實現(xiàn)機械手準(zhǔn)確地抓到目標(biāo)物。

圖6 測矩三角型原理圖