CN113225705A - Multi-robot data communication system with customized communication interface - Google Patents
Multi-robot data communication system with customized communication interface Download PDFInfo
- Publication number
- CN113225705A CN113225705A CN202110400112.6A CN202110400112A CN113225705A CN 113225705 A CN113225705 A CN 113225705A CN 202110400112 A CN202110400112 A CN 202110400112A CN 113225705 A CN113225705 A CN 113225705A
- Authority
- CN
- China
- Prior art keywords
- pin
- module
- robot
- chip
- reserved
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000005540 biological transmission Effects 0.000 claims abstract description 28
- 239000003381 stabilizer Substances 0.000 claims abstract 4
- 238000006317 isomerization reaction Methods 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 10
- 238000001514 detection method Methods 0.000 claims description 4
- 230000002159 abnormal effect Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 15
- 238000000034 method Methods 0.000 description 10
- 230000003993 interaction Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000002457 bidirectional effect Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000008676 import Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/38—Services specially adapted for particular environments, situations or purposes for collecting sensor information
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L69/00—Network arrangements, protocols or services independent of the application payload and not provided for in the other groups of this subclass
- H04L69/08—Protocols for interworking; Protocol conversion
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L69/00—Network arrangements, protocols or services independent of the application payload and not provided for in the other groups of this subclass
- H04L69/18—Multiprotocol handlers, e.g. single devices capable of handling multiple protocols
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/70—Services for machine-to-machine communication [M2M] or machine type communication [MTC]
Landscapes
- Engineering & Computer Science (AREA)
- Signal Processing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Computer Security & Cryptography (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
Description
技术领域technical field
本发明涉及多机器人系统技术领域,具体为一种针对异构辅助机器人之间实现统一化通信数据传输的系统。The invention relates to the technical field of multi-robot systems, in particular to a system for realizing unified communication data transmission between heterogeneous auxiliary robots.
背景技术Background technique
随着机器人应用领域和范围的扩展,机器人的工作环境及任务复杂度也在逐步上升,尤其在助老助残的场景下,单一机器人已难以完成工作任务,特别需要多个异构化辅助机器人相互配合才能有效的完成连续性生活行为辅助。因此,多个异构化辅助机器人之间的通信显得尤为重要,需要基于通信数据定制化、统一化的方法,来实现各异构辅助机器人在交互过程中的信息共享,为人与多机器人系统交互提供重要基础。With the expansion of the application field and scope of robots, the working environment and task complexity of robots are also gradually increasing. Especially in the scenario of helping the elderly and the disabled, it is difficult for a single robot to complete the work tasks, especially the need for multiple heterogeneous auxiliary robots to interact with each other. Cooperation can effectively complete the continuous life behavior assistance. Therefore, the communication between multiple heterogeneous auxiliary robots is particularly important, and a customized and unified method based on communication data is required to realize the information sharing of various heterogeneous auxiliary robots in the interaction process, and to facilitate the interaction between humans and multi-robot systems. provide an important foundation.
目前国内的专利、产品暂无面向多个异构化日常生活辅助机器人的通信系统。对于多个异构化日常生活辅助机器人的通信系统中,由于每个异构机器人的机载传感器类型、通信协议并不相同,机器人彼此无法通信,即无法实现机器人彼此信息的共享。At present, there is no communication system for multiple heterogeneous daily life assistant robots in domestic patents and products. In the communication system of multiple heterogeneous daily life assistance robots, because the airborne sensor types and communication protocols of each heterogeneous robot are different, the robots cannot communicate with each other, that is, the sharing of information between the robots cannot be realized.
各异构机器人在室内复杂环境应用中,由于多运动目标,光照等因素影响,系统性能、通信方式受到干扰。针对于助老助残的场景下,需要更多种类的传感器数据进行机器人彼此通信。同时,多个异构化辅助机器人、不同的使用者,需要采集机器人彼此位姿信息,使用者操纵机器人的心率、肌电信号等,单一的通信方法不能实现。In the application of various heterogeneous robots in complex indoor environments, due to the influence of multiple moving targets, illumination and other factors, the system performance and communication methods are disturbed. For the scenarios of helping the elderly and the disabled, more types of sensor data are needed for robots to communicate with each other. At the same time, multiple isomerized auxiliary robots and different users need to collect the position and posture information of the robots, and the users manipulate the heart rate and electromyographic signals of the robots, which cannot be realized by a single communication method.
发明内容SUMMARY OF THE INVENTION
本发明的目的在于提供了一种含定制化通信接口的多机器人数据通信系统,实现使用者与机器人交互过程中的生物电信号,各异构化辅助机器人的位置信息、朝向信息等数据共享。提高多种辅助机器人的兼容性,为多机器人协作系统提供应用平台。The purpose of the present invention is to provide a multi-robot data communication system with a customized communication interface, which realizes the data sharing of bioelectric signals, position information and orientation information of each isomerized auxiliary robot during the interaction between the user and the robot. Improve the compatibility of various auxiliary robots and provide an application platform for the multi-robot collaborative system.
为实现上述目的,本发明提供如下技术方案:一种含定制化通信接口的多机器人数据通信系统,该系统包括有PCB电路板和电源,所述电源通过开关与PCB电路板上的电源接口V1连接;PCB电路板上设有中央处理器芯片、传输模块P3、陀螺仪P4、无线通信模块P5、继电器P9和多个预留模块,中央处理器芯片的输入/输出接口分别连接数据传输模块P3、陀螺仪P4、无线通信模块P5、继电器P9和多个预留模块;In order to achieve the above purpose, the present invention provides the following technical solutions: a multi-robot data communication system with a customized communication interface, the system includes a PCB circuit board and a power supply, the power supply is connected to the power supply interface V1 on the PCB circuit board through a switch Connection; the PCB circuit board is provided with a CPU chip, a transmission module P3, a gyroscope P4, a wireless communication module P5, a relay P9 and a plurality of reserved modules, and the input/output interfaces of the CPU chip are respectively connected to the data transmission module P3 , gyroscope P4, wireless communication module P5, relay P9 and multiple reserved modules;
开关通过稳压器分别与数据传输模块P3、陀螺仪P4、无线通信模块P5、继电器P9和多个预留模块连接;数据传输模块P3与异构辅助机器人的串口进行连接,无线通信模块P5电信号连接控制中心和其他机器人。The switch is connected to the data transmission module P3, the gyroscope P4, the wireless communication module P5, the relay P9 and several reserved modules respectively through the voltage regulator; the data transmission module P3 is connected to the serial port of the heterogeneous auxiliary robot, and the wireless communication module P5 is electrically connected. Signals connect the control center and other robots.
与现有技术相比,本发明的有益效果是:目前国内暂无针对多个异构化辅助机器人的通信系统,多个异构化机器人同时执行任务时,彼此无法通信。而本发明提出一种面向异构辅助机器人的通用化数据通信系统,该系统在多个异构化辅助机器人由于各自传感器类型与通信协议的不同导致通信数据异构的情况下,可以实现彼此的通信。本发明为异构化辅助机器人之间提供了通信平台,增加了多种异构化辅助机器人之间的兼容性。Compared with the prior art, the present invention has the beneficial effects that there is currently no communication system for multiple isomerized auxiliary robots in China, and when multiple isomerized robots perform tasks at the same time, they cannot communicate with each other. However, the present invention proposes a generalized data communication system for heterogeneous auxiliary robots, which can realize the communication between multiple heterogeneous auxiliary robots when the communication data is heterogeneous due to the difference of their respective sensor types and communication protocols. communication. The present invention provides a communication platform for the isomerization auxiliary robots, and increases the compatibility between various isomerization auxiliary robots.
本发明的通信系统中预留了多个传感器串口,当本发明连接的机器人需要增加其它类型的传感器时,即插即用,可随时将所需传感器插在本发明的通信系统上,从而使通信系统收集的数据类型更加灵活,很好的解决了机器人后续添加新功能而无法导入数据的问题,提高了通信系统的可拓展性。A plurality of sensor serial ports are reserved in the communication system of the present invention. When the robot connected by the present invention needs to add other types of sensors, plug and play can be used, and the required sensors can be inserted into the communication system of the present invention at any time, so that the The type of data collected by the communication system is more flexible, which solves the problem that the robot cannot import data after adding new functions, and improves the scalability of the communication system.
附图说明Description of drawings
图1为本发明面向异构辅助机器人的通用化数据通信系统框图。FIG. 1 is a block diagram of a generalized data communication system for heterogeneous auxiliary robots according to the present invention.
图2为本发明单片机STM32F407ZGT6的各个引脚连接图。FIG. 2 is a connection diagram of each pin of the microcontroller STM32F407ZGT6 of the present invention.
图3a和3b为本发明单片机双排25*2针与各模块的引脚连接图。3a and 3b are the pin connection diagrams of the double row 25*2 pins of the single-chip microcomputer of the present invention and each module.
图4为本发明LED灯连接电路图。FIG. 4 is a connection circuit diagram of the LED lamp of the present invention.
图5a为本发明预留模块P1连接电路图。FIG. 5a is a connection circuit diagram of the reserved module P1 of the present invention.
图5b为本发明UWB定位系统连接电路图。FIG. 5b is a connection circuit diagram of the UWB positioning system of the present invention.
图5c为本发明数据传输模块P3连接电路图。FIG. 5c is a connection circuit diagram of the data transmission module P3 of the present invention.
图5d为本发明陀螺仪P4连接电路图。FIG. 5d is a connection circuit diagram of the gyroscope P4 of the present invention.
图5e为本发明无线通信模块P5连接电路图。FIG. 5e is a connection circuit diagram of the wireless communication module P5 of the present invention.
图5f为本发明心率检测模块连接电路图。FIG. 5f is a connection circuit diagram of the heart rate detection module of the present invention.
图5g为本发明蜂鸣器P8连接电路图。FIG. 5g is the connection circuit diagram of the buzzer P8 of the present invention.
图5h为本发明继电器P9连接电路图。FIG. 5h is a circuit diagram of the connection of the relay P9 of the present invention.
图6a为本发明第一个稳压器LM1117的电路连接图。Figure 6a is a circuit connection diagram of the first voltage regulator LM1117 of the present invention.
图6b为本发明第二个稳压器LM1117的电路连接图。Figure 6b is a circuit connection diagram of the second voltage regulator LM1117 of the present invention.
图6c为本发明稳压器7805的电路连接图。FIG. 6c is a circuit connection diagram of the voltage regulator 7805 of the present invention.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, but not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.
如图1所示,本发明提供一种技术方案:一种含定制化通信接口的多机器人数据通信系统,包括PCB电路板,PCB电路板上分别设有芯片、数据传输模块P3、陀螺仪P4、无线通信模块P5、蜂鸣器P8、继电器P9和多个LED灯;PCB电路板的电源接口与VCC电源间接通有开关;PCB电路板还设有多个预留模块。As shown in FIG. 1 , the present invention provides a technical solution: a multi-robot data communication system with a customized communication interface, comprising a PCB circuit board, which are respectively provided with a chip, a data transmission module P3, and a gyroscope P4 , wireless communication module P5, buzzer P8, relay P9 and multiple LED lights; there is a switch between the power interface of the PCB circuit board and the VCC power supply; the PCB circuit board also has a number of reserved modules.
芯片的类型为STM32F407ZGT6,该芯片带有25*4个引脚,分别对应于双排25*2针的插件,其中PCB板上各模块的引脚按照图3的连接方式连接于芯片上。芯片STM32F407ZGT6可集中处理接收到的不同类型的数据,可将不同类型的数据转换为同一进制下,还可将原始数据转换为操作人员易懂的信息通过无线通信模块传输给控制中心。The type of the chip is STM32F407ZGT6. The chip has 25*4 pins, which correspond to double-row 25*2-pin plug-ins respectively. The pins of each module on the PCB are connected to the chip according to the connection method shown in Figure 3. The chip STM32F407ZGT6 can centrally process different types of data received, convert different types of data into the same system, and also convert the original data into information that is easy for operators to understand and transmit to the control center through the wireless communication module.
数据传输模块P3,可通过该接口将本发明与异构辅助机器人串口进行连接,从而将机器人运行状态数据及搭载传感器数据进行采集。The data transmission module P3 can connect the present invention with the serial port of the heterogeneous auxiliary robot through this interface, so as to collect the data of the robot running state and the data of the mounted sensor.
数据传输模块P3共4个引脚,1号引脚连接VCC5端口;2号引脚连接Chair_TXD,对应于芯片的PB11管脚;3号引脚连接Chair_RXD,对应于芯片的PB10管脚;4号引脚接地。其中2号引脚、3号引脚连接异构化辅助机器人,2号引脚传送数据,3号引脚接收数据。(例如:采集轮椅机器人运动数据与机载传感器数据,通过P3接口将本发明与轮椅机器人串口连接。该接口共4个引脚,1号引脚连接VCC5端口;2号引脚连接Chair_TXD;3号引脚连接Chair_RXD;4号引脚接地。)The data transmission module P3 has a total of 4 pins.
陀螺仪P4的型号为MPU9250,可测量出该模块及其机器人角度、加速度和航向角等数据。该陀螺仪内部集成有3轴陀螺仪、3轴加速度计和3轴磁力计,通过传感器电路总线接口和芯片STM32F407ZGT6进行数据交互,用于测量机器人三轴转向角度、角速度、加速度和机器人航向角数据。The model of the gyroscope P4 is MPU9250, which can measure the angle, acceleration and heading angle of the module and its robot. The gyroscope is internally integrated with a 3-axis gyroscope, a 3-axis accelerometer and a 3-axis magnetometer. It exchanges data with the chip STM32F407ZGT6 through the sensor circuit bus interface, and is used to measure the robot's three-axis steering angle, angular velocity, acceleration and robot heading angle data. .
陀螺仪P4共4个引脚,1号引脚连接第二3.3v稳压器;2号引脚连接Gyro_TXD,对应于芯片的PA1管脚;3号引脚连接Gyro_RXD,对应于芯片的PA0管脚;4号引脚接地。其中2号引脚、3号引脚连接陀螺仪,2号引脚传送数据,3号引脚接收数据。The gyroscope P4 has a total of 4 pins, the No. 1 pin is connected to the second 3.3v voltage regulator; the No. 2 pin is connected to Gyro_TXD, which corresponds to the PA1 pin of the chip; the No. 3 pin is connected to Gyro_RXD, which corresponds to the chip's PA0 tube pin;
无线通信模块P5为2.4GZigbee无线通信模块。该通信模块用于将采集的机器人数据、机载传感器数据和板载传感器数据进行通信协议定制后,与多机器人控制中心和其他机器人进行双向数据交互。由于异构机器人间传输数据具有差异性,因此,需结合通信对象特征,完成定制化通信协议与数据编码、解码过程。在进行通用化处理后,通过无线传输的方式传输给多机器人控制中心以及其它异构化辅助机器人,实现多个异构化辅助机器人的通信。The wireless communication module P5 is a 2.4G Zigbee wireless communication module. The communication module is used to conduct bidirectional data interaction with the multi-robot control center and other robots after customizing the communication protocol of the collected robot data, airborne sensor data and onboard sensor data. Due to the differences in the data transmitted between heterogeneous robots, it is necessary to combine the characteristics of the communication object to complete the customized communication protocol and data encoding and decoding process. After generalization processing, it is transmitted to the multi-robot control center and other heterogeneous auxiliary robots through wireless transmission, so as to realize the communication of multiple heterogeneous auxiliary robots.
无线通信模块P5共4个引脚,1号引脚连接第一3.3v稳压器;2号引脚连接Zee_TXD;3号引脚连接Zee_RXD,对应于芯片的PC12管脚;4号引脚接地。其中2号引脚、3号引脚连接2.4GZigbee无线通信模块,2号引脚传送数据,3号引脚接收数据。The wireless communication module P5 has a total of 4 pins,
蜂鸣器P8共3个引脚,1号引脚连接第一3.3v稳压器;2号引脚连接BEEP,对应于芯片的PB9管脚;3号引脚接地。其中2号引脚接收BEEP信号。系统出现异常时蜂鸣器P8可发出报警声音。当传输数据失败时或系统中有异常产生时,单片机会控制蜂鸣器发出声音,以便通过声音来得知系统运行情况。The buzzer P8 has a total of 3 pins, the No. 1 pin is connected to the first 3.3v voltage regulator; the No. 2 pin is connected to BEEP, which corresponds to the PB9 pin of the chip; the No. 3 pin is grounded. Among them,
继电器P9用于起到自动调节与保护电路的作用,共4个引脚,1号引脚连接第二3.3v稳压器;2号引脚连接UP,对应于芯片的PC10管脚;3号引脚连接DOWN,对应于芯片的PC11管脚;4号引脚接地。Relay P9 is used to play the role of automatic adjustment and protection circuit. There are 4 pins in total. No. 1 pin is connected to the second 3.3v voltage regulator; No. 2 pin is connected to UP, which corresponds to the PC10 pin of the chip; No. 3 The pin is connected to DOWN, which corresponds to the PC11 pin of the chip;
预留模块P1、预留模块P2、预留模块P7和数据传输模块P3均通过5v稳压器连接开关。5v稳压器的型号为7805-5v,且其输出的5v电压通过VCC5端口连接预留模块P1、预留模块P2、预留模块P7和数据传输模块P3。The reserved module P1, the reserved module P2, the reserved module P7 and the data transmission module P3 are all connected to the switch through a 5v voltage regulator. The model of the 5v regulator is 7805-5v, and the output 5v voltage is connected to the reserved module P1, the reserved module P2, the reserved module P7 and the data transmission module P3 through the VCC5 port.
7805-5v稳压器用于将直流输入电压VCC转换成5V直流输出电压以向其他电气元件供电。该稳压器电路和元件设置在PCB电路板上。The 7805-5v regulator is used to convert the DC input voltage VCC to a 5V DC output voltage to power other electrical components. The voltage regulator circuit and components are provided on the PCB circuit board.
无线通信模块P5和蜂鸣器P8通过第一3.3v稳压器连接开关。第一3.3v稳压器的型号为LM1117,且其输出的3.3v电压通过3V3_1端口连接无线通信模块P5和蜂鸣器P8。The wireless communication module P5 and the buzzer P8 are connected to the switch through the first 3.3v voltage regulator. The model of the first 3.3v voltage regulator is LM1117, and the output 3.3v voltage is connected to the wireless communication module P5 and the buzzer P8 through the 3V3_1 port.
陀螺仪P4、继电器P9和LED灯通过第二3.3v稳压器连接开关。第二3.3v稳压器的型号同为LM1117,且其输出的3.3v电压通过3V3_2端口连接陀螺仪P4、继电器P9和LED灯。The gyroscope P4, relay P9 and the LED light are connected to the switch via a second 3.3v regulator. The model of the second 3.3v regulator is the same as LM1117, and the output 3.3v voltage is connected to the gyroscope P4, the relay P9 and the LED light through the 3V3_2 port.
LED灯的数量为4个,且4个LED灯并联于3V3_2端口。4个LED灯分别连接PB5、PB6、PB7和PB8插口。其用于显示通讯是否成功。若LED灯每隔0.1s闪烁一次,则代表系统通信正常。The number of LED lights is 4, and the 4 LED lights are connected in parallel to the 3V3_2 port. The 4 LED lights are connected to the PB5, PB6, PB7 and PB8 sockets respectively. It is used to show whether the communication was successful. If the LED light flashes once every 0.1s, it means the system communication is normal.
预留模块接口的数量为3个,且分别为预留模块P1、预留模块P2和预留模块P7。The number of reserved module interfaces is 3, which are reserved module P1, reserved module P2 and reserved module P7 respectively.
预留模块P1共4个引脚,1号引脚连接VCC5端口;2号引脚连接USART6_TXD,对应于芯片的PA7管脚;3号引脚连接USART6_RXD,对应于芯片的PA6管脚;4号引脚接地。若增加其他类型传感器时,其中2号、3号引脚连接传感器,2号引脚传送数据,3号引脚接收数据。The reserved module P1 has a total of 4 pins, the No. 1 pin is connected to the VCC5 port; the No. 2 pin is connected to USART6_TXD, which corresponds to the PA7 pin of the chip; the No. 3 pin is connected to USART6_RXD, which corresponds to the chip's PA6 pin; No. 4 pin to ground. If other types of sensors are added, the No. 2 and No. 3 pins are connected to the sensor, the No. 2 pin transmits data, and the No. 3 pin receives data.
预留模块P2共4个引脚,1号引脚连接VCC5端口;2号引脚连接Local_TXD,对应于芯片的PA3管脚;3号引脚连接Local_RXD,对应于芯片的PA2管脚;4号引脚接地。当该模块连接定位模块时,其中2号引脚、3号引脚连接UWB定位标签,2号引脚传送数据,3号引脚接收数据。The reserved module P2 has a total of 4 pins, the No. 1 pin is connected to the VCC5 port; the No. 2 pin is connected to Local_TXD, which corresponds to the PA3 pin of the chip; the No. 3 pin is connected to Local_RXD, which corresponds to the chip's PA2 pin; No. 4 pin to ground. When the module is connected to the positioning module, the No. 2 pin and No. 3 pin are connected to the UWB positioning label, the No. 2 pin transmits data, and the No. 3 pin receives data.
预留模块P7共6个引脚,1、2、3号引脚连接VCC5端口;4号引脚无连接对象,5号引脚连接Dig_out,对应于芯片的PE0管脚;6号引脚接地。The reserved module P7 has a total of 6 pins, pins 1, 2 and 3 are connected to the VCC5 port;
本发明系统的预留接口可以连接UWB定位系统,通过结合卡尔曼滤波算法,从而精确的计算定位标签的位置,即可实时获得该异构化辅助机器人的室内位置信息。The reserved interface of the system of the present invention can be connected to the UWB positioning system, and by combining the Kalman filter algorithm, the position of the positioning tag can be accurately calculated, and the indoor position information of the isomerization auxiliary robot can be obtained in real time.
本发明系统的预留接口可以连接心率检测模块连接测量使用者心率的传感器,可以将使用者的心率数据传入芯片,实现使用者与异构化辅助机器人之间的通信。或者用于采集使用者的肌电信号,通过该模块连接肌电信号传感器将需采集的肌电信号数据传输到本系统的单片机中,用作信号的处理与分析。The reserved interface of the system of the present invention can be connected to the heart rate detection module to connect the sensor for measuring the user's heart rate, and the user's heart rate data can be transmitted to the chip to realize the communication between the user and the isomerized auxiliary robot. Or used to collect the user's EMG signal, and connect the EMG signal sensor through this module to transmit the EMG signal data to be collected to the single-chip microcomputer of the system for signal processing and analysis.
本发明预留多个传感器接口,如果当前的传感器接口以无法满足对新型数据种类的采集,该接口可随时连接新型传感器以便采集多种数据信息,大大提高了系统的可拓展性。The invention reserves a plurality of sensor interfaces. If the current sensor interface cannot meet the collection of new types of data, the interface can be connected to the new sensor at any time to collect various data information, which greatly improves the expandability of the system.
本发明的数据传输模块用于连接异构化辅助机器人串口,同时,需将本发明系统固定在异构化辅助机器人机身,使异构化辅助机器人的位姿信息与本发明系统同步,即本发明系统的位置信息、朝向信息即为该异构化辅助机器人对应的信息。与此同时,本发明通过串口通信可以接收该异构化辅助机器人所采集的各种数据,例如对全方向移动底盘的速度、方向控制及底盘四周超声传感器的距离等数据。The data transmission module of the present invention is used to connect the serial port of the isomerization auxiliary robot. At the same time, the system of the invention needs to be fixed on the body of the isomerization auxiliary robot, so that the pose information of the isomerization auxiliary robot is synchronized with the system of the invention, that is, The position information and orientation information of the system of the present invention are the information corresponding to the isomerized auxiliary robot. At the same time, the present invention can receive various data collected by the isomerization auxiliary robot through serial communication, such as the speed of moving the chassis in all directions, the direction control and the distance of ultrasonic sensors around the chassis.
本发明的工作流程是:首先将开关调到OFF处,并将本发明的数据传输模块连接并固定在异构化辅助机器人上,在此之后,本发明的其余各个模块按上述连接方式连接于各自的传感器,连接时应注意数据传输的端口和数据接收的端口的连接方式,以防损坏电路板。最后将VCC端口接入12V直流电压源,将GND端口接地。将开关调到ON,此时本发明开始工作,各异构化辅助机器人与使用者的通用化数据可在控制中心直观显示,各异构化辅助机器人也会获得彼此的信息,更好的实现交互,实现彼此通信。操作人员可在控制中心实时掌控各项数据,可有效快捷的对数据进行下一步的处理和分析。The work flow of the present invention is as follows: first, turn the switch to OFF, and connect and fix the data transmission module of the present invention on the isomerization auxiliary robot. After that, the other modules of the present invention are connected to the When connecting the respective sensors, pay attention to the connection method of the data transmission port and the data receiving port to prevent damage to the circuit board. Finally, connect the VCC port to a 12V DC voltage source, and connect the GND port to ground. Turn the switch to ON, at this time the invention starts to work, the generalized data of each isomerized auxiliary robot and the user can be visually displayed in the control center, and each isomerized auxiliary robot will also obtain each other's information, which is better to realize interact and communicate with each other. Operators can control various data in real time in the control center, and can effectively and quickly process and analyze the data in the next step.
具体功能如下:The specific functions are as follows:
(功能一)可拓展性:本发明系统板载多种传感器并预留多种传感器接口,具有较强的拓展能力。当使用者与机器人交互过程中,使用者的心率信号、位置信息,各异构化辅助机器人的底盘的速度、方向及底盘四周的距离数据和机器人的加速度与航向角方向等数据都可采集并传输到主控系统上,通过主控系统的统一处理、定制化通信协议后,将数据通过无限传输模块传输到多机器人控制中心和其他异构化辅助机器人上。(Function 1) Scalability: The system of the present invention has a variety of sensors onboard and a variety of sensor interfaces are reserved, and has strong expansion ability. When the user interacts with the robot, the user's heart rate signal, position information, the speed and direction of the chassis of each isomerized auxiliary robot, and the distance data around the chassis, as well as the robot's acceleration and heading angle, etc. data can be collected and processed. After the data is transmitted to the main control system, through the unified processing of the main control system and the customized communication protocol, the data is transmitted to the multi-robot control center and other heterogeneous auxiliary robots through the infinite transmission module.
(功能二)定制化通信协议:通过连接多种不同种类的传感器可以获得本发明所连接机器人和使用者的各种数据,根据数据类型,本发明系统可以将这些数据生成定制化通信协议,为多机器人彼此交互和多机器人系统控制提供基础。(Function 2) Customized communication protocol: Various data of the connected robot and user of the present invention can be obtained by connecting a variety of different types of sensors. According to the data type, the system of the present invention can Multi-robot interaction with each other and multi-robot system control provide the basis.
(功能三)多异构机器人通信:将本发明用上述方式连接在各异构化辅助机器人上,针对各异构化机器人的通信协议不同,传感器类型不同导致通信数据不同问题,结合本发明的定制化通信协议,通过无线通信模块实现多个异构化辅助机器人数据相互通信,从而获取机器人彼此位置、朝向信息与使用者的信息。(Function 3) Multi-heterogeneous robot communication: The present invention is connected to each isomerized auxiliary robot in the above-mentioned manner. For different communication protocols of each isomerized robot and different sensor types, different communication data problems are caused. The customized communication protocol realizes the mutual communication of data of multiple heterogeneous auxiliary robots through the wireless communication module, so as to obtain the position, orientation information and user information of the robots.
实施例Example
以本发明系统与某种具有全向轮的辅助机器人通信为例,首先将本发明与机器人串口相连,并结合该机器人机构、控制系统、传感器类型定制通信协议为例,其中本发明发送指令控制机器人控制板的通信协议格式如下:Taking the communication between the system of the present invention and a certain auxiliary robot with omnidirectional wheels as an example, firstly, the present invention is connected to the serial port of the robot, and the communication protocol is customized in combination with the robot mechanism, control system, and sensor type as an example, wherein the present invention sends an instruction to control The communication protocol format of the robot control board is as follows:
本发明系统→机器人控制板System of the present invention→Robot control board
其中,in,
Enable(使能位)Enable (enable bit)
:0电机驱动的指令无效(电机自由状态): 0 The command of motor drive is invalid (motor free state)
:1电机驱动的指令有效(电机根据Direction,Speed的指令运动): 1 The command of the motor drive is valid (the motor moves according to the command of Direction and Speed)
Direction(方向位)Direction (direction bit)
:0电机的旋转方向CCW,即逆时针: 0 the rotation direction of the motor CCW, that is, counterclockwise
:1电机的旋转方向CW,即顺时针: 1 The rotation direction of the motor is CW, that is, clockwise
Speed(电机速度)Speed (motor speed)
:0~255(8bit 0x00~0xFF): 0~255 (8bit 0x00~0xFF)
0时速度最低、255时速度最大Lowest speed at 0, maximum speed at 255
table UP(机器人高度上升调节)table UP (robot height up adjustment)
:0无动作: 0 no action
:1扶板上升: 1 lift plate
table DOWN(机器人高度下降调节)table DOWN (Robot Height Down Adjustment)
:0无动作: 0 no action
:1扶板下降: 1 lift plate down
设定通信规则:本系统以每100毫秒向机器人发送上述格式的数据。如果500毫秒以上机器没有接收到从系统发送的上述格式的数据,机器人电机将停机。FCS是帧校验码,其为从Start code开始到所有的数据结束(即FCS之前的数据)执行异或操作的结果。Set communication rules: The system sends data in the above format to the robot every 100 milliseconds. If the machine does not receive the data in the above format sent from the system for more than 500 milliseconds, the robot motor will stop. FCS is a frame check code, which is the result of performing an XOR operation from the Start code to the end of all data (ie, data before FCS).
当机器人控制板将机器人本体数据传送至本发明系统后,将机器人运动数据、机器人安装传感器数据与发明系统传感器数据结合,生成定制化通信协议。该协议用于通过无线传输方式将统一化总体数据传输给多机器人控制中心以及其它异构化辅助机器人,实现多机器人系统总体化通信和异构机器人间通信。通信协议格式如下:After the robot control board transmits the data of the robot body to the system of the invention, it combines the robot motion data, the sensor data of the robot installation and the sensor data of the invention system to generate a customized communication protocol. This protocol is used to transmit the unified overall data to the multi-robot control center and other heterogeneous auxiliary robots through wireless transmission, so as to realize the overall communication of the multi-robot system and the communication between the heterogeneous robots. The communication protocol format is as follows:
1.Out2的输出格式为:1. The output format of Out2 is:
"1_OP:%1d,%1d,%1d,%1d,%1d,%1d,%1d,%1d,%1d\r\n",ems,OPE_MODE,SPEED_MODE,PB_SW,JOYSW_X,JOYSW_Y,JOYSW_Z,TBL_UP,TBL_DN,作用是发送开关的操作信息:"1_OP:%1d,%1d,%1d,%1d,%1d,%1d,%1d,%1d,%1d\r\n",ems,OPE_MODE,SPEED_MODE,PB_SW,JOYSW_X,JOYSW_Y,JOYSW_Z,TBL_UP ,TBL_DN, the function is to send the operation information of the switch:
2.Out3的输出格式为:2. The output format of Out3 is:
"2_SN,%4d,%4d,%4d,%4d,%4d,%4df\r\n",FR,FL,RR,LL,BR,BL,作用是发送机器人本体嵌入的六个不同方向超声波传感器的输出信号。"2_SN,%4d,%4d,%4d,%4d,%4d,%4df\r\n",FR,FL,RR,LL,BR,BL, the function is to send ultrasonic waves in six different directions embedded in the robot body the output signal of the sensor.
FR,FL,RR,LL,BR,BL分别为右前、左前、右、左、右后、左后方向。FR, FL, RR, LL, BR, BL are right front, left front, right, left, right rear, and left rear directions, respectively.
3.Out4的输出格式为:3. The output format of Out4 is:
"3_RS,%+4d,%+4d,%+4d,%+4d\r\n",FR,FL,BR,BL,作用是发送机器人本体中右前、左前、右后、左后电机的旋转信息。"3_RS,%+4d,%+4d,%+4d,%+4d\r\n",FR,FL,BR,BL, the function is to send the rotation of the front right, front left, rear right and rear left motors in the robot body information.
4.Out5的输出格式为:4. The output format of Out5 is:
"4_LS,%+4d,%+4d,%+4d,%+4d,%+4d,%+4d\r\n",RF,RC,RB,LF,LC,LB,作用是发送后期安装在机器人上六个压力传感器输出信号。RF,RC,RB,LF,LC,LB分别为右前、右中、右后、左前、左中、左后。"4_LS,%+4d,%+4d,%+4d,%+4d,%+4d,%+4d\r\n",RF,RC,RB,LF,LC,LB, the function is to send the post installation in The six pressure sensors on the robot output signals. RF, RC, RB, LF, LC, LB are right front, right middle, right rear, left front, left middle, and left rear, respectively.
5.Out6的输出格式为:5. The output format of Out6 is:
"5_PS,%+5d,%+5d,%+5d,%+5d,%+5d,%+5d\r\n",acc_x,acc_y,acc_z,gyro_x,gyro_y,gyro_z,作用是通过本发明系统中的陀螺仪测量机器人各个姿态的输出信号:"5_PS,%+5d,%+5d,%+5d,%+5d,%+5d,%+5d\r\n",acc_x,acc_y,acc_z,gyro_x,gyro_y,gyro_z, the function is through the system of the present invention The gyroscope in measures the output signal of each attitude of the robot:
通过本发明,可以综合机器人本体运动信息、机器人自带传感器、外接传感器和发明板载传感器的信息,统一化通信协议,方便传输给中心控制系统和其他机器人系统。Through the invention, the robot body motion information, the robot's own sensor, the external sensor and the invention's onboard sensor information can be integrated, the communication protocol can be unified, and the transmission to the central control system and other robot systems can be facilitated.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110400112.6A CN113225705A (en) | 2021-04-14 | 2021-04-14 | Multi-robot data communication system with customized communication interface |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110400112.6A CN113225705A (en) | 2021-04-14 | 2021-04-14 | Multi-robot data communication system with customized communication interface |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113225705A true CN113225705A (en) | 2021-08-06 |
Family
ID=77087278
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110400112.6A Pending CN113225705A (en) | 2021-04-14 | 2021-04-14 | Multi-robot data communication system with customized communication interface |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113225705A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115519548A (en) * | 2022-11-29 | 2022-12-27 | 海南狮子鱼深海技术有限公司 | Mechanical arm sensor acquisition board |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103377541A (en) * | 2013-07-16 | 2013-10-30 | 中国科学院深圳先进技术研究院 | Human body fall-down prevention early warning and intervening method and system |
CN205311867U (en) * | 2016-01-08 | 2016-06-15 | 何惠威 | Portable underwater robot |
CN106054896A (en) * | 2016-07-13 | 2016-10-26 | 武汉大学 | Intelligent navigation robot dolly system |
CN106444789A (en) * | 2016-12-03 | 2017-02-22 | 河池学院 | Multi-robot formation control system based on wireless sensor network |
CN109471435A (en) * | 2018-11-09 | 2019-03-15 | 福州大学 | A multi-heterogeneous mobile robot control system |
CN208722023U (en) * | 2018-09-26 | 2019-04-09 | 沈阳希科泰科技有限公司 | Vehicle control unit of electric vehicle |
CN110292509A (en) * | 2019-07-03 | 2019-10-01 | 广西科技大学 | A kind of exoskeleton rehabilitation robot control system |
CN111710146A (en) * | 2020-06-16 | 2020-09-25 | 中惠宇航(广东)科技股份公司 | Multi-sensor data collection system and method |
-
2021
- 2021-04-14 CN CN202110400112.6A patent/CN113225705A/en active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103377541A (en) * | 2013-07-16 | 2013-10-30 | 中国科学院深圳先进技术研究院 | Human body fall-down prevention early warning and intervening method and system |
CN205311867U (en) * | 2016-01-08 | 2016-06-15 | 何惠威 | Portable underwater robot |
CN106054896A (en) * | 2016-07-13 | 2016-10-26 | 武汉大学 | Intelligent navigation robot dolly system |
CN106444789A (en) * | 2016-12-03 | 2017-02-22 | 河池学院 | Multi-robot formation control system based on wireless sensor network |
CN208722023U (en) * | 2018-09-26 | 2019-04-09 | 沈阳希科泰科技有限公司 | Vehicle control unit of electric vehicle |
CN109471435A (en) * | 2018-11-09 | 2019-03-15 | 福州大学 | A multi-heterogeneous mobile robot control system |
CN110292509A (en) * | 2019-07-03 | 2019-10-01 | 广西科技大学 | A kind of exoskeleton rehabilitation robot control system |
CN111710146A (en) * | 2020-06-16 | 2020-09-25 | 中惠宇航(广东)科技股份公司 | Multi-sensor data collection system and method |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115519548A (en) * | 2022-11-29 | 2022-12-27 | 海南狮子鱼深海技术有限公司 | Mechanical arm sensor acquisition board |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107360477B (en) | A multifunctional remote debugging device | |
US10661912B2 (en) | Addressing method for functional modules of a movable object | |
CN107247460B (en) | A method and system for swarm control of robotic bees | |
CN102085664B (en) | Autonomous operation forestry robot intelligent control system | |
CN103646004B (en) | Modularization miniature intelligent vehicle hardware system and the method for constructing miniature intelligent vehicle | |
CN108476008A (en) | For the control method of driving motor rotation, electron speed regulator, power suit and unmanned vehicle | |
CN110161900B (en) | Remote operation's wearing formula remote control operation platform | |
CN206460276U (en) | A kind of unmanned plane | |
CN113225705A (en) | Multi-robot data communication system with customized communication interface | |
CN206170098U (en) | Automation of target can be indoorly followed and thing robot is got | |
CN205563189U (en) | Unmanned aerial vehicle flight controller | |
CN104097197A (en) | Modular robot | |
US20190280428A1 (en) | Configurable smart object system with magnetic contacts and magnetic assembly | |
CN113848909A (en) | Control system and control method of flip-blade type wall-climbing robot | |
CN117472848A (en) | Vehicle-mounted main control chip, control system and calculation force expansion method | |
CN102126222A (en) | Control system for remote-controlled robot | |
JP4480010B2 (en) | Distributed control system | |
US20190280421A1 (en) | Configurable smart object system with grid or frame-based connectors | |
CN111190424A (en) | An integrated sensor for autonomous positioning and mapping of indoor mobile robots | |
CN201489364U (en) | A robot motion platform based on bluetooth and embedded system | |
CN112550302B (en) | Driving controller and vehicle | |
CN210573389U (en) | A two-wheeled self-balancing trolley control system | |
CN209044388U (en) | Chassis control system of intelligent robot | |
CN209927144U (en) | Indoor navigation car based on laser SLAM | |
CN114815689A (en) | A UAV for realizing gesture control and its control system and control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210806 |
|
RJ01 | Rejection of invention patent application after publication |