A method and system for controlling the depth of an underwater robot

By acquiring and analyzing the depth, force control device and water flow velocity data of the underwater robot, and determining the speed prediction and mapping control parameters, the problem of inaccurate depth control in the underwater environment is solved, and more accurate depth control and safety are achieved .

CN118795910BActive Publication Date: 2024-11-15北京世航智能科技有限公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411274158.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-12
Publication Date
2024-11-15
Estimated Expiration
2044-09-12

AI Technical Summary

Technical Problem

In complex underwater environments, it is difficult for the prior art to accurately predict and compensate for interference from changes in water flow velocity, resulting in insufficient fixed depth control of underwater robots, affecting their working performance and safety.

Method used

By obtaining the depth timing data of the underwater robot, the rotation speed timing data of the force control device and the target flow rate timing data of the water flow target flow rate, analyzing the consistency between the target flow rate and the depth changes, determining the speed prediction control parameters and mapping control parameters of the force control device, and combining multiple The parameters are PID-controlled to ensure depth stability.

Benefits of technology

It realizes more accurate depth control of underwater robots in complex underwater environments, can be dynamically adjusted to adapt to changes in water flow velocity, and improves the accuracy and safety of fixed-depth control.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118795910B_ABST
    Figure CN118795910B_ABST
Patent Text Reader

Abstract

The present invention relates to the technical field of underwater robot depth control, and specifically to a method and system for controlling the depth of an underwater robot. The depth time series data of the underwater robot, the rotation speed time series data of a force control device, and the target flow rate time series data in the vertical direction are obtained. The fluctuation of the target flow rate value and the fluctuation characteristics between the target flow rate time series data and the depth time series data are analyzed to obtain the rotation speed mapping control parameters and the rotation speed prediction control parameters. The rotation speed prediction value is obtained by combining the rotation speed value at the current moment and the target flow rate value. Based on the error between the rotation speed prediction value and the current rotation speed value, the depth of the underwater robot is PID controlled. Since the rotation speed prediction value takes into account the influence of the water flow velocity, the depth of the underwater robot can be accurately and dynamically adjusted when performing PID control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of underwater robot depth control, and in particular to a depth control method and system for an underwater robot. Background Art

[0002] In the fields of marine engineering, marine science research and underwater rescue, underwater robots are increasingly used. Among them, depth control is a crucial part of underwater robot technology, which directly affects whether underwater robots can perform various tasks stably and accurately.

[0003] In the process of controlling the depth of an underwater robot, the existing technology usually controls the depth of the underwater robot based on the deviation between a preset depth value and the current depth value of the underwater robot. However, due to the complex and changeable underwater environment, especially the randomness and irregularity of the water flow velocity change, the water flow velocity will have a component in the vertical direction, and the underwater robot will be subjected to additional force generated by the water flow in the vertical direction. Therefore, when controlling the depth of the underwater robot under the action of the water flow, the deviation between the current depth value and the preset depth value cannot accurately predict and compensate for the interference caused by the randomness of the water flow velocity change, which will cause the underwater robot's depth control to be inaccurate, seriously affecting its working performance and safety. Summary of the invention

[0004] In order to solve the technical problem that in a complex underwater environment, the deviation between the current depth value and the preset depth value cannot be accurately predicted and compensated for the interference caused by the randomness of the water flow velocity change, which will lead to inaccurate depth control of the underwater robot and seriously affect its working performance and safety, the purpose of the present invention is to provide a depth control method and system for an underwater robot, and the technical solutions adopted are as follows:

[0005] Acquire the depth time series data of the underwater robot and the speed time series data of the force control device; acquire the target flow velocity time series data of the water flow in the vertical direction at the location of the underwater robot;

[0006] Based on the numerical characteristics of the target flow rate value at the current moment and the data fluctuations in the local range, the speed prediction control parameters of the force control device at the next moment are obtained; the consistency of data changes between the target flow rate time series data and the depth time series data is analyzed to determine the speed mapping control parameters of the force control device at the current moment;

[0007] According to the speed mapping control parameters, speed prediction control parameters, the speed value at the current moment and the target flow rate value corresponding to the force control device, the speed prediction value of the force control device at the next moment is obtained; and the depth of the underwater robot is controlled based on the speed prediction value.

[0008] Furthermore, the method for acquiring the target flow rate time series data includes:

[0009] Obtaining time series data of the initial flow velocity of the water flow in the vertical direction at the location of the underwater robot;

[0010] Determining an adaptive smoothing window corresponding to each moment based on changes in the initial flow velocity value in the initial flow velocity time series data;

[0011] In the adaptive smoothing window corresponding to each moment, the initial flow velocity value is smoothed based on the mean filtering algorithm to obtain the target flow velocity time series data corresponding to the initial flow velocity time series data.

[0012] Furthermore, the method for obtaining the adaptive smoothing window includes:

[0013] Determine a preset neighborhood corresponding to each moment, and within the preset neighborhood corresponding to each moment, determine a local change degree value corresponding to each moment based on the change fluctuation of the initial flow velocity value in the initial flow velocity time series data;

[0014] In the initial flow velocity time series data, based on the distribution of extreme value points, determining the overall stability value of the initial flow velocity time series data;

[0015] According to the overall stability value and the local change value corresponding to each moment, the preset window length is adjusted to determine the adaptive smoothing window corresponding to each moment, and the overall stability value and the local change value are positively correlated with the length of the adaptive smoothing window.

[0016] Furthermore, the method for obtaining the overall stability value includes:

[0017] Segmenting the initial flow velocity time series data based on the extreme value points to obtain all flow velocity data segments;

[0018] The value after the segment lengths of all flow velocity data segments are averaged is used as the overall stability value.

[0019] Furthermore, the method for obtaining the speed prediction control parameter includes:

[0020] In the target flow rate time series data, the extreme point with the smallest time interval distance from the current moment is taken as the discontinuity point, and the target flow rate value between the discontinuity point and the current moment is formed into a target data segment;

[0021] In the target data segment, the absolute value of the difference between the maximum target flow rate value and the minimum target flow rate value is used as the flow rate change value; the ratio of the flow rate change value to the target data segment length is used as the control factor;

