一種基于總線控制方式的AGV控制系統技術方案

本實用新型專利技術涉及一種基于總線控制方式的AGV控制系統，包括上位機控制單元、安裝在AGV車上的AGV接口板、伺服電機和絕對值編碼器，AGV接口板通過總線方式與驅動AGV車輪轉動的一組伺服電機相連接，AGV接口板與陀螺儀、加速度計相連接，AGV接口板與安裝在車軸上的一組絕對值編碼器相連接，AGV接口板還與上位機控制單元相連接進行實時數據交互實現對AGV的控制功能。本實用新型專利技術采用以FPGA為核心的AGV接口板并通過MECHATROLINK2總線與一組驅動AGV運動的伺服電機相連接，有效地防止了外界干擾，能夠實時、快速、準確地控制和獲取伺服電機的工作狀態，實現對AGV運動的自動控制功能，保證了控制的實時性和穩定性，可廣泛用于AGV領域。（*該技術在2022年保護過期，可自由使用*）

【技術實現步驟摘要】

本技術屬于移動機器人
，尤其是一種基于總線控制方式的AGV控制系統。
技術介紹
AGV是一種以電池為動力、裝有非接觸導向裝置和獨立尋址系統的無人駕駛自動化搬運車輛，其在計算機的監控下，按指令自主駕駛，自動沿著規定的導引路徑行使，到達指定地點，完成一系列作業任務。AGV本體控制系統的組成可以有兩種組合方式，一種是比較簡單的方式，如微處理 器+外設，由它們的控制單元、運算單元、存儲單元和時鐘等直接控制外設，這里以ARM+外設、DSP+外設為例，雖然它們在理論上是可行的，但是在高實時性，短控制周期、穩定性、可靠性、快速高效、低功耗、靈活擴展、外形緊湊、最小占用空間上都存在很多問題第一個問題是難于實現實時、正確地接受和發送用于控制的位置數據，速度數據，輸進輸出狀態等信息，從而完成AGV的非常靈活和高精度的運動控制；第二個問題是難于實現掛接AGV所需要的各種高精度外設，如伺服電機；第三個問題是難于實現軟、硬件在一定程度上可修改，按照用戶需求定制AGV產品；第四個問題是難于實現整個系統很小的功耗、極高的可靠性、模塊的可自由擴展性。第二種方式是AGV本體控制系統的三層架構的方式高性能微處理器+高性能接口板+外設。鑒于目前國內AGV開發尚處于初級階段，相關廠家在以上第二種方式的開發應用上都遠遠未能達到實際應用的要求，本技術正是基于填補國內這一空白的技術背景下而研發的。
技術實現思路
本技術的目的在于克服現有技術的不足，提供一種實時性高、穩定性強的一種基于總線控制方式的AGV控制系統。本技術解決其技術問題是采取以下技術方案實現的一種基于總線控制方式的AGV控制系統，包括上位機控制單元、AGV接口板、伺服電機和絕對值編碼器，AGV接口板通過MECHATR0LINK2總線與驅動AGV車輪轉動的一組伺服電機相連接，AGV接口板與陀螺儀、加速度計相連接，AGV接口板與安裝在車軸上的一組絕對值編碼器相連接，AGV接口板還與上位機控制單元相連接進行實時數據交互實現對AGV的控制功能。而且，所述的AGV接口板包括FPGA控制模塊、陀螺儀、加速度計和MECHATR0LINK2總線控制模塊，FPGA控制模塊與陀螺儀、加速度計相連接，與一組絕對值編碼器相連接，FPGA控制模塊與MECHATR0LINK2總線控制模塊相連接，該總線控制模塊通過MECHATR0LINK2總線與驅動AGV運動的一組伺服電機相連接，FPGA控制模塊與上位機控制單元相連接。而且，所述的FPGA控制模塊包括MicroBlaze CPU、SPI單元、SSI單元、ISA單元、EPC單元、GPIO單元，MicroBlaze CPU與SPI單元、SSI單元、ISA單元、EPC單元及GPIO單元通過PLB總線相連接，SPI單元與陀螺儀、加速度計相連接，SSI單元與絕對值編碼器相連接，EPC總線擴展器單元及GPIO總線擴展器單元與MECHATR0LINK2總線控制模塊相連接，所述的ISA單元與上位機控制單元相連接。而且，所述的上位機控制單元采用的是PC104主板。本技術的優點和積極效果是本技術采用上位機控制單元+接口板+伺服電機的三層AGV本體控制體系，每一層都體現了配置上的優化I、上位機控制單元采用PC104主板具有小尺寸、高可靠性、模塊可自由擴展、低功耗、堆棧式連接(PC104系統在形式上采用了多個功能模塊板進行互相堆棧的形式，并且占用空間非常小，功耗也比傳統PC低得多。堆棧的形式帶來了系統升級的便利性和系統高·度的可靠性。)、開發周期短等特點。2、AGV接口板A、數據傳輸速率高。CAN總線傳輸速率最高位1Mbps，而MECHATR0LINK2總線傳輸速率為10Mbps。B、MECHATR0LINK2總線實現了實時、正確地接受和發送用于控制的位置數據，速度數據，輸進輸出狀態等信息，完成靈活的，高精度的運動控制，特別適用于需要各軸間的協調同步和插補控制的應用；C、MECHATR0LINK2總線還可連接豐富的組件，其中包括伺服電機。伺服電機是AGV的首選可使控制速度，位置精度非常準確，伺服電機轉子轉速受輸入信號控制，并能快速反應，在自動控制系統中，用作執行元件，且具有機電時間常數小、線性度高、始動電壓等特性；D、FPGA可編程，軟、硬件在一定程度上可修改(通過硬件描述語言)。具有Soc片上系統的特點可以按照用戶需求進行定制產品；FPGA還具有IO管腳多的特點，可以很容易掛接不同IO外設。3、伺服電機伺服電機可使控制速度，位置精度非常準確，伺服電機轉子轉速受輸入信號控制，并能快速反應，在自動控制系統中，用作執行元件，且具有機電時間常數小、線性度高、始動電壓等特性。附圖說明圖I是本技術的系統連接示意圖；圖2是以FPGA接口板為核心的AGV控制系統連接示意圖；圖3是FPGA控制模塊內部邏輯框圖。具體實施方式以下結合附圖對本技術實施例做進一步詳述一種基于總線控制方式的AGV控制系統，如圖I，包括上似機控制單兀、AGV接口板、伺服電機和絕對值編碼器。AGV接口板通過MECHATR0LINK2總線與驅動AGV車輪轉動的一組伺服電機相連接用于采集各個伺服電機的工作狀態，AGV接口板與陀螺儀、加速度計相連接用于采集陀螺儀偏差信號(角速率)和加速度計的加速度信號；AGV接口板與安裝在車軸上的一組絕對值編碼器相連接用于采集絕對編碼值。AGV接口板通過以太網與上位機控制單元進行實時數據交互，在I毫秒控制周期內，根據上位機控制命令進行電機命令的下發和電機狀態以及傳感器狀態的上傳，從而實現對AGV的自動控制功能。 AGV接口板采用基于FPGA的AGV接口板，如圖2及圖3所示，包括FPGA控制模塊、陀螺儀、加速度計和MECHATR0LINK2總線控制模塊。所述的FPGA控制模塊包括CPU、SPI單元、SSI單元、ISA單元、EPC單元、GPIO單元，上述SPI單元、SSI單元、ISA單元、EPC單元及GPIO單元均為FPGA內部的IP核，上述IP核通過PLB總線與CPU相連接。其中SPI單元為串行通信接口 IP核，其與陀螺儀、加速度計相連接用于采集陀螺儀偏差信號(角速率)和加速度計的加速度信號并傳給CPU。SSI單元是同步串行接口的IP核，其與安裝在車軸的一組絕對值編碼器相連接用于采集絕對編碼值并將該絕對編碼值傳送給CPU。EPC單元及GPIO單元與MECHATR0LINK2總線控制模塊相連接，該總線控制模塊通過MECHATR0LINK2總線與驅動AGV運動的一組伺服電機相連接，CPU通過MECHATR0LINK2總線控制模塊采集各個伺服電機的狀態。ISA單元為工業標準結構總線接口 IP核，其與上位機控制單元進行實時數據交互，在I毫秒控制周期內，根據上位機控制命令進行伺服電機命令的下發和伺服電機狀態以及傳感器狀態的上傳，從而實現對AGV的自動控制功能。AGV控制系統的工作過程為該AGV接口板通過MECHATR0LINK2總線采集各種伺服電機的工作狀態，通過單片機或SSI接口采集安裝在車軸上的絕對值編碼器的編碼值，通過陀螺儀、加速度計采集陀螺儀偏差信號(角速率)和加速度計的加速度信號，由AGV接口板上傳至上位機控制單元進行分析處理后，得到下一周期命令，然后通過本文檔來自技高網...

【技術保護點】
一種基于總線控制方式的AGV控制系統，其特征在于：包括上位機控制單元、AGV接口板、伺服電機和絕對值編碼器，AGV接口板通過MECHATROLINK2總線與驅動AGV車輪轉動的一組伺服電機相連接，AGV接口板與陀螺儀、加速度計相連接，AGV接口板與安裝在車軸上的一組絕對值編碼器相連接，AGV接口板還與上位機控制單元相連接進行實時數據交互實現對AGV的控制功能。

【技術特征摘要】

【專利技術屬性】
技術研發人員：趙哲，
申請(專利權)人：無錫普智聯科高新技術有限公司，
類型：實用新型
國別省市：