基于PMAC2 PC - 104運(yùn)動(dòng)控制器的AGV底盤控制系統(tǒng)

1　AGV系統(tǒng)硬件構(gòu)成

PMAC（ProgrammableMulti-AxisController）是美國DeltaTau數(shù)字系統(tǒng)公司推出的一種可編程多軸運(yùn)動(dòng)控制器,它采用Motorola公司的DSP56300處理器作為CPU,可以實(shí)現(xiàn)最多8個(gè)坐標(biāo)系同時(shí)運(yùn)動(dòng),可以通過存儲在其內(nèi)部的程序單獨(dú)操作[2],使用PMAC作為AGV控制器,物理結(jié)構(gòu)可以大大簡化,系統(tǒng)設(shè)計(jì)和調(diào)試過程也變得更簡單。
AGV采用4輪-雙輪驅(qū)動(dòng),左右2個(gè)同軸輪獨(dú)立驅(qū)動(dòng),通過2輪差速實(shí)現(xiàn)AGV行駛狀態(tài)的調(diào)整,適宜采用PMAC運(yùn)動(dòng)控制器作為系統(tǒng)的核心處理器,為了實(shí)現(xiàn)PMAC多軸控制功能,需在PMAC板上擴(kuò)展相應(yīng)的I/O接口板,同時(shí)采用伺服電機(jī)、伺服驅(qū)動(dòng)單元、編碼器以及相應(yīng)的傳感器構(gòu)成1套完整的開放式AGV控制系統(tǒng),見圖1。

2　AGV控制系統(tǒng)伺服環(huán)設(shè)置

為保證AGV運(yùn)行時(shí)的精確性和穩(wěn)定性,電機(jī)控制采用速度、位置雙反饋系統(tǒng),如圖2所示。變量lx03指向寄存器地址＄720作為位置編碼器的地址[3],在每一個(gè)伺服周期閉上位置環(huán)。電機(jī)編碼器的數(shù)據(jù)經(jīng)過處理后存儲到lx03指定的地址,閉上位置環(huán)。變量lx04指向寄存器地址＄721作為速度編碼器的地址,在每一個(gè)伺服周期閉上速度環(huán)。陀螺儀的數(shù)據(jù)經(jīng)過處理后存儲到lx04指定的地址,閉上速度環(huán)。使用雙反饋系統(tǒng)需將lx25變量設(shè)置為1,以打開PMAC的硬件位置捕獲功能,提高控制精度。

3　上位機(jī)通信程序編制

AGV控制軟件使用VisualC++進(jìn)行設(shè)計(jì),通過PMAC的各種參數(shù)設(shè)置實(shí)現(xiàn)對AGV小車運(yùn)動(dòng)路線的控制,如圖3所示。AGV控制軟件主要實(shí)現(xiàn)參數(shù)設(shè)置、路徑編制、狀態(tài)診斷功能。

上一頁 1 2 下一頁