[0022] Based on the regulation factor and the absolute value of the target flow rate value at the current moment, the speed prediction control parameter of the force control device at the next moment is determined, and the regulation factor and the absolute value of the target flow rate value at the current moment are positively correlated with the speed prediction control parameter.

[0023] Furthermore, the method for acquiring the speed mapping control parameter includes:

[0024] Calculating the DTW distance between the target flow rate time series data and the depth time series data;

[0025] The value after negative correlation mapping and normalization processing of the DTW distance is used as the rotation speed mapping control parameter of the force control device at the current moment.

[0026] Furthermore, when the direction of the water flow velocity at the position where the underwater robot is located is vertically upward, the target flow velocity value is a positive number, and when the direction of the water flow velocity at the position where the underwater robot is located is vertically downward, the target flow velocity value is a negative number.

[0027] Furthermore, the method for obtaining the rotational speed prediction value includes:

[0028] When the target flow rate value at the current moment in the target flow rate time series data is a positive number, the value after negative correlation mapping of the product of the speed mapping control parameter and the speed prediction control parameter is used as the adjustment parameter, and the product of the adjustment parameter and the speed value of the force control device at the current moment is used as the speed prediction value;

[0029] When the target flow rate value at the current moment in the target flow rate time series data is negative, the product of the speed mapping control parameter and the speed prediction control parameter is numerically adjusted and used as the adjustment parameter, and the product of the adjustment parameter and the speed value of the force control device at the current moment is used as the speed prediction value.

[0030] Further, the controlling the depth of the underwater robot based on the rotation speed prediction value comprises:

[0031] Calculating the difference between the speed prediction value and the speed value of the force control device at the current moment as an error factor;

[0032] The error factor is used as the input of the PID controller, and the rotation speed of the force control device is adjusted based on the initial proportional coefficient, the initial integral coefficient and the initial differential coefficient, so as to perform PID control on the depth of the underwater robot.

[0033] The present invention also proposes a depth control system for an underwater robot, the system comprising:

[0034] A memory, a processor, and a computer program stored in the memory and executable on the processor. When the processor executes the computer program, any step of the depth control method for the underwater robot can be implemented.

[0035] The present invention has the following beneficial effects:

[0036] First, the depth time series data of the underwater robot and the speed time series data of the force control device are obtained. Due to the complex underwater environment, the water flow velocity will affect the depth control of the underwater robot, so the target flow velocity time series data of the water flow in the vertical direction at the location of the underwater robot is obtained at the same time. When the water flow velocity changes, in order to ensure the depth stability of the underwater robot, the speed of the force control device also needs to be changed. Therefore, the fluctuation of the target flow velocity value in the target flow velocity time series data can be analyzed to determine the speed prediction control parameters that the force control device should have at the next moment, so that the speed of the force control device can respond to the change of the water flow velocity more accurately; at the same time, since the change of the water flow velocity is closely related to the depth change of the underwater robot, the change between the target flow velocity time series data and the depth time series data can be matched, so as to ensure that the speed of the force control device matches the depth change of the underwater robot, and obtain the speed mapping control parameters of the force control device at the current moment. Finally, multiple parameters can be integrated, namely based on the speed mapping control parameters, the speed prediction control parameters, the speed value at the current moment and the target flow rate value, to obtain the speed prediction value of the force control device at the next moment, and control the depth of the underwater robot based on the speed prediction value. At this time, since the speed prediction value takes into account the influence of the water flow velocity on the depth positioning of the underwater robot, when the depth of the underwater robot is controlled, the speed can be more accurately approached to the predicted value, thereby accurately and dynamically adjusting the depth of the underwater robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0037] In order to more clearly illustrate the technical solutions and advantages in the embodiments of the present invention or the prior art, the drawings required for use in the embodiments or the prior art descriptions are briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0038] Figure 1 A method flow chart of a depth control method for an underwater robot provided by an embodiment of the present invention;

[0039] Figure 2 A schematic structural diagram of a force control device for an underwater robot provided by one embodiment of the present invention;

[0040] Figure 3A method flow chart of a method for acquiring target flow rate time series data provided by one embodiment of the present invention;

[0041] Figure 4 A system block diagram of a depth control system for an underwater robot provided by an embodiment of the present invention;

[0042] Figure 5 A schematic diagram of the system structure of a depth control system of an underwater robot provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0043] In order to further explain the technical means and effects adopted by the present invention to achieve the predetermined invention purpose, the following is a detailed description of the depth control method and system of an underwater robot proposed by the present invention, its specific implementation, structure, features and effects, in combination with the accompanying drawings and preferred embodiments. In the following description, different "one embodiment" or "another embodiment" does not necessarily refer to the same embodiment. In addition, specific features, structures or characteristics in one or more embodiments may be combined in any suitable form.

[0044] Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs.

[0045] The specific scheme of the depth control method and system of an underwater robot provided by the present invention is described in detail below with reference to the accompanying drawings.

[0046] See also Figure 1 , which shows a method flow chart of a depth control method of an underwater robot provided by an embodiment of the present invention, the method comprising the following steps:

[0047] Step S1: Acquire the depth time series data of the underwater robot and the rotation speed time series data of the force control device; acquire the target flow velocity time series data of the water flow in the vertical direction at the position of the underwater robot.

[0048] An underwater robot is an autonomous or remote-controlled device used to perform various tasks underwater. In order to accurately complete underwater work tasks without being affected by the underwater environment on its depth, an underwater robot depth control system is required to adaptively adjust the force it is subjected to according to the underwater environment to achieve the purpose of depth determination, thereby ensuring the accuracy of the task and the safety of the equipment.

