基于航跡推算的移動(dòng)式機器人定位系統設計
加入技術(shù)交流群
式中，Vx(t)和Vy(t)分別表示x軸和y軸在時(shí)間t時(shí)的速度，S表示t到t+1時(shí)刻的行走路徑，φ(t)表示t時(shí)刻x軸速度與速度的夾角。
2 系統電路設計
2．1 伺服器電路
伺服器是一種電機驅動(dòng)器，與普通電機驅動(dòng)器不同，該驅動(dòng)器可以與電機連接形成閉環(huán)控制單元。伺服器通過(guò)實(shí)時(shí)檢測安裝在電機上的高分辨率光電編碼器的信號計算出電機轉速和轉角，通過(guò)與目標轉速和轉角進(jìn)行比較來(lái)實(shí)時(shí)調整電機運動(dòng)狀態(tài)。本文引用地址：http://dyxdggzs.com/article/160341.htm
如圖3所示為伺服器系統硬件電路的信號處理單元。該電路包括了信號整合和信號運算，其中DS26LS32CM實(shí)現編碼盤(pán)信號的整合，即把4路PWM信號整合成2路PWM信號。由于編碼盤(pán)信號是由A、B兩路相位差為90°的PWM組成，通過(guò)對DS26LS32CM邏輯使能口的電平控制，可實(shí)現輸出端在A(yíng)、B信號超前或滯后90°時(shí)輸出高電平或低電平，以此判斷出電機正反轉狀態(tài)。LM629為PID信號算法芯片，通過(guò)對編碼盤(pán)信號運算和DS26LS32CM輸出信號狀態(tài)分析，芯片可發(fā)出信號使電機一直保持在編碼盤(pán)的某一個(gè)柵格處，讓電機急停鎖死或準確運動(dòng)所需要的柵格數，實(shí)現對機器人移動(dòng)的準確控制。HCP-2602為高速光耦芯片，其目的是減少控制端與電機之間的信號干擾。
評論