[發明專利]一種水下機器人

在審

• 申請號: 201710711945.8
• 申請日: 2017-08-18
• 公開（公告）號: CN107340757A
• 公開（公告）日: 2017-11-10
• 發明（設計）人: 丁偉;程巖;信柯
• 申請（專利權）人: 江蘇信息職業技術學院
• 主分類號: G05B19/414
• 分類號: G05B19/414
• 代理公司: 南京天翼專利代理有限責任公司32112
• 代理人: 朱戈勝,查俊奎

1. 一種水下機器人，包括機器人本體以及監控機器人本體的監控站，所述機器人本體用于水下作業且包括機架、推進器和PLC控制器，所述推進器和PLC控制器設置在機架上，其特征在于，包括交換機， 所述PLC控制器包括EtherCAT總線耦合器、模擬量輸出模塊、數字量輸入模塊、模擬量輸入模塊和伺服驅動模塊，所述數字量輸入模塊、模擬量輸入模塊分別與EtherCAT總線耦合器連接，所述模擬量輸出模塊和伺服驅動模塊分別與EtherCAT總線耦合器連接，所述伺服驅動模塊與推進器連接以驅動推動器，所述監控站包括TwinCAT主站、監控主機和顯示器，所述PLC控制器中的EtherCAT總線耦合器與交換機通過以太網方式通信連接，所述交換機與TwinCAT主站通過以太網方式通信連接，所述TwinCAT主站與主機通過以太網方式通信連接，所述顯示器與主機連接，所述交換機可安裝在機器人本體上或者監控站中。

2.臺和網絡攝像頭，所述網絡攝像頭安裝在攝像頭云臺上且與交換機通信連接，所述攝像頭云臺與模擬量輸出模塊電連接。

3.如權利要求1所述的一種水下機器人，其特征在于，包括機械手和角度傳感器，所述機械手安裝在機架上且機械手的各關節分別具有一關節電機，所述伺服驅動模塊與機械手的關節電連接以驅動機械手各關節運動，所述角度傳感器安裝在機械手各關節上且用于測量各關節運動角度，所述角度傳感器的輸出端與模擬量輸入模塊電連接。

4.如權利要求3所述的一種水下機器人，其特征在于，包括力傳感器，所述力傳感器安裝在機械手的自由端且用來感知夾持物體時的力度，所述力傳感器與模擬量輸入模塊電連接。

5.如權利要求1所述的一種水下機器人，其特征在于，包括高亮LED燈，所述高亮LED燈與模擬量輸出模塊電連接，所述高亮LED燈安裝在機架上。

6.如權利要求1所述的一種水下機器人，其特征在于，包括溫度傳感器，所述溫度傳感器安裝在推進器上以采集推進器的溫度，所述溫度傳感器分別與數字量輸入模塊電連接。

7.如權利要求1所述的一種水下機器人，其特征在于，包括深度傳感器、速度傳感器、陀螺儀、GPS傳感器和流速傳感器，所述深度傳感器配備為測量機器人本體的下潛水深，所述速度傳感器配備為機器人本體的運行速度，所述陀螺儀配備為測量機器人本體的姿態，所述GPS傳感器配備為測量機器人本體的位置信息，所述流速傳感器配備為測量水流速度，所述深度傳感器、速度傳感器、陀螺儀、GPS傳感器和流速傳感器分別固定在機器人本體上，所述深度傳感器與數字量輸入模塊電連接，所述速度傳感器、陀螺儀、GPS傳感器和流速傳感器分別與模擬量輸入模塊電連接。

8.如權利要求1所述的一種水下機器人，其特征在于，所述TwinCAT主站采用基于TwinCAT控制器的TwinCAT主站，所述主機安裝有LabVIEW系統。