[0049] Due to the complexity and changeability of the underwater environment, changes in water flow velocity will affect the adjustment feedback of the underwater robot during depth control. Therefore, in order to obtain a more accurate depth control effect, it is necessary to conduct a comprehensive analysis of the underwater water flow velocity and the depth data of the underwater robot. At the same time, the force control device usually provides an additional force to the underwater robot by adjusting its own rotation speed to offset the force exerted by the water flow velocity on the underwater robot, thereby achieving control of the depth of the underwater robot. Therefore, in an embodiment of the present invention, within a preset time period, the depth time series data of the underwater robot is obtained based on the sonar sensor, and the speed time series data of the force control device is obtained based on the speed sensor installed on the force control device. At the same time, since the flow velocity of the water flow in the vertical direction at the position of the underwater robot has a greater influence on the depth control of the underwater robot, the initial flow velocity time series data of the water flow in the vertical direction at the position of the underwater robot is obtained based on the flow velocity sensor installed at a suitable position of the underwater robot. For the initial flow velocity value in the initial flow velocity time series data, since it represents the water flow velocity in the vertical direction at the position of the underwater robot, and the water flow velocity is a vector with value and direction, in an embodiment of the present invention, the vertical upward direction is used as the standard direction, that is, when the water flow velocity direction is vertically upward, the flow velocity value is a positive number, conversely, when the water flow velocity direction is vertically downward, the flow velocity value is a negative number, and when the water flow is still, the flow velocity value is 0.

[0050] It should be noted that the duration of the acquired time series data is set to 30 minutes in this embodiment of the present invention, and the time interval for data collection is set to 1s. The duration of the specific time period and the time interval for data collection can be adjusted according to the implementation scenario, and are not limited here. At this time, each moment has three data values: depth value, initial flow velocity value and rotation speed value; the collection device of depth time series data, rotation speed time series data and initial flow velocity time series data can also be adjusted according to the implementation scenario, and are not limited here.

[0051] When the underwater robot is stationary, the water flow velocity in the vertical direction can be directly obtained through the flow sensor, or the comprehensive speed of the underwater water flow can be obtained, and then decomposed to obtain the water flow velocity in the vertical direction. The specific acquisition method is not limited here; when the underwater robot is in the process of moving, the initial flow velocity value obtained by the flow sensor should be the relative speed between the water flow and the robot. The movement speed of the underwater robot itself can be obtained according to the speed sensor in the underwater robot, and then decomposed in the vertical and horizontal directions to obtain the movement speed component of the underwater robot in the vertical direction. Similarly, when the direction of the movement speed component is vertically upward, the value is positive, and when the direction of the movement speed component is vertically downward, the value is negative. Therefore, the target flow velocity value in the initial flow velocity time series data at this time should be calculated based on the flow velocity value in the vertical direction measured by the flow sensor and the movement speed component of the underwater robot's own movement speed in the vertical direction. The specific calculation process includes: when the velocity component of the underwater robot's movement speed in the vertical direction is vertically upward, and the direction of the water flow speed is also vertically upward, the initial flow velocity value of the water flow measured at this time is the flow velocity value in the vertical direction measured by the flow velocity sensor plus the velocity component of the robot's movement speed in the vertical direction; when the velocity component of the underwater robot's movement speed in the vertical direction is vertically upward, and the direction of the water flow speed is vertically downward, the initial flow velocity value of the water flow measured at this time is the velocity component of the robot's movement speed in the vertical direction plus the velocity component of the robot's movement speed in the vertical direction measured by the flow velocity sensor. flow velocity value; when the velocity component of the underwater robot's movement speed in the vertical direction is vertically downward, and the direction of the water flow velocity is also vertically downward, the initial flow velocity value of the water flow measured at this time is the flow velocity value in the vertical direction measured by the flow velocity sensor plus the velocity component of the robot's movement speed in the vertical direction; when the velocity component of the underwater robot's movement speed in the vertical direction is vertically downward, and the direction of the water flow velocity is vertically upward, the initial flow velocity value of the water flow measured at this time is the velocity component of the robot's movement speed in the vertical direction plus the flow velocity value in the vertical direction measured by the flow velocity sensor.

[0052] In the embodiment of the present invention, the force control device can be a propeller, etc. When the speed of the propeller increases, it can provide an upward force for the underwater robot. Conversely, when the speed of the propeller decreases, the upward force provided will also decrease. Figure 2 , which shows a schematic structural diagram of a force control device in an embodiment of the present invention, including a blade surface 1, a base 2 and a driving mechanism 3.

[0053] During the operation of the underwater robot, the water flow velocity will not only be affected by natural factors (wind, tide, etc.), but also the posture change of the underwater robot will cause the magnitude and direction of the water flow velocity to change. Therefore, the magnitude of the water flow velocity in the vertical direction will produce accidental fluctuations under the joint action of multiple factors. However, since the movement of the underwater robot has a certain inertia, the short-term water flow change at this time will not cause the change of the depth of the underwater robot. Therefore, if the instantaneous change of the water flow velocity is not processed, and the depth of the underwater robot is directly controlled according to the water flow velocity, it may lead to a decrease in control accuracy. Therefore, the initial flow velocity time series data of the water flow in the vertical direction at the location of the underwater robot can be smoothed to reduce the noise and accidental changes in the data, and obtain the target flow velocity time series data, which is used to reduce the impact of the sudden change of the water flow velocity in the initial flow velocity time series data.

[0054] Preferably, in one embodiment of the present invention, the method for acquiring target flow rate time series data includes:

[0055] Since the initial flow velocity data exhibits different change characteristics at different times, the flow velocity changes relatively smoothly in some time periods, while sudden changes occur in a few time periods. Therefore, in order to obtain more accurate smoothing results, the adaptive smoothing window corresponding to each moment can be determined based on the change of the initial flow velocity value in the initial flow velocity time series data, and the initial flow velocity time series data can be smoothed within the adaptive smoothing window to meet different smoothing processing requirements.

[0056] See also Figure 3 , which shows a method flow chart of a method for acquiring target flow rate time series data in one embodiment of the present invention, the method comprising the following steps:

[0057] Step S101: Determine a preset neighborhood corresponding to each moment, and within the preset neighborhood corresponding to each moment, determine a local change degree value corresponding to each moment based on the change fluctuation of the initial flow velocity value in the initial flow velocity time series data.

[0058] Since in the embodiment of the present invention, the local mutation of the initial flow velocity value is mainly analyzed, the change of the initial flow velocity value in the initial flow velocity time series data can first be analyzed from the local data sensitivity.

