一種Delta機器人驅控系統的制作方法
【技術領域】
[0001]本實用新型涉及嵌入式計算機控制領域，具體涉及一種Delta機器人驅控系統。
【背景技術】
[0002]目前PA(PRECISE AUTOMAT1N)公司開發的Delta機器人驅動控制器采用ARM+FPGA+M0DBUS/TCP的硬件架構，實現了對機器人的控制和組網，而驅動控制器采用M0DBUS/TCP點到點的通訊方式使得組網通訊效率較低，可組網機器人數量有限，最大可組網32個機器人，而且沒有采用DSP處理器作為運算單元，使得系統做大規模復雜運算的時候效率低下。
【實用新型內容】
[0003]有鑒于此，本實用新型提出的一種Delta機器人驅控系統，以解決現有技術中機器人組網通訊效率較低、可組網機器人數量有限和系統做大規模復雜運算的時候效率低下的問題。
[0004]本實用新型通過以下技術手段解決上述問題:
[0005]—種Delta機器人驅控系統，包括主控制子系統、控制子系統和電源模塊，所述主控制子系統實現機器人動力學運算和閉環控制，所述控制子系統實現對伺服電機的控制，所述主控制子系統和所述控制子系統之間進行雙向數據協同傳輸，所述主控制子系統包含F28M36雙核芯片，所述F28M36雙核芯片包括負責外圍電路監控的ARM處理器和負責機器人所有運算的DSP處理器，所述Delta機器人驅控系統采用EtherCAT總線方式連接所述F28M36雙核芯片，用于實現上位主機與機器人子節點的高效通訊，所述電源模塊用于提供向所述通訊EtherCAT、所述主控制子系統和所述控制子系統供電的電壓。
[0006]進一步的，所述主控制子系統和所述控制子系統之間采用UART進行雙向數據協同傳輸。
[0007]進一步的，所述控制子系統包括處理器DSPTMS320F2812、IPU模塊、電機模塊、第一隔離型ADC和編碼器，所述處理器DSPTMS320F2812通過所述IPU模塊連接所述電機模塊，所述編碼器根據所述電機模塊運動的情況將信息反饋給所述處理器F28M36，實現所述主控制子系統對所述Delta機器人驅控系統的監測以及根據所述電機模塊的運動狀態發出相應的指令。
[0008]進一步的，所述IPU模塊內部集成邏輯、控制、檢測和保護電路。
[0009]進一步的，所述電源模塊用于提供向所述通訊EtherCAT和所述處理器DSPTMS320F2812供電的5V電壓以及向所述IPU模塊供電的直流310V電壓。
[0010]進一步的，所述主控制子系統還包括第二隔離型ADC，用于將所述處理器F28M36的模擬信號轉化為數字信號。
[0011]進一步的，所述Delta機器人驅控系統主要功能模塊包括數據采集模塊、數據監控模塊和運算模塊，所述數據采集模塊通過所述處理器DSPTMS320F2812采集數據信息，所述數據監控模塊根據所述處理器DSPTMS320F2812采集的數據信息通過所述第一隔離型ADC對所述IPU模塊進行監控，所述數據采集和/或數據監控包括對溫度、電壓、電流等的監控，所述運算模塊用于所述主控制系統根據所述數據采集模塊采集的數據向所述控制子系統發出控制指令，實現機器人動力學運算和閉環控制。
[0012]進一步的，所述Delta機器人驅控系統輔助功能模塊包括顯示模塊、數據存儲模塊、串口模塊和擴展1模塊，所述顯示模塊用于顯示反映所述Delta機器人驅控系統狀態的數據，所述數據存儲模塊用于存儲數據和/或數據采集模塊獲取的各種參數，所述串口模塊采用串行通信方式的擴展接口，方便Delta機器人驅控系統與外部設備相連接，所述擴展1模塊用于所述主控制子系統與所述數據存儲模塊的連接和/或外部設備的連接/數據交換，當所述外部設備對所述主控制子系統發出相應命令時，使所述Delta機器人驅動系統做出相應的動作。
[0013]本實用新型的Delta機器人驅控系統采用ARM+DSP+EtherCAT硬件架構，ARM處理器負責外圍電路的監控，DSP處理器負責機器人的所有運算，采用DSP處理器增加系統的運算速率，性價比可大幅度提高，而且采用目前工業界最流行的EtherCAT總線通訊方式(Onthefly)，可將同一個網絡的所有機器人通訊效率發揮到最大，最大可以同時組網65535個機器人。
【附圖說明】
[0014]圖1為一種Delta機器人驅控系統的示意圖；
[0015]圖2為圖1的Delta機器人驅控系統的具體結構示意圖。
【具體實施方式】
[0016]為使本實用新型的上述目的、特征和優點能夠更加明顯易懂，下面將結合附圖和具體的實施例對本實用新型的技術方案進行詳細說明，
[0017]請參閱圖1和圖2，本實用新型的Delta機器人驅控系統包括主控制子系統、控制子系統和電源模塊，所述主控制子系統實現機器人動力學運算和閉環控制，所述控制子系統實現對伺服電機的控制，所述主控制子系統和所述控制子系統之間進行雙向數據協同傳輸，所述主控制子系統包含F28M36雙核芯片，所述F28M36雙核芯片包括負責外圍電路監控的ARM處理器和負責機器人所有運算的DSP處理器，所述Delta機器人驅控系統采用EtherCAT總線方式連接所述F28M36雙核芯片，用于實現上位主機與機器人子節點的高效通訊，所述電源模塊用于提供向所述通訊EtherCAT、所述主控制子系統和所述控制子系統供電的電壓。
[0018]所述主控制子系統和所述控制子系統之間采用UART進行雙向數據協同傳輸。
[0019]所述控制子系統包括處理器DSPTMS320F2812、IPU模塊、電機模塊、第一隔離型ADC和編碼器，所述處理器DSPTMS320F2812通過所述IPU模塊連接所述電機模塊，所述編碼器根據所述電機模塊運動的情況將信息反饋給所述處理器F28M36，實現所述主控制子系統對所述Delta機器人驅控系統的監測以及根據所述電機模塊的運動狀態發出相應的指令。
[0020]所述IPU模塊內部集成邏輯、控制、檢測和保護電路。
[0021]所述電源模塊用于提供向所述通訊EtherCAT和所述處理器DSPTMS320F2812供電的5V電壓以及向所述IHJ模塊供電的直流31OV電壓。
[0022]所述主控制子系統還包括第二隔離型ADC，用于將所述處理器F28M36的模擬信號轉化為數字信號。
[0023]所述Delta機器人驅控系統主要功能模塊包括數據采集模塊、數據監控模塊和運算模塊。所述數據采集模塊通過所述處理器DSPTMS320F2812采集數據信息。所述數據監