A bionic robotic fish cluster underwater acoustic telemetry and remote control system and method thereof
By adopting the master-slave working mode and high-performance DSP in the bionic robot fish cluster water acoustic telemetry remote control system, combined with FH-MFSK modulation technology, the bionic robot fish cluster water acoustic telemetry remote control system in the existing technology is solved by a large volume and high power consumption. The problem of this problem has achieved efficient and real-time water acoustic communication and monitoring, and improved the collaborative operation capabilities of bionic robot fish.
Patent Information
- Application Number
- CN202211169116.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-09-23
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2042-09-23
AI Technical Summary
The existing bionic robot fish cluster water acoustic telemetry remote control system is difficult to achieve efficient network communication due to its large size, high power consumption and does not support secondary development, resulting in low monitoring and control efficiency in underwater environments, which is prone to conflicts and affects Network capacity.
Bionic robot fish cluster water acoustic telemetry remote control system adopts the master-slave working mode, realizes water acoustic communication and network protocols through high-performance DSP, and uses full-duplex water acoustic communication method, and the main control node and monitored node are sub-B1 and B2 respectively. Information transmission is carried out on the belt, and precise clock synchronization is achieved through synchronous clocks. Combined with FH-MFSK modulation and demodulation technology, channel encoding and decoding is performed to ensure real-time and robust monitoring.
A small-scale, low-power consumption bionic robot fish cluster water acoustic telemetry remote control system has been realized, which has improved the collaborative operation capabilities of multiple bionic robot fish, ensured real-time monitoring and control, and is suitable for the water acoustic environment with rapidly changing channels, and hardware systems. Small size and cheap, the software system can be upgraded, easy to debug and maintain.
Smart Images