[0059] Since the slope between data values ​​can more intuitively characterize the change trend of data, the data curve corresponding to the flow velocity time series data can be obtained, and then the slope value corresponding to each moment can be obtained, and the preset neighborhood corresponding to each moment can be determined. Then, within the preset neighborhood corresponding to each moment, the difference in slope values ​​between moments is analyzed, so as to capture the subtle changes of the initial flow velocity value in a short period of time and obtain the local change degree value corresponding to each moment. The formula model of the local change degree value can be, for example, as follows:

[0060]

[0061] in, Indicates the local change degree value corresponding to each moment; Indicates the total number of moments in the preset neighborhood corresponding to each moment; Indicates that in the preset neighborhood corresponding to each moment, The slope value corresponding to the initial flow velocity time series data at a certain moment; Indicates that in the preset neighborhood corresponding to each moment, The slope value corresponding to the initial flow velocity time series data at a certain moment; Indicates that in the preset neighborhood corresponding to each moment, The slope value corresponding to the initial flow velocity time series data at a certain moment; Represents the normalization function.

[0062] In the formula model of the local change degree value, within the preset neighborhood corresponding to each moment, the difference between the slope values ​​in the initial flow velocity time series data at adjacent moments is analyzed. The larger the value, the The moment and The change trend of the initial flow velocity value may have changed significantly between the moments. On the contrary, the smaller the value, the The moment and The change trend of the initial flow velocity value between the adjacent moments is relatively consistent, and then the change trend of the initial flow velocity value between adjacent moments in the preset neighborhood is analyzed to obtain , this value represents the trend change of the initial flow velocity value between three adjacent moments. The larger the value, the more it means that the trend has changed, that is, the initial flow velocity value has fluctuated greatly. Therefore, combined with the change trend of the initial flow velocity values ​​between all three adjacent moments in the preset neighborhood, the local change degree value corresponding to each moment is obtained. The larger the value, the greater the fluctuation of the initial flow velocity data in the local range corresponding to each moment.

[0063] In other embodiments of the present invention, the absolute value of the difference between the slope values ​​corresponding to two adjacent moments can be calculated within a preset neighborhood corresponding to each moment, and then the sum of the absolute values ​​of the slope differences between all adjacent moments can be normalized and used as the local change degree value corresponding to each moment. Similarly, the larger the value, the greater the fluctuation degree of the initial flow velocity data within the local range corresponding to each moment.

[0064] Since the variance of a set of data values ​​can reflect the fluctuation of the data, the variance of the initial flow velocity values ​​at all times is calculated within the preset neighborhood corresponding to each moment, and the variance value is normalized as the local change degree value corresponding to each moment. Similarly, the larger the value, the greater the fluctuation degree of the initial flow velocity data in the local range corresponding to each moment.

[0065] It should be noted that the standard deviation value can also be used to reflect the fluctuation of the data, which is not limited here. The preset neighborhood is set to be centered at each moment, and 2 moments are taken before and after in the time series, that is, the neighborhood size is set to 5. When the moments on one side are less than 2, the total number of 5 can be supplemented on the other side. The size of the neighborhood can be adjusted according to the implementation scenario, which is not limited here.

[0066] Step S102: In the initial flow velocity time series data, based on the distribution of extreme value points, determine the overall stability value of the initial flow velocity time series data.

[0067] In step S101, the local fluctuation of the data is analyzed, and the introduction of global information can avoid excessive smoothing in some local areas and ignoring important flow rate change information. Extreme points are usually significant change points in the data, so here, by considering the distribution of extreme points in the initial flow rate time series data, the overall change trend of the initial flow rate time series data over a period of time can be grasped, and the overall stability value can be obtained, which is helpful to select a more appropriate length of the adaptive smoothing window in the subsequent process.

[0068] First, all extreme points in the initial flow velocity time series data are obtained, including maximum points and minimum points, and then the initial flow velocity time series data is segmented based on the extreme points, that is, the initial flow velocity value between two adjacent extreme points is taken as a data segment, thereby obtaining all flow velocity data segments.

[0069] The mean length of all velocity data segments can indicate whether the data in the initial velocity time series data changes dramatically. Therefore, the value after the segment length of all velocity data segments is averaged is used as the overall stability value of the initial velocity time series data. The formula model of the overall stability value includes:

[0070]

[0071] in, Indicates the overall stability value corresponding to the initial flow velocity time series data; Indicates the total number of flow rate data segments in the initial flow rate time series data; Indicates the initial flow velocity time series data The segment length of a flow rate data segment.

[0072] In the formula model of the overall stability value, the mean length of all flow velocity data segments in the initial flow velocity time series data is calculated. The larger it is, the smaller the number of flow velocity time series data segments is and the longer the segment length of each flow velocity time series data segment is, then the overall change cycle of the initial flow velocity time series data will be longer. From the overall level, the change fluctuation of the initial flow velocity time series data is smaller, that is, from a global perspective, the change fluctuation of the initial flow velocity time series data is smaller.

[0073] Step S103: According to the overall stability value and the local change value corresponding to each moment, the preset window length is adjusted to determine the adaptive smoothing window corresponding to each moment.

[0074] When the overall stability value of the initial flow velocity time series data is larger, it means that the overall change cycle of the initial flow velocity time series data is longer, so when determining the adaptive smoothing window corresponding to each moment, a larger window should be selected; similarly, when the local change value corresponding to each moment is larger, it means that the data fluctuates more strongly in the local range corresponding to the moment, so a larger smoothing window should be used to enable more accurate smoothing processing. Therefore, the overall stability value and the local change value are positively correlated with the length of the adaptive smoothing window, so the formula model of the length of the adaptive smoothing window can be specifically, for example:

[0075]

[0076] in, Indicates the length of the adaptive smoothing window at each moment; Indicates the local change degree value corresponding to each moment; Indicates the overall stability value corresponding to the initial flow velocity time series data; Indicates the preset window length; represents the normalization function; Represents the ceiling function.

