時間:2006-11-15 15:05:00來源:shenyan
圖1 機器人結構示意圖
圖2 機械手移動機構示意圖[/align]
1.2.2 圖書存儲欄
機器人在開始作業前,工作人員將待上架的圖書放人圖書存儲欄中。圖書存儲欄固定于機器人機身部,隨著機器人移動。為了便于機械手從欄中將所需圖書取出,須將每本圖書間隔開并豎立放置。于是,我們設計了如圖3所示的圖書存儲欄。分別用兩塊擋板隔成了一個個書槽,將待上架的圖書每本分別放置于書槽中,這樣使每本圖書不會倒下,而且彼此間隔了一定距離,使機械手在掃描到目標圖書后,能方便、準確地將之取出。
[align=center]
圖3 圖書存儲欄
圖4 引導裝置原理圖[/align]
1.2.3 機器人導引裝置
本設計中采用了電磁引導方式,原理如圖4所示,導引圖書館作業型機器人沿書架旁邊直線運動。該方法在地板上開出數厘米深的溝,埋人導線,通以頻率為3~10kHz的電流。安裝在機器人機身內的敏感線圈,能感知機體與導線間的偏移,從而引導機器人沿導線正確行走。
2 PLC硬件接線和軟件編程
本設計中機器人控制需大量的輸入點和輸出點。因此,我們選用日本三菱公司生產的F1-60MR型可編程序控制器,具有36個輸入點,24個輸出點,足以滿足本設計的要求。
[align=center]
圖5 PLC的梯形圖
圖6 程序框圖[/align]
為了更詳細地介紹PLC控制圖書館作業型機器人工作原理,我們在此列出了機器人將A1、A2類圖書自動上架的程序段,并特別針對機器人將A1類圖書上架的程序段進行了詳細的說明。圖5是PLC的梯形圖。
PLC控制機器人將A1、A2類圖書上架的程序框圖如圖6所示。在此,還寫出了相應的梯形圖程序。
程序說明如下:
(1)當機器人的機械手位于鋼軌前端限位處,并垂直正對書架時,為機器人初始位置。此時,鋼軌前端限位開關SQ2,機械手繞Z軸逆時針方向旋轉180°限位開關SQ5被壓,x402、x405觸點接通按下起動按鈕SB1時,X400觸點接通,Y430線圈接通,機器人前進。
(2)當機器人前進至位置A時,壓下限位開關SQ1,x401觸點斷開Y430線圈,機器人停止前進,正好停在書架A的前面(機器人機身長度與書架寬度相等)。
(3)機械手繞Z軸J頃時針方向旋轉至觸到限位開關SQ4,此時x404觸點斷開Y433線圈,機械手停止旋轉。此時,機械手已旋轉180°至垂直正對圖書存儲欄。
(4)x404觸
點接通線圈Y431,機械手開始在鋼軌上沿X軸正方向朝后端移動,尋找A1類圖書。
(5)掃描到A1類圖書信息,x412觸點斷開Y431線圈,機械手停止移動,x412觸點接通移位寄存器數據輸入端,使M100置“1”,Y435線圈接通,機械手手臂伸出。
(6)手臂伸至限位開關SQ6時,X406與M100觸點接通移位寄存器移位信號輸入端,產生移位信號,M100的“1”態移至M101,M101接通線圈M200,M200觸點接通Y531線圈,手爪夾緊書。同時定時器T450開始計時。M100置“0”,Y435斷開,手臂停止伸出。
(7)T450延時到,T450與M101觸點接通,產生移位信號,M102為“1”,M100~M101置“0”,M102觸點接通Y436線圈,機械手手臂縮回,因為使用S指令,所以M200線圈保持接通,Y531也保持接通,使手爪繼續把書加緊。
(8)當手臂縮至限位開關SQ7時,x407與M102觸點接通產生移位信號,M103為“l”,M100~M102置“0”。M102斷開Y436線圈,停止縮回,同時M103接通Y434線圈,機械手開始繞Z軸逆時針方向旋轉。
(9)機械手旋轉至限位開關SQ5時,X405與M103觸點接通移位信號,M104為“1”,M100-M103置“0”。M103觸點斷開Y434線圈,停止旋轉。此時機械手已逆時針方向旋轉180*,正好垂直正對書架。同時,M104接通線圈Y432,機械手開始在鋼軌上沿X軸反方向朝前端移動。
(10)移動時,機械手頂端的掃描裝置開始掃描圖書條形碼信息。當沒有條形碼信息時,X500與M104觸點接通移位信號,M105為“1”,M100~M104置“0”。M104觸點斷開Y435線圈,機械手停止移動。同時,M105觸點接通Y435線圈,機械手手臂伸出。
(11)手臂伸至限位開關SQ6時,X406與M105觸點接通移位信號,M106為“1”,M100~M105置“0”,M105觸點斷開Y435線圈,手臂停止伸出。同時M106觸點接通M200線圈,R指令使M200復位,M200觸點斷開Y531線圈,手爪松開,放置圖書于書欄A1中。同時,T451開始計時。
(12)T451延時到后,T451與M106觸點接通移位信號,M107為“1”,M100~M106置“0”,Y436線圈接通,機械手手臂縮回。
(13)手臂縮至限位開關SQ7時,X407與M107觸點接通移位信號,M110為“1”,M100-M107置“0”,M107斷開Y436線圈,手臂停止縮回。同時,M110接通Y432線圈,機械手開始在鋼軌上沿軸反方向移動。
(14)機械手移動至限位開關SQ2時,X402與M110觸點接通移位信號,M111為“1”,M100~M110置“0”,M110觸點斷開Y432線圈,機械手停止移動。同時,M111觸點接通移位寄存器復位輸入端,寄存器全部復位。此時,機器人處于初始位置狀態,M111觸點接通Y433線圈,機械手又開始繞Z軸順時針方向旋轉,繼續尋找A1類圖書,反復執行以上步驟。
以上(1)~(14)步驟的程序說明是針對A至B程序段展開的。若機械手在鋼軌上移動至末端限位開關處,說明已掃描完圖書存儲欄中所有待上架的圖書,即已將A1類圖書尋找完畢。這時,程序直接跳轉至B點后,機器人開始執行A2類圖書查找并自動上架任務。
當按下停止按鈕SB2時,X501觸點作用,使機器人立即停止動作。
3 結束語
本系統采用FX系列PLC控制圖書館作業型機器人,使其按編制的程序自動完成圖書上架工作,經實際試運行,表明各項功能均已滿足設計要求,且控制系統的可靠性高、故障少,結構部分操作方便,安全可靠,從而節省了勞動力,提高了工作效率。
標簽:
上一篇:三坐標裝配機器人的修復
傳動網版權與免責聲明:凡本網注明[來源:傳動網]的所有文字、圖片、音視和視頻文件,版權均為傳動網(www.cdcst56.com)獨家所有。如需轉載請與0755-82949061聯系。任何媒體、網站或個人轉載使用時須注明來源“傳動網”,違反者本網將追究其法律責任。
本網轉載并注明其他來源的稿件,均來自互聯網或業內投稿人士,版權屬于原版權人。轉載請保留稿件來源及作者,禁止擅自篡改,違者自負版權法律責任。
產品新聞
更多>2025-12-10
2025-11-20
2025-11-10
2025-11-10
2025-11-07
2025-10-31