Figure CN115694665B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of underwater acoustic telemetry and remote control, and in particular to a bionic robot fish cluster underwater acoustic telemetry and remote control system and method thereof. Background Art
[0002] Bionic robot fish is a small underwater robot, and its movement mode is similar to that of the real fish it imitates, and it has the advantages of realistic shape, high efficiency, quietness, flexibility and convenience. If cameras, temperature, pressure and other sensors are installed on the bionic robot fish, it can be applied to the fields of fish life habit observation, marine biological resource exploration and underwater environment monitoring. In addition, bionic robot fish can also be used as exhibits in places such as oceanariums, science and technology museums and schools. These bionic robot fish swim in the water tank alone or in groups, attracting the attention of many tourists with their realistic appearance and lively movement mode. However, most of the existing bionic robot fish are autonomous navigation modes, and people cannot effectively monitor and control them. Obviously, in order to improve the use value of bionic robot fish, such as the exhibition effect in places such as oceanariums and science and technology museums, cluster telemetry and remote control are very necessary.
[0003] Since the bionic robot fish works underwater, only sound waves can be used for effective telemetry and remote control. In recent years, underwater communication using sound waves, namely underwater acoustic communication, has developed rapidly. Most of the advanced technologies in radio communication have been applied to underwater acoustic communication, and good results have been achieved in marine tests. Various underwater acoustic modems with different modulation modes and different rates have emerged on the market, such as Link-Quest's UWM1000, UWM2000 and UWM3000 series of underwater acoustic modems; Benthos's ATM-910, ATM-920 and ATM-960 series of underwater acoustic modems. Most of these existing underwater acoustic modems are large in size, high in price and power consumption, and do not support secondary development, so it is difficult to use them directly for telemetry and remote control of bionic robot fish.
[0004] The underwater acoustic telemetry and remote control of bionic robot fish clusters involves the monitoring and control of multiple bionic robot fishes. It is necessary to develop an efficient network communication protocol to ensure the effective monitoring and control of robot fishes. Since the available frequency band resources in the underwater acoustic channel are very limited, most underwater acoustic communication networks use competition-based network protocols such as ALOHA, CSMA and MACA. These protocols will inevitably conflict, which will greatly reduce the network capacity in serious cases and may even cause two nodes to be unable to communicate with each other for a long time. In the underwater acoustic telemetry and remote control system of bionic robot fish clusters, the bionic robot fish is the monitored node, and the node on the water surface is the master node. The status of the two is unequal, so the efficiency of using competition-based network protocols is low, and it should be improved and perfected according to special application requirements. Summary of the invention
[0005] The purpose of the present invention is to address the above-mentioned problems existing in the existing technology and to provide a miniaturized, low-power and embedded bionic robotic fish cluster underwater acoustic telemetry and remote control system and method for multiple bionic robotic fish working together underwater.
[0006] The bionic robotic fish cluster underwater acoustic telemetry and remote control system is composed of a master control node, a monitored bionic robotic fish node (referred to as the monitored node) and a telemetry and remote control terminal, and adopts a master-slave working mode;
[0007] The master control node is a host, which only includes one node, while the monitored node is a slave, which includes two or more nodes; the master control node and the telemetry and remote control terminal exchange information through a wireless transceiver, which is used for issuing user instructions and forwarding the running status of the bionic robot fish; the master control node and the monitored node use an underwater acoustic communication method to exchange information, and the underwater acoustic communication and network protocol are all implemented in a high-performance DSP; the master control node and the monitored node of the bionic robot fish cluster underwater acoustic telemetry and remote control system use a full-duplex underwater acoustic communication method to ensure real-time and robust monitoring of the bionic robot fish; the master control node uses the B of the underwater acoustic transmitting transducer 1 The subband transmits information to the monitored node, and the monitored node uses the B of the underwater acoustic emission transducer 2 The sub-band transmits information to the master node, the master node sends information to the monitored node at any time, and the monitored node sends information to the master node after obtaining the frequency band resources through competition; the master node and the monitored node achieve precise clock synchronization through synchronous clocks.
[0008] The hardware system of the master control node includes components such as a wireless transceiver, a synchronous clock, a DSP and its peripheral circuits, a power amplifier circuit, a preamplifier circuit, a bandpass filter circuit, a power conversion circuit, an underwater acoustic emission transducer and a hydrophone; the wireless transceiver receives instructions from the telemetry and remote control terminal, and transmits the instructions to the DSP through the RS232 serial port, the DSP completes the modulation of the data, and outputs the signal to the power amplifier circuit through a D / A converter, and the electrical signal output after power amplification excites the underwater acoustic emission transducer to emit sound waves; the hydrophone receives the sound signal from the monitored node and converts it into an electrical signal, the electrical signal is amplified and filtered, and is input to the DSP through an A / D converter, the DSP completes the demodulation of the signal, and transmits the demodulated data to the wireless transceiver through the RS232 serial port, and the wireless transceiver sends the data to the telemetry and remote control terminal.
[0009] The hardware system of the monitored node includes components such as a synchronous clock, a DSP and its peripheral circuits, a power amplifier circuit, a preamplifier circuit, a bandpass filter circuit, a power conversion circuit, an underwater acoustic emission transducer and a hydrophone; the hydrophone receives the sound signal from the main control node and converts it into an electrical signal, the electrical signal is amplified and filtered, and then input to the DSP through an A / D converter, the DSP completes the demodulation of the signal, and sends the demodulated data to the bionic robot fish through an RS232 serial port; the DSP reads the status information of the bionic robot fish through the RS232 serial port, encodes and modulates it, and the modulated signal is output to the power amplifier circuit through a D / A converter, and the electrical signal output after power amplification excites the underwater acoustic emission transducer to emit sound waves.
[0010] The hardware system of the telemetry and remote control terminal includes a wireless transceiver and a PC; the PC and the wireless transceiver are connected by RS232 serial port communication; the PC interface software receives user instructions and transmits the instructions to the wireless transceiver through the RS232 serial port; the wireless transceiver uses wireless communication to exchange information with the main control node.
[0011] The bionic robotic fish cluster hydroacoustic telemetry and remote control method comprises the following steps:
[0012] 1) The telemetry and remote control terminal sets the ID of the monitored node through the serial port, and the ID of different monitored nodes is set to different values;
[0013] 2) The monitored node collects the status information of the bionic robot fish for source coding, generates a bionic robot fish status word, and forms a data frame;
[0014] 3) The DSP of the monitored node performs channel coding, channel interleaving and FH-MFSK modulation on the data frame obtained in step 2), and inserts a detection signal before and after each frame signal, and inserts a protection interval between the detection signal and the modulated signal;
[0015] 4) The DSP of the monitored node shifts the signal obtained in step 3) to B 2 The sub-band outputs an electrical signal through a D / A converter at a period T to drive the power amplifier to stimulate the underwater acoustic transducer to emit sound waves;
[0016] 5) The hydrophone of the master node receives the acoustic signal and converts it into an electrical signal. The electrical signal is preamplified and 2 After sub-band filtering, it enters the DSP of the master control node through the A / D converter;
[0017] 6) The DSP of the master control node uses the matched filtering method to determine whether a synchronization signal has arrived. If so, it first performs coarse Doppler estimation and compensation, and then performs underwater acoustic channel delay-Doppler joint estimation to obtain the impulse response and Doppler frequency deviation of the underwater acoustic channel;
[0018] 7) The DSP of the master control node performs Doppler compensation and channel matching processing on the received signal according to the Doppler frequency deviation and the impulse response of the underwater acoustic channel obtained in step 6);
[0019] 8) The DSP of the master control node performs FH-MFSK demodulation on the signal processed in step 7), and performs channel deinterleaving and channel decoding to generate a received data frame;
[0020] 9) The DSP of the master control node determines whether the CRC of the received data frame obtained in step 8) is correct. If it is correct, it forwards it to the telemetry and remote control terminal through the wireless transceiver and transmits it to the B of the underwater acoustic transducer. 1 The subband returns a response signal to the corresponding monitored node;
[0021] 10) If the monitored node receives a response signal from the master control node, it will continue to report the status information of the bionic robot fish to the master control node at a period T; if it does not receive a response signal from the master control node within a certain time range, it will report the status information of the bionic robot fish to the master control node again after a random delay of one time unit in units of 10ms;
[0022] 11) The telemetry and remote control terminal receives data from the master control node through a wireless transceiver, updates the status information of the corresponding bionic robotic fish, and marks the icon corresponding to the bionic robotic fish in blue. If the status information of a bionic robotic fish is not received for a certain period of time, an alarm message is generated, and the icon corresponding to the bionic robotic fish is marked in red;
[0023] 12) The telemetry and remote control terminal generates a control data frame according to the user input command;
[0024] 13) The telemetry and remote control terminal sends the control data frame obtained in step 12) to the master control node via a wireless transceiver;
[0025] 14) The DSP of the master control node receives data from the monitoring terminal through the wireless transceiver, and performs channel coding, channel interleaving and FH-MFSK modulation on the data, and inserts a detection signal before and after each frame signal, and inserts a protection interval between the detection signal and the modulation signal;
[0026] 15) The DSP of the master control node shifts the signal obtained in step 14) to B 1 The sub-band outputs electrical signals through the D / A converter to drive the power amplifier to stimulate the underwater acoustic transducer to emit sound waves;
[0027] 16) The hydrophone of the monitored node receives the acoustic signal and converts it into an electrical signal. 1 After sub-band filtering and pre-amplification, it enters the DSP of the monitored node through the A / D converter;
[0028] 17) The DSP of the monitored node adopts the same method as steps 6-8) to perform delay-Doppler joint estimation, Doppler compensation, channel matching, FH-MFSK demodulation, channel deinterleaving and channel decoding on the received signal, and generates a received data frame;
[0029] 18) The DSP of the monitored node determines whether the CRC of the received data frame obtained in step 17) is correct. If it is correct, it matches its ID with the ID in the received data frame and extracts the corresponding control word;
[0030] 19) The DSP of the monitored node decodes the control word obtained in step 18) and sends the obtained control command to the control host of the bionic robotic fish through the serial port.
[0031] In step 2), the state information of the bionic robotic fish includes the motion state of the bionic robotic fish, the sea depth at which the robot is located, and the remaining battery capacity ratio; the data frame may be constructed in the following format:
[0032] ID Bionic robot fish status word CRC
[0033] Wherein, ID is the ID of the monitored node, and CRC is the cyclic redundancy check code;
[0034] In step 6), the underwater acoustic channel delay-Doppler joint estimation is performed according to formula (1):
[0035]
[0036] Among them, α is a constant less than 1, P and Y are the Fourier transforms of the detection signal transmission and reception sequences, respectively, and ||u|| and ||u|| 1 They represent the l of u respectively. 2 and l 1 norm, u is the Fourier transform of the impulse response of the underwater acoustic channel, and its element u(i) is expressed as:
[0037]
[0038] Among them, h(n,m) (n=0,1,...,N-1,m=0,1,...,M-1) is the impulse response of the underwater acoustic channel.
[0039] In step 9), the response signal is returned to the corresponding monitored node by using FH-MFSK hydroacoustic modulation to return the response signal to the corresponding monitored node. The corresponding format is:
[0040] ID OK CRC .
[0041] In step 12), the telemetry and remote control terminal generates a control data frame in the following format according to the user input command:
[0042]
[0043] The control word is the source code of the bionic robotic fish control command. The control words belonging to different bionic robotic fish in the same data frame may be the same or different.
[0044] The advantages of the present invention are as follows:
[0045] 1. The modular design is adopted, and the underwater acoustic communication and wireless communication are combined to realize the remote telemetry and remote control of multiple bionic robot fish underwater, which helps to improve the collaborative operation ability of multiple bionic robot fish;
[0046] 2. The master-slave working mode is adopted. There is only one master control node and two or more monitored nodes. The master control node uses the B of the underwater acoustic emission transducer. 1 The subband transmits information to the monitored node, and the monitored node transmits information to the monitored node through B 2 The sub-band transmits information to the master node, and the two do not interfere with each other, with full-duplex communication function;
[0047] 3. It adopts a robust FH-MFSK underwater acoustic communication system and performs Doppler compensation and channel matching on the received signal based on the delay-Doppler joint estimation result, which is suitable for underwater acoustic environments with rapidly changing channels;
[0048] 4. With high-performance DSP as the core, underwater acoustic communication algorithms and network protocols are all implemented in one DSP. The hardware system is small in size, low in power consumption and cheap; the software system is upgradeable, easy to debug and maintain. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] Figure 1 This is the overall block diagram of the underwater acoustic telemetry and remote control of the bionic robotic fish cluster.
[0050] Figure 2 This is the block diagram of the master control node.
[0051] Figure 3 The block diagram of the monitored node.
[0052] Figure 4 This is the block diagram of the telemetry and remote control terminal.
[0053] Figure 5 This is the FH-4FSK underwater acoustic communication transmission flow chart.
[0054] Figure 6 This is the FH-4FSK underwater acoustic communication receiving flow chart.
[0055] Figure 7This is the program flow chart of the master control node.
[0056] Figure 8 This is the program flow chart of the monitored node.
[0057] Fig. 9 This is the flow chart of the telemetry and remote control terminal program. DETAILED DESCRIPTION
[0058] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments.
[0059] The bionic robotic fish cluster underwater acoustic telemetry and remote control system is composed of three parts: a main control node, a monitored bionic robotic fish node (referred to as a monitored node) and a telemetry and remote control terminal. Figure 1 As shown. There is only one master control node, which is deployed on the water surface. It is a bridge for information exchange between the telemetry and remote control terminal and the monitored nodes. It exchanges information with the telemetry and remote control terminal through wireless communication and with the monitored nodes through underwater acoustic communication. There are two or more monitored nodes. In this embodiment, five monitored nodes are provided, and their ID numbers are respectively set to 0x01, 0x02, 0x03, 0x04 and 0x05. They are connected to the bionic robot fish through the RS232 serial port to realize the control of the latter and query of status information. In order to ensure high-reliability information transmission between the master control node and the monitored node, a robust FH-4FSK underwater acoustic communication method is adopted, and the received signal is Doppler compensated and channel matched according to the delay-Doppler joint estimation result. The bandwidth of the underwater acoustic transmitting transducer is divided into B 1 and B 2 Two sub-bands, B 1 The subband is used for the master node to transmit information to the monitored node, while the B 2 The sub-band is used for the monitored node to transmit information to the master node to realize full-duplex communication function. The master node can send control information to multiple nodes at the same time or send response signals to a single node at any time, and the monitored node needs to compete for the frequency band resources to successfully send information to the master node. The telemetry and remote control terminal is the interface for users to control and query the status of the bionic robot fish. The telemetry and remote control terminal is used for: monitoring node ID setting and query; bionic robot fish addition and deletion; bionic robot fish cluster control; bionic robot fish cluster status query; alarm generation, management and query; master node and monitored node software upgrade and modulation.
[0060] like Figure 2 As shown, the hardware of the master control node mainly consists of C6748 DSP and its peripheral circuits, power amplifier, preamplifier, B 2The wireless transceiver receives the user's instructions from the telemetry and remote control terminal and transmits the instructions to the DSP through the RS232 serial port. The DSP completes the LDPC encoding, channel interleaving and FH-4FSK modulation of the transmitted data, and the modulated signal is frequency-shifted to B 1 The sub-band is output to the power amplifier through the D / A converter. The output of the power amplifier excites the underwater acoustic emission transducer to emit sound waves. The hydrophone receives the acoustic signal from the monitored node and converts it into an electrical signal. The electrical signal is amplified and B 2 After sub-band bandpass filtering, it is input to DSP through A / D converter. DSP completes the synchronization, delay-Doppler joint estimation, Doppler compensation, channel matching, FH-4FSK demodulation, channel deinterleaving and LDPC decoding of underwater acoustic signals, and transmits the obtained data to the wireless transceiver through RS232 serial port. The wireless transceiver sends it to the remote control and telemetry terminal through wireless communication.
[0061] like Figure 3 As shown in FIG. 1 , the hardware of the monitored node mainly consists of C6748 DSP and its peripheral circuits, power amplifier, preamplifier, B 1 The sub-band bandpass filter, A / D converter and D / A converter, underwater acoustic emission transducer and hydrophone are composed; the hydrophone receives the acoustic signal from the main control node and converts it into an electrical signal, which is amplified and 1 After sub-band bandpass filtering, the sub-band bandpass filter is input to the DSP through the A / D converter. The DSP completes the synchronization, delay-Doppler joint estimation, Doppler compensation, channel matching, FH-4FSK demodulation, channel deinterleaving and LDPC decoding of the underwater acoustic signal, and transmits the obtained data to the host of the bionic robot fish through the RS232 serial port; the DSP obtains the bionic robot fish status information data through the RS232 serial port, and performs LDPC encoding, channel interleaving and FH-4FSK modulation on the data. The modulated signal is frequency-shifted to B 2 The sub-band is output to the power amplifier through the D / A converter, and the power amplifier output excites the underwater acoustic emission transducer to emit sound waves.
[0062] like Figure 4 As shown, the hardware of the telemetry and remote control terminal is composed of a personal computer (PC) and a wireless transceiver, and the PC and the wireless transceiver communicate via RS232 serial port; the PC interface software receives user command input and transmits it to the wireless transceiver via the RS232 serial port, and the wireless transceiver sends it to the main control node via wireless communication; the wireless transceiver receives the robot fish status information reported by the main control node, and sends the received status information to the PC interface software via the RS232 serial port, and the PC interface software completes the update of the corresponding robot fish status information.
[0063] The DSP of the monitored node periodically queries the status information of the bionic robot fish through the serial port, including the movement status, the water depth of the location and the remaining power ratio, and performs source coding and framing on the status information. The frame format is as follows:
[0064] ID <![CDATA[Z 1 ]]> <![CDATA[Z 2 ]]> <![CDATA[Z 2 ]]> CRC
[0065] Among them, ID is the ID of the monitored node; Z 1 , Z 2 and Z 3 The codes for the motion state, water depth and remaining power percentage of the bionic robot fish are respectively represented; CRC is a cyclic redundancy check. ID, Z 1 , Z 2 , Z 3 The length of the CRC is 8 bits, and the total frame length is 40 bits.
[0066] The DSP of the monitored node reports the status information of the bionic robot fish to the main control node at a period T. After receiving the information of the monitored node, the main control node immediately returns a response signal. The format of the response signal is as follows:
[0067] ID OK CRC
[0068] Among them, OK means successful reception, its length is 8 bits, set to 0xAA. If the monitored node receives the response signal returned by the master node, it will continue to report the status information of the bionic robot fish to the master node at a period of T. If the response signal is not received within a certain time range, it will report again after a random delay of 10ms. The average time of random delay increases with the number of times the response signal is not received. To ensure the high reliability of system information transmission, whether the master node transmits information to the monitored node or the monitored node transmits information to the master node, the robust FH-4FSK underwater acoustic communication method is adopted. The difference is that the former uses the B of the underwater acoustic transmitting transducer. 1 subband, while the latter uses B 2 subband, and B 1 Subband and B 2 The sub-bands do not overlap.
[0069] The telemetry and remote control terminal receives the input of user control commands through the interface software, and issues control commands to the monitored bionic robot fish at regular or irregular times (through user-controlled buttons). The telemetry and remote control terminal completes the source encoding and framing of the user control commands, and sends the framed data to the master control node through the wireless transceiver. The format of the data frame is as follows:
[0070] 0x01 <![CDATA[C 1 ]]> 0x02 <![CDATA[C 2 ]]> 0x03 <![CDATA[C 3 ]]> 0x04 <![CDATA[C 4 ]]> 0x05 <![CDATA[C 5 ]]> CRC
[0071] Among them, 0x01, 0x02, 0x03, 0x04 and 0x05 correspond to the IDs of 5 different bionic robot fish respectively. 1 , C 2 , C 3 , C 4 and C 5 The control words corresponding to the ID numbers 0x01, 0x02, 0x03, 0x04 and 0x05 of the bionic robot fish, C 1 , C 2 , C 3 , C 4 and C 5 The length of is 8 bits. The master control node receives data from the telemetry and remote control terminal through a wireless transceiver, and sends the received data to the monitored node through FH-4FSK underwater acoustic communication. The monitored node parses the received data and transmits the correct instructions to the host of the bionic robot fish through the serial port. The host of the bionic robot fish completes the final control of the bionic robot fish. Under normal working conditions, the telemetry and remote control terminal receives the bionic robot fish status information reported by each monitored node at a period T. If the bionic robot fish status information reported by a monitored node is not received for more than 5T, an alarm message is generated to prompt the user that the bionic robot fish has failed or lost connection, and the corresponding bionic robot fish icon is marked in red; if the status information reported by the faulty bionic robot fish is received again, an alarm release message is generated, and the corresponding bionic robot fish icon is marked in blue again.
[0072] The transmission process of FH-4FSK underwater acoustic communication in the master node and the monitored node is basically the same, including LDPC coding, channel interleaving, 4FSK modulation, frequency hopping, frequency shifting and detection signal insertion. Figure 5 As shown, the difference is that the master node shifts frequency to B 1 subband, and the monitored node shifts frequency to B 2 Sub-band. The detection signal is used for signal synchronization and delay-Doppler joint estimation. A 20ms linear frequency modulation signal is used. A 20ms protection interval is inserted between the linear frequency modulation signal and the FH-4FSK modulation signal to eliminate or alleviate the interference caused by the channel multipath effect. The transmission signal is converted by D / A and amplified to excite the underwater acoustic transducer to transmit sound waves.
[0073] The receiving and processing procedures of FH-4FSK underwater acoustic communication in the master node and the monitored node are as follows: Figure 6 As shown, the difference between the two is that the frequency band ranges corresponding to the bandpass filters are different. The former corresponds to the frequency band B 2 subband, while the latter corresponds to B 1The hydrophone converts the acoustic signal into an electrical signal, which is amplified and band-pass filtered before entering the DSP through A / D conversion. The DSP of the master node (or monitored node) uses a matched filtering method to detect whether a synchronization signal has arrived. If so, it first performs a rough Doppler estimation and a rough length estimation, and then performs a delay-Doppler joint estimation. The estimation formula is:
[0074]
[0075] Among them, α is a constant less than 1, P and Y are the Fourier transforms of the detection signal transmission and reception sequences, respectively, and ||u|| and ||u|| 1 They represent the l of u respectively. 2 and l 1 norm, u is the Fourier transform of the impulse response of the underwater acoustic channel, and its element u(i) is expressed as:
[0076]
[0077] Among them, h(n,m) (n=0,1,…,N-1,m=0,1,…,M-1) is the impulse response of the underwater acoustic channel.
[0078] The DSP of the master node (or monitored node) performs Doppler compensation and channel matching on the received signal according to the delay-Doppler joint estimation result. Assuming that the received signal after Doppler compensation is r(t), the received signal is:
[0079] r(t)=x(t)*h(t) (3)
[0080] The symbol “*” represents linear convolution; x(t) and h(t) are the transmitted signal and the underwater acoustic channel impulse response, respectively. Let the detection signal be p(t) and its corresponding received signal be p′(t), then:
[0081] p′(t)=p(t)*h(t) (4)
[0082] From equations (3) and (4), we can get:
[0083]
[0084] By windowing, discretizing and Fourier transforming equation (5), we get:
[0085]
[0086] Where w(n) is a rectangular window; N = T 1 F s , T 1 and F sare symbol period and sampling frequency respectively; I is the number of symbols in a frame signal. The value b of the two bits corresponding to the i-th symbol can be obtained by equation (6): i0 and b i1 , these bit values are input into the LDPC decoder to decode and output the received data frame.
[0087] The DSP program of the master control node consists of five functional modules: main program, serial port interrupt program, timer interrupt program, task 1 and task 2. Figure 7 As shown. The main program mainly completes peripheral initialization, interrupt initialization, task initialization and SYS / BIOS startup; the serial port interrupt program reads the serial port data into the serial port cache and clears possible serial port errors; the timer interrupt program reads the A / D data at a regular interval according to the sampling frequency, and transfers the data to be sent in the D / A cache to the D / A converter. Subtask 1 processes the serial port cache data. First, it determines whether there is data in the serial port cache. If so, it then determines whether the CRC check in a frame of data is correct. If it is correct, it starts the FH-4FSK underwater acoustic communication modulation process, including LDPC coding, channel interleaving, 4FSK modulation, frequency hopping and frequency shift to B 1 Sub-band and other operations, and write the generated transmission signal data into the D / A buffer; if there is no serial port data, the task sleeps for 10ms and then continues to detect whether there is serial port data. If there is serial port data but the CRC check is incorrect, it will continue to process the next frame of data until the serial port buffer is empty. Sub-task 2 processes the A / D buffer data. First, it determines whether there is data in the A / D buffer. If there is synchronization, it will first perform delay-Doppler joint estimation, and perform Doppler compensation and channel matching on the received signal based on the estimation results. Then, the received signal is demodulated by FH-4FSK, channel deinterleaved and LDPC decoded. Finally, it determines whether the received data frame is correct based on the CRC check. If it is correct, the received data frame is forwarded to the telemetry and remote control terminal through the wireless transceiver, and a response signal is returned to the monitored node; if there is no A / D data, it sleeps for 10ms and returns to detect whether there is A / D data. If there is A / D data but no synchronization, it will continue to read the A / D buffer data until the A / D buffer is empty.
[0088] The DSP program of the monitored node consists of five functional modules: main program, serial port interrupt program, timer interrupt program, task 1 and task 2. The main program, serial port terminal program and timer interrupt program are the same as those of the master control node. The program flow chart of task 1 and task 2 is as follows: Figure 8As shown. Task 1 processes serial port buffer data, and its function is roughly the same as Task 1 in the master control node. The difference is that the process of reading and writing the bionic robot fish ID is added. After detecting that the serial port data CRC is correct, it first determines whether to read or write the bionic robot fish ID. If so, the corresponding process is executed, otherwise the same process as Task 1 in the master control node is executed; Task 2 processes A / D buffer data, and its main function is roughly the same as Task 2 of the master control program, that is, completing the FH-4FSK underwater acoustic communication receiving processing process. The difference is that if the received data frame is correct, it is forwarded to the control host of the bionic robot fish instead of forwarding it to the remote control telemetry terminal, and there is no need to return a response signal.
[0089] The remote control and telemetry terminal program is divided into two functional modules: the interface program and the serial port processing thread. The interface program receives the input of user commands and displays the status of the bionic robot fish; the serial port processing thread program flow chart is as follows: Fig. 9 The serial port processing thread first detects whether there is data in the serial port buffer. If so, it further determines whether the CRC of the received data frame is correct. If it is correct, it decodes the status information and updates the status of the corresponding bionic robot fish. If there is no serial port data, it detects whether the bionic robot fish control button is pressed. If it is pressed, it reads the control information of the bionic robot fish, performs source encoding and framing, and finally outputs the data frame to the wireless transceiver through the serial port, and the wireless transceiver sends it to the master control node.
Claims
1. A bionic robotic fish cluster underwater acoustic telemetry and remote control system, characterized in that It consists of a master control node, monitored nodes and telemetry and remote control terminals, and adopts a master-slave working mode; The master control node is a host, which only includes one node, while the monitored node is a slave, which includes two or more nodes; the master control node and the telemetry and remote control terminal exchange information through a wireless transceiver, which is used for issuing user instructions and forwarding the running status of the bionic robotic fish; the master control node and the monitored node use an underwater acoustic communication method to exchange information, and the underwater acoustic communication and network protocol are all implemented in a high-performance DSP; the master control node and the monitored node of the bionic robotic fish cluster underwater acoustic telemetry and remote control system use a full-duplex underwater acoustic communication method to ensure real-time and robust monitoring of the bionic robotic fish; the master control node uses the B1 subband of the underwater acoustic transducer to transmit information to the monitored node, and the monitored node uses the B2 subband of the underwater acoustic transducer to transmit information to the master control node. The master control node sends information to the monitored node at any time, and the monitored node sends information to the master control node after obtaining the frequency band resources through competition; the master control node and the monitored node achieve precise clock synchronization through synchronous clocks; The hardware system of the master control node includes a wireless transceiver, a synchronous clock, a DSP and its peripheral circuits, a power amplifier circuit, a preamplifier circuit, a bandpass filter circuit, a power conversion circuit, an underwater acoustic emission transducer and a hydrophone; the wireless transceiver receives instructions from the telemetry and remote control terminal, and transmits the instructions to the DSP through the RS232 serial port, the DSP completes the modulation of the data, and outputs the signal to the power amplifier circuit through the D / A converter, and the electrical signal output after power amplification excites the underwater acoustic emission transducer to emit sound waves; the hydrophone receives the sound signal from the monitored node and converts it into an electrical signal, the electrical signal is amplified and filtered, and is input to the DSP through the A / D converter, the DSP completes the demodulation of the signal, and transmits the demodulated data to the wireless transceiver through the RS232 serial port, and the wireless transceiver sends the data to the telemetry and remote control terminal; The hardware system of the telemetry and remote control terminal includes a wireless transceiver and a computer PC; the PC and the wireless transceiver are connected by RS232 serial port communication; the PC interface software receives user instructions and transmits the instructions to the wireless transceiver through the RS232 serial port; the wireless transceiver uses wireless communication to exchange information with the main control node.
2. A bionic robotic fish cluster underwater acoustic telemetry and remote control system as claimed in claim 1, characterized in that The hardware system of the monitored node includes a synchronous clock, a DSP and its peripheral circuits, a power amplifier circuit, a preamplifier circuit, a bandpass filter circuit, a power conversion circuit, an underwater acoustic emission transducer and a hydrophone; the hydrophone receives the sound signal from the main control node and converts it into an electrical signal, the electrical signal is amplified and filtered, and then input to the DSP through an A / D converter, the DSP completes the demodulation of the signal, and sends the demodulated data to the bionic robot fish through an RS232 serial port; the DSP reads the status information of the bionic robot fish through the RS232 serial port, encodes and modulates it, and the modulated signal is output to the power amplifier circuit through a D / A converter, and the electrical signal output after power amplification excites the underwater acoustic emission transducer to emit sound waves.
3. A method for underwater acoustic telemetry and remote control of a bionic robotic fish cluster, characterized in that Using the bionic robotic fish cluster underwater acoustic telemetry and remote control system as claimed in claim 1, the method specifically comprises the following steps: 1) The telemetry and remote control terminal sets the ID of the monitored node through the serial port, and the ID of different monitored nodes is set to different values; 2) The monitored node collects the status information of the bionic robot fish, performs source coding, generates a bionic robot fish status word, and forms a data frame; 3) The DSP of the monitored node performs channel coding, channel interleaving and FH-MFSK modulation on the data frame obtained in step 2), and inserts a detection signal before and after each frame signal, and inserts a protection interval between the detection signal and the modulated signal; 4) The DSP of the monitored node shifts the signal obtained in step 3) to the B2 subband, and outputs an electrical signal through a D / A converter at a period T to drive the power amplifier to stimulate the underwater acoustic transducer to emit sound waves; 5) The hydrophone of the master node receives the acoustic signal from the monitored node and converts it into an electrical signal, which enters the DSP of the master node through an A / D converter after preamplification and B2 sub-band filtering; 6) The DSP of the master control node uses the matched filtering method to determine whether a synchronization signal has arrived. If so, it first performs coarse Doppler estimation and compensation, and then performs underwater acoustic channel delay-Doppler joint estimation to obtain the impulse response and Doppler frequency deviation of the underwater acoustic channel; 7) The DSP of the master control node performs Doppler compensation and channel matching processing on the received signal according to the Doppler frequency deviation and the impulse response of the underwater acoustic channel obtained in step 6); 8) The DSP of the master control node performs FH-MFSK demodulation on the signal processed in step 7), and performs channel deinterleaving and channel decoding to generate a received data frame; 9) The DSP of the master control node determines whether the CRC of the received data frame obtained in step 8) is correct. If it is correct, it forwards it to the telemetry and remote control terminal through the wireless transceiver, and returns a response signal to the corresponding monitored node through the B1 subband of the underwater acoustic transducer; 10) If the monitored node receives a response signal from the master control node, it will continue to report the status information of the bionic robot fish to the master control node at a period T; if it does not receive a response signal from the master control node within a certain time range, it will report the status information of the bionic robot fish to the master control node again after a random delay of one time unit in units of 10ms; 11) The telemetry and remote control terminal receives data from the master control node through a wireless transceiver, updates the status information of the corresponding bionic robotic fish, and marks the icon corresponding to the bionic robotic fish in blue. If the status information of a bionic robotic fish is not received for a certain period of time, an alarm message is generated, and the icon corresponding to the bionic robotic fish is marked in red; 12) The telemetry and remote control terminal generates a control data frame according to the user input command; 13) The telemetry and remote control terminal sends the control data frame obtained in step 12) to the master control node via a wireless transceiver; 14) The DSP of the master control node receives data from the monitoring terminal through the wireless transceiver, and performs channel coding, channel interleaving and FH-MFSK modulation on the data, and inserts a detection signal before and after each frame signal, and inserts a protection interval between the detection signal and the modulation signal; 15) The DSP of the master control node shifts the frequency of the signal obtained in step 14) to the B1 subband, and outputs an electrical signal through a D / A converter to drive the power amplifier to stimulate the underwater acoustic transducer to emit sound waves; 16) The hydrophone of the monitored node receives the acoustic signal and converts it into an electrical signal, which enters the DSP of the monitored node through an A / D converter after amplification and B1 sub-band filtering; 17) The DSP of the monitored node adopts the same method as steps 6-8) to perform delay-Doppler joint estimation, Doppler compensation, channel matching, FH-MFSK demodulation, channel deinterleaving and channel decoding on the received signal, and generates a received data frame; 18) The DSP of the monitored node determines whether the CRC of the received data frame obtained in step 17) is correct. If it is correct, it matches its ID with the ID in the received data frame and extracts the corresponding control word; 19) The DSP of the monitored node decodes the control word obtained in step 18) and sends the obtained control command to the control host of the bionic robotic fish through the serial port.
4. A method for underwater acoustic telemetry and remote control of a bionic robotic fish cluster as claimed in claim 3, characterized in that In step 2), the state information of the bionic robotic fish includes the motion state of the bionic robotic fish, the sea depth at which the robot is located, and the remaining battery capacity ratio; the data frame may be constructed in the following format: Among them, ID is the ID of the monitored node, and CRC is the cyclic redundancy check code.
5. A method for underwater acoustic telemetry and remote control of a bionic robotic fish cluster as claimed in claim 3, characterized in that In step 6), the underwater acoustic channel delay-Doppler joint estimation is performed according to formula (1): Among them, α is a constant less than 1, P and Y are the Fourier transforms of the detection signal transmission and reception sequences, respectively, ||u|| and ||u||1 represent the l2 and l1 norms of u, respectively, u is the Fourier transform of the underwater acoustic channel impulse response, and its element u(i) is expressed as: Among them, h(n,m) (n=0,1,...,N-1,m=0,1,...,M-1) is the impulse response of the underwater acoustic channel.
6. A method for underwater acoustic telemetry and remote control of a bionic robotic fish cluster as claimed in claim 3, characterized in that In step 9), the response signal is returned to the corresponding monitored node by using FH-MFSK hydroacoustic modulation to return the response signal to the corresponding monitored node. The corresponding format is: 。 7. A method for underwater acoustic telemetry and remote control of a bionic robotic fish cluster as claimed in claim 3, characterized in that In step 12), the telemetry and remote control terminal generates a control data frame in the following format according to the user input command: The control word is the source code of the bionic robotic fish control command, and the control words belonging to different bionic robotic fish in the same data frame may be the same or different.
Citation Information
Patent Citations
Cooperative control method of bionic fish for large-range water monitoring
CN104950884A
Full-duplex underwater acoustic digital voice communication system and method
CN112291020A