[0077] In the above formula model, the overall stability value of the initial flow velocity time series data and the sum of the local change value corresponding to each moment are normalized to obtain the adjustment factor The larger the adjustment factor, the longer the adaptive smoothing window length corresponding to each moment should be. Therefore, the value added by the adjustment factor and 1 is used as the adjustment degree value corresponding to each moment. The adjustment degree value represents the degree to which the adaptive smoothing window corresponding to each moment should be adjusted. Therefore, the adjustment degree value is multiplied by the preset window length, and the product is rounded up to obtain the adaptive window length corresponding to each moment.

[0078] It should be noted that the preset window length is set to 5 and the width is 1, that is, the window size is 5×1. The specific window length can be adjusted according to the implementation scenario and is not limited here.

[0079] At this point, the adaptive smoothing window length corresponding to each moment can be obtained. Then, the initial flow rate value can be smoothed based on the mean filter algorithm within the adaptive smoothing window corresponding to each moment, that is, the target flow rate time series data corresponding to the initial flow rate time series data can be obtained.

[0080] It should be noted that in other embodiments of the present invention, filtering methods such as median filtering can also be used to smooth the initial flow velocity time series data, and the median filtering algorithm and the mean filtering algorithm are technical means well known to those skilled in the art and will not be elaborated here.

[0081] In this embodiment of the present invention, the purpose of smoothing the initial flow velocity time series data to obtain the target flow velocity time series data is to eliminate the impact of sudden changes in water flow velocity on the depth control of the underwater robot, thereby making the subsequent process more accurate. In other embodiments of the present invention, the initial flow velocity time series data can also be directly used as the target flow velocity time series data, which is not limited here.

[0082] Step S2: Based on the numerical characteristics of the target flow rate value at the current moment and the data fluctuations in the local range, obtain the speed prediction control parameters of the force control device at the next moment; analyze the consistency of data changes between the target flow rate time series data and the depth time series data, and determine the speed mapping control parameters of the force control device at the current moment.

[0083] After obtaining the target flow rate time series data, when the water flow at the location of the underwater robot changes in the vertical direction, the control system needs to adjust the speed of the force control device of the underwater robot so that the additional force can counteract the change in the water flow rate. Therefore, the speed prediction control parameter of the force control device at the next moment can be determined based on the target flow rate value at the current moment in the target flow rate time series data and the data fluctuation in the local range. At the same time, the underwater robot is affected by the water flow to different degrees at different depths. Therefore, in the embodiment of the present invention, the data fluctuation consistency between the target flow rate time series data and the depth time series data is analyzed to quantify the correlation between the depth change of the underwater robot and the change of the target flow rate time series data, and obtain the speed mapping control parameter of the force control device at the current moment. Then, in the subsequent process, the speed of the force control device can be controlled in real time based on the speed prediction control parameter and the speed mapping control parameter, so as to ensure that when the underwater robot is performing fixed depth control, it can better adapt to the influence of the change of the water flow environment.

[0084] In the target flow rate time series data, the data fluctuations in the local range at the current moment reflect the subtle changes in the water flow in a short period of time. Since the underwater environment is complex and changeable, and the current moment is closest to the next moment, based on the numerical characteristics of the target flow rate value at the current moment in the target flow rate time series data and the data fluctuations in the local range, the speed prediction control parameters of the force control device at the next moment can be predicted more accurately.

[0085] Preferably, in one embodiment of the present invention, the method for obtaining the speed prediction control parameter includes:

[0086] Since the extreme point usually represents a significant change in the data in a short period of time, in the target flow rate time series data, the extreme point with the smallest time interval distance from the current moment is used as the discontinuity point, and the target flow rate value between the discontinuity point and the current moment constitutes the target data segment; at this time, since the data in the target data segment is a group of data segments with obvious data change trends that are closest to the next moment in time, the data therein can be regarded as data that has an important influence on predicting the future rotational speed of the force control device.

[0087] Therefore, in the target data segment, the absolute value of the difference between the maximum target flow rate value and the minimum target flow rate value is used as the flow rate change value, and the change flow rate value reflects the change range of the target flow rate value in the target data segment. The segment length of the target data segment reflects the duration of the change trend of the flow rate data. Combining it with the change range can explain the drastic data fluctuation to a certain extent, so the ratio of the flow rate change value to the segment length of the target data segment is used as the control factor.

[0088] Finally, based on the control factor and the absolute value of the target flow rate value at the current moment, the speed prediction control parameter of the force control device at the next moment is determined, and the control factor and the absolute value of the target flow rate value at the current moment are positively correlated with the speed prediction control parameter. The formula model of the speed prediction control parameter can be, for example:

[0089]

[0090] in, Indicates that at the next moment Speed ​​prediction control parameters; Indicates the length of the preset period, that is, the current moment; Indicates the target flow rate value in the target flow rate time series data at the current moment; Indicates the maximum target flow rate value in the target data segment; Indicates the minimum target flow rate value in the target data segment; Indicates the segment length of the target data segment; Represents the normalization function.

[0091] In the formula model of the speed prediction control parameter, the absolute value of the difference between the maximum target flow rate value and the minimum target flow rate value is calculated as the flow rate change value. , when the flow velocity change value is larger, it means that in the target data segment, the water flow velocity around the underwater robot changes greatly, then it is necessary to apply a larger control parameter to the force control device to offset the change in water flow velocity; and when the segment length of the target data segment is smaller, it means that the aforementioned flow velocity change occurs in a very short time, so the control factor The larger it is, the more dramatic the change in water velocity has occurred in a short period of time. At the same time, if the absolute value of the flow rate in the target flow rate time series data at the current moment is also larger, it means that the water flow changes greatly at this time, and the speed prediction control parameters should be increased to better adapt to the underwater water flow velocity fluctuations.

[0092] At this point, based on the fluctuation of the target flow rate value in the local range corresponding to the target flow rate time series data at the current moment, the rotation speed prediction control parameter of the force control device at the next moment is obtained.

[0093] In a complex underwater environment, the most intuitive way to analyze the impact of water flow velocity on the depth control of the underwater robot is to analyze the consistency of data changes between the target flow velocity time series data and the underwater robot depth time series data, so as to quantify the speed control of the force control device at the current moment and determine the speed mapping control parameters.

[0094] Preferably, in one embodiment of the present invention, the method for acquiring the speed mapping control parameter includes:

[0095] The DTW distance can be used to analyze the similarities between two sets of data, and then to characterize the mutual influence relationship between the two. Therefore, the DTW distance between the target flow velocity time series data and the depth time series data of the underwater robot is calculated.

[0096] Then the DTW distance is negatively correlated and normalized and the value is used as the speed mapping control parameter of the force control device at the current moment. The formula model of the speed mapping control parameter can be, for example:

[0097]

[0098] in, Indicates the current time Speed ​​mapping control parameters; represents the DTW distance between the target flow velocity time series data and the depth time series data of the underwater robot; Expressed as a natural constant An exponential function with base .

[0099] In the formula model of the speed mapping control parameter, the DTW distance is used to represent the similarity between the target flow rate time series data and the depth time series data. When the DTW distance is smaller, it means that the two are more similar. It can be regarded that when the water flow rate changes, the depth of the underwater robot also fluctuates accordingly, which means that the greater the impact of the water flow rate change on the depth of the underwater robot, the more correlated the fluctuations of the two are. Then, at the current moment, the force control device should adopt a larger control parameter to offset the impact of the water flow rate change on the depth of the underwater robot. Therefore, the DTW distance is negatively correlated and normalized to achieve logical relationship correction, and the speed mapping control parameter of the force control device at the current moment is obtained.

[0100] In other embodiments of the present invention, the cosine similarity between the target flow rate time series data and the depth time series data can also be analyzed. Specifically, the flow rate vector composed of all target flow rate values ​​in the target flow rate time series data can be obtained. Similarly, the depth vector composed of all depth values ​​in the depth time series data can be obtained. Then, the cosine similarity between the flow rate vector and the depth vector is calculated, and the value range of the value is adjusted. The adjusted value is used as the speed mapping control parameter of the force control device at the current moment. The formula model of the speed mapping control parameter can be, for example, as follows:

[0101]

[0102] in, Indicates the current time Speed ​​mapping control parameters; Represents the cosine similarity between the target flow velocity time series data and the depth time series data of the underwater robot.

[0103] In the formula model of the speed mapping control parameter, the value range of the cosine similarity between the flow velocity vector and the depth vector is [-1, 1], and the closer it is to 1, the more similar they are. This indicates that while the water flow velocity changes, the depth of the underwater robot also fluctuates accordingly. Therefore, the value range of the cosine similarity is adjusted to [0, 1]. The larger the adjusted value is, the greater the impact of the water flow velocity change on the depth of the underwater robot. Therefore, the adjusted value is used as the speed mapping control parameter.

[0104] At this point, based on the consistency of data changes between the target flow rate time series data and the depth time series data, the rotation speed mapping control parameters of the force control device at the current moment are obtained.

[0105] Step S3: According to the speed mapping control parameters, speed prediction control parameters, speed value at the current moment and target flow rate value corresponding to the force control device, obtain the speed prediction value of the force control device at the next moment; and control the depth of the underwater robot based on the speed prediction value.

[0106] In the above process, by analyzing the change of water flow velocity at the position of the underwater robot and its influence on the change of the depth of the underwater robot, the speed mapping control parameters and speed prediction control parameters of the force control device are obtained; in the target flow velocity time series data, when the target flow velocity value is positive, it represents the direction of the water flow velocity at this time as vertically upward, and when the target flow velocity value is negative, it represents the direction of the water flow velocity at this time as vertically downward, and for different water flow directions, the speed adjustment direction of the force control device should also be different, so the speed value of the force control device at the current moment can be adjusted based on the speed mapping control parameters and speed prediction control parameters corresponding to the force control device on the basis of the target flow velocity time series data at the current moment, so as to obtain the speed prediction value of the force control device at the next moment. Finally, based on the deviation between the speed prediction value and the speed value at the current moment, the depth of the underwater robot is PID controlled.

[0107] Due to the uncertainty of the direction of the water flow velocity, the direction of increase or decrease of the additional force applied by the force control device of the underwater robot is also uncertain. The rotational speed value of the force control device at the current moment represents the working state of the force control device at this moment. Therefore, based on the target flow rate value of the target flow rate time series data at the current moment, the working state of the force control device at the current moment is adjusted based on the rotational speed mapping control parameters and the rotational speed prediction control parameters corresponding to the force control device, so as to more accurately determine the rotational speed prediction value that the force control device should have at the next moment.

[0108] Preferably, in one embodiment of the present invention, the method for obtaining the speed prediction value includes:

[0109] When the target flow rate value at the current moment in the target flow rate time series data is a positive number, it means that the direction of the water flow velocity at the current position of the underwater robot is vertically upward. Then the underwater robot may move upward under the action of the water flow velocity. Therefore, it is necessary to reduce the rotation speed of the force control device and reduce the upward force provided by the force control device so that the underwater robot can move downward under the action of its own gravity, thereby maintaining depth balance. Therefore, the value after negative correlation mapping of the product of the speed mapping control parameter and the speed prediction control parameter is used as the adjustment parameter, and the product of the adjustment parameter and the speed value of the force control device at the current moment is used as the speed prediction value.

[0110] When the flow rate value at the current moment in the target flow rate time series data is negative, it means that the direction of the water flow velocity at the current position of the underwater robot is vertically downward. Then, the underwater robot may move downward under the action of the water flow velocity. In order to keep the depth of the underwater robot stable, it is necessary to increase the upward force. Therefore, the product of the speed mapping control parameter and the speed prediction control parameter is numerically adjusted to the value used as the adjustment parameter, and the product of the adjustment parameter and the speed value of the force control device at the current moment is used as the speed prediction value.

[0111] The formula model of the speed prediction value may be specifically, for example:

[0112]

[0113]

[0114] in, Indicates that the force control device will The predicted speed value at ; Indicates the force control device at the current moment The speed value below; Indicates that at the next moment Speed ​​prediction control parameters; Indicates the speed mapping control parameters at the current moment; Indicates the current time The target flow rate value in the target flow rate time series data.

[0115] In the formula model of the speed prediction value, when the target flow rate value at the current moment in the target flow rate time series data is a positive number, it means that the underwater robot is subjected to an upward force provided by a water flow at this time, then the speed of the force control device should be reduced, thereby reducing the upward force provided by the force control device, so that the underwater robot can maintain the stability of the depth. Therefore, the product of the speed mapping control parameter of the force control device at the current moment and the speed prediction control parameter at the next moment is negatively correlated and mapped to obtain the adjustment parameter , at this time, the value range of the adjustment parameter is 0-1, and the specific value can be regarded as the degree to which the speed of the force control device needs to be reduced, so the adjustment parameter is multiplied by the speed value of the force control device at the current moment to obtain the speed prediction value at the next moment. On the contrary, when the flow rate value at the current moment in the target flow rate time series data is negative, it means that the underwater robot is subjected to a downward force provided by a water flow. In this case, the speed of the force control device should be increased, thereby increasing the upward force provided by the force control device, so that the underwater robot can maintain depth stability under the action of multiple forces. Therefore, the product of the speed mapping control parameter of the force control device at the current moment and the speed prediction control parameter at the next moment is numerically adjusted to obtain the adjustment parameter. At this time, the value range of the adjustment parameter is 1-2, which represents the degree to which the speed of the force control device needs to be increased. Finally, the adjustment parameter is multiplied by the speed value of the force control device at the current moment to obtain the predicted speed value at the next moment.

[0116] It should be noted that underwater, since water bodies are affected by many factors, such as gravity, wind, terrain, etc., these factors will cause water bodies to flow. Even in relatively closed waters, since water bodies are affected by many factors such as temperature, salinity, biological activities, etc., there will be slight flows. Therefore, under actual circumstances, it is almost impossible for the water flow rate to be 0. However, under ideal conditions, if the target flow rate value in the target flow rate time series data at the current moment is 0, it means that at this moment, the depth of the underwater robot is in a stable state, then the speed prediction value of the force control device at the next moment can be kept consistent with the current moment, that is, .

[0117] At this point, the predicted speed value of the force control device at the next moment can be obtained, and then it can be compared with the actual speed value of the force control device at the current moment to obtain the deviation value. Finally, based on the deviation value, the PID controller is used to more accurately adjust the speed of the force control device to gradually approach the predicted value, thereby adjusting the depth of the underwater robot so that it maintains dynamic balance within a smaller range of changes.

[0118] Preferably, in one embodiment of the present invention, controlling the depth of the underwater robot based on the rotation speed prediction value includes:

[0119] The difference between the speed prediction value and the speed value of the force control device at the current moment is calculated as an error factor.

[0120] The error factor is used as the input of the PID controller, and the rotation speed of the force control device is adjusted based on the initial proportional coefficient, the initial integral coefficient and the initial differential coefficient, so as to perform PID control on the depth of the underwater robot.

[0121] It should be noted that, in an embodiment of the present invention, the Ziegler-Nichols law in the PID data setting method can be used to obtain the initial proportional coefficient, initial integral coefficient and initial differential coefficient, and the Ziegler-Nichols law is a technical means well known to those skilled in the art, and will not be described in detail here; in other embodiments of the present invention, other PID data setting methods can also be used, such as trial and error method, critical oscillation method, reference model method or genetic algorithm, optimization algorithm and other methods to obtain the initial proportional coefficient, initial integral coefficient and initial differential coefficient, and will not be described in detail here. In practical applications, the initial proportional coefficient, initial integral coefficient and initial differential coefficient can also be adjusted according to the specific characteristics and working environment of the underwater robot to obtain a better control effect, and will not be described in detail here.

[0122] In order to facilitate calculation, all the index data involved in the calculation in the embodiment of the present invention are preprocessed to eliminate the dimension effect. The specific means of eliminating the dimension effect are well known to those skilled in the art and will not be limited or elaborated here.

[0123] In summary, firstly, the depth time series data of the underwater robot and the speed time series data of the force control device are obtained. Due to the complex underwater environment, the water flow velocity will affect the fixed depth control of the underwater robot, so the target flow velocity time series data of the water flow in the vertical direction at the position of the underwater robot is obtained at the same time. When the water flow velocity changes, in order to ensure the depth stability of the underwater robot, the speed of the force control device also needs to be changed. Therefore, the fluctuation of the target flow velocity value in the target flow velocity time series data can be analyzed to determine the speed prediction control parameters that the force control device should have at the next moment, so that the speed of the force control device can respond to the change of the water flow velocity more accurately; at the same time, since the change of the water flow velocity is closely related to the depth change of the underwater robot, the fluctuation between the target flow velocity time series data and the depth time series data can be matched, so as to ensure that the speed of the force control device matches the depth change of the underwater robot, and obtain the speed mapping control parameters of the force control device at the current moment. Finally, multiple parameters can be integrated, namely, based on the speed mapping control parameters, the speed prediction control parameters, the speed value at the current moment and the target flow rate value, to obtain the speed prediction value of the force control device at the next moment, and based on the error between the speed prediction value and the current speed value, the depth of the underwater robot can be PID controlled. At this time, since the speed prediction value takes into account the influence of the water flow velocity on the depth positioning of the underwater robot, the speed can be more accurately approached to the predicted value during PID control, thereby accurately and dynamically adjusting the depth of the underwater robot.

[0124] The present invention also proposes a depth control system for an underwater robot, see Figure 4, which shows a system block diagram, including: a data acquisition module 401, a speed control parameter acquisition module 402, and a depth control module 403.

[0125] It should be noted that the system provided in the above embodiment is only illustrated by the division of the above functional modules. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the computer device is divided into different functional modules to complete all or part of the functions described above. In addition, the depth control system of an underwater robot and the depth control method of an underwater robot provided in the above embodiment belong to the same concept. The specific implementation process is detailed in the method embodiment and will not be repeated here.

[0126] See also Figure 5 , which shows a schematic diagram of the system structure of a depth control system of an underwater robot provided by an embodiment of the present invention, including a processor 500, a memory 501, a bus 502 and a communication interface 503, wherein the processor 500, the communication interface 503 and the memory 501 are connected via the bus 502; wherein the memory 501 may include a high-speed random access memory, the bus 502 may be an ISA bus, a PCI bus or an EISA bus, etc., and the processor 500 may be an integrated circuit chip with signal processing capabilities; the memory 501 stores at least one instruction, at least one program, a code set or an instruction set, and when the at least one instruction, at least one program, a code set or an instruction set is loaded and executed by the processor, the steps in a depth control method of an underwater robot are implemented.

[0127] It should be noted that the sequence of the above embodiments of the present invention is only for description and does not represent the advantages and disadvantages of the embodiments. The processes depicted in the accompanying drawings do not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.

[0128] The various embodiments in this specification are described in a progressive manner, and the same or similar parts between the various embodiments can be referenced to each other, and each embodiment focuses on the differences from other embodiments.

Claims

1. A method for controlling the depth of an underwater robot, characterized in that: A powerful control device is installed on the underwater robot, and the method includes: Acquire the depth time series data of the underwater robot and the speed time series data of the force control device; acquire the target flow velocity time series data of the water flow in the vertical direction at the location of the underwater robot; Based on the numerical characteristics of the target flow rate value at the current moment and the data fluctuations in the local range, the speed prediction control parameters of the force control device at the next moment are obtained; the consistency of data changes between the target flow rate time series data and the depth time series data is analyzed to determine the speed mapping control parameters of the force control device at the current moment; According to the speed mapping control parameter corresponding to the force control device, the speed prediction control parameter, the speed value at the current moment and the target flow rate value, obtaining the speed prediction value of the force control device at the next moment; and controlling the depth of the underwater robot based on the speed prediction value; The method for obtaining the speed prediction control parameter includes: In the target flow rate time series data, the extreme point with the smallest time interval distance from the current moment is taken as the discontinuity point, and the target flow rate value between the discontinuity point and the current moment is formed into a target data segment; In the target data segment, the absolute value of the difference between the maximum target flow rate value and the minimum target flow rate value is used as the flow rate change value; the ratio of the flow rate change value to the target data segment length is used as the control factor; Based on the regulation factor and the absolute value of the target flow rate value at the current moment, determining the speed prediction control parameter of the force control device at the next moment, and the regulation factor and the absolute value of the target flow rate value at the current moment are both positively correlated with the speed prediction control parameter; When the water flow velocity direction at the underwater robot is vertically upward, the target flow velocity value is a positive number, and when the water flow velocity direction at the underwater robot is vertically downward, the target flow velocity value is a negative number; The method for obtaining the speed prediction value includes: When the target flow rate value at the current moment in the target flow rate time series data is a positive number, the value after negative correlation mapping of the product of the speed mapping control parameter and the speed prediction control parameter is used as the adjustment parameter, and the product of the adjustment parameter and the speed value of the force control device at the current moment is used as the speed prediction value; When the target flow rate value at the current moment in the target flow rate time series data is a negative number, the value after the product of the speed mapping control parameter and the speed prediction control parameter is numerically adjusted is used as the adjustment parameter, and the product of the adjustment parameter and the speed value of the force control device at the current moment is used as the speed prediction value; The formula model for the speed prediction value includes: in, Indicates that the force control device will The predicted speed value at ; Indicates the force control device at the current moment The speed value below; Indicates that at the next moment Speed ​​prediction control parameters; Indicates the speed mapping control parameters at the current moment; Indicates the current time The target flow rate value in the target flow rate time series data; express Adjustment parameters when express The adjustment parameters when .

2. A method for controlling the depth of an underwater robot according to claim 1, characterized in that: The method for acquiring the target flow rate time series data includes: Obtaining time series data of the initial flow velocity of the water flow in the vertical direction at the location of the underwater robot; Determining an adaptive smoothing window corresponding to each moment based on changes in the initial flow velocity value in the initial flow velocity time series data; In the adaptive smoothing window corresponding to each moment, the initial flow velocity value is smoothed based on the mean filtering algorithm to obtain the target flow velocity time series data corresponding to the initial flow velocity time series data.

3. The method for controlling the depth of an underwater robot according to claim 2, characterized in that: The method for obtaining the adaptive smoothing window includes: Determine a preset neighborhood corresponding to each moment, and within the preset neighborhood corresponding to each moment, determine a local change degree value corresponding to each moment based on the change fluctuation of the initial flow velocity value in the initial flow velocity time series data; In the initial flow velocity time series data, based on the distribution of extreme value points, determining the overall stability value of the initial flow velocity time series data; According to the overall stability value and the local change value corresponding to each moment, the preset window length is adjusted to determine the adaptive smoothing window corresponding to each moment, and the overall stability value and the local change value are positively correlated with the length of the adaptive smoothing window.

4. A method for controlling the depth of an underwater robot according to claim 3, characterized in that: The method for obtaining the overall stability value includes: Segmenting the initial flow velocity time series data based on the extreme value points to obtain all flow velocity data segments; The value after the segment lengths of all flow velocity data segments are averaged is used as the overall stability value.

5. The depth control method of an underwater robot according to claim 1, characterized in that: The method for obtaining the speed mapping control parameter includes: Calculating the DTW distance between the target flow rate time series data and the depth time series data; The value after negative correlation mapping and normalization of the DTW distance is used as a speed mapping control parameter of the force control device at the current moment; The formula model of the speed mapping control parameters includes: in, Indicates the current time Speed ​​mapping control parameters; represents the DTW distance between the target flow velocity time series data and the depth time series data of the underwater robot; Indicated by natural constant An exponential function with base .

6. The method for controlling the depth of an underwater robot according to claim 1, characterized in that: The controlling the depth of the underwater robot based on the rotation speed prediction value comprises: Calculating the difference between the speed prediction value and the speed value of the force control device at the current moment as an error factor; The error factor is used as the input of the PID controller, and the rotation speed of the force control device is adjusted based on the initial proportional coefficient, the initial integral coefficient and the initial differential coefficient, so as to perform PID control on the depth of the underwater robot.

7. A depth control system for an underwater robot, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the depth control method of the underwater robot as described in any one of claims 1 to 6 are implemented.