Judgment method of starting environment of underwater robot, calibration control method of depth sensor, load power control method and control device, underwater robot, storage medium and electronic equipment
By detecting the time difference of the change in the switch level of the underwater robot, judging the boot environment and sending calibration and control instructions, the environment judgment problem when the underwater robot is turned on is solved, the equipment is overheated damage and calibration errors are avoided, and the equipment is ensured in different environments. Working normally.
Patent Information
- Application Number
- CN202410923869.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-10
- Publication Date
- 2024-11-12
AI Technical Summary
The prior art cannot effectively judge the environment in which the underwater robot is in when it is turned on, resulting in overheating and damage caused by high-power loads when they run in the air.
By detecting the time difference between the level changes of at least two switches of the underwater robot, the power-off environment is judged, and calibration instructions and load control instructions are sent according to preset conditions to ensure that the depth sensor calibration and load power are operated in the appropriate environment.
It avoids the depth sensor calibration problem caused by accidental restart of underwater robots, prevents high-power loads from overheating and damage in the air, and ensures that the equipment is used normally under different air pressure environments.
Smart Images

Figure CN118938732A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of underwater robots, and specifically to a method for determining an underwater robot startup environment, a depth sensor calibration control method, a load power control method and control device, an underwater robot, a storage medium, and an electronic device. Background Art
[0002] The high-power loads of underwater robots generate a lot of heat when working, such as lighting, motors, and some sensors such as sonar, DVL (Doppler Velocity Log, Doppler velocity recorder), etc. In the field of underwater robots, the mainstream approach to dissipating heat from high-power loads is to conduct the heat into the water to solve the heat dissipation problem, such as Figure 1 shown.
[0003] However, if the user mistakenly places the underwater robot on shore to run it, the lighting, motor and some sensors will be at risk of overheating and damage, causing significant property losses. Therefore, it is necessary to judge the environment in which the underwater robot is located.
[0004] In the prior art, the solution for determining the environment of the underwater robot is to determine it based on the depth data of the depth sensor of the underwater robot. Generally speaking, if the depth data is greater than 0 meters, the underwater robot is determined to be underwater, otherwise, the underwater robot is determined to be in the air.
[0005] However, the inventors of the present application discovered that judging the environment of the underwater robot based on the depth data of the depth sensor cannot determine the environment of the underwater robot when it is turned on, and there is still the possibility that the high-power load of the underwater robot is running in the air. Summary of the invention
[0006] According to one aspect of the present application, the present application provides a method for determining the startup environment of an underwater robot. The determination method may include: detecting the levels of at least two startup signals in response to a startup instruction; and determining the startup environment of the underwater robot according to the time difference between the changes in the levels of the at least two startup signals.
[0007] According to some embodiments of one aspect of the present application, the underwater robot includes at least two switches; the above-mentioned step of detecting the levels of at least two power-on signals in response to a power-on instruction may include: detecting the levels of at least two power-on signals generated by at least two switches in response to the power-on instruction.
[0008] According to some embodiments of one aspect of the present application, the step of judging the power-on environment of the underwater robot based on the time difference of the change in the levels of at least two power-on signals may include: judging that the power-on environment is that the underwater robot is in the air when the time difference of the change satisfies a first preset condition; and judging that the power-on environment is that the underwater robot is in liquid when the time difference of the change satisfies a second preset condition.
[0009] According to one aspect of the present application, the present application provides a calibration control method for a depth sensor of an underwater robot. The calibration control method includes: responding to a power-on instruction, detecting the levels of at least two power-on signals; and, judging, based on the time difference between the changes in the levels of the at least two power-on signals, that when the power-on environment of the underwater robot meets a preset environmental condition, sending a calibration instruction to the depth sensor.
[0010] According to some embodiments of one aspect of the present application, the preset environmental condition is that the underwater robot is in the air.
[0011] According to one aspect of the present application, the present application provides a method for controlling the load power of an underwater robot. The control method includes: responding to a power-on instruction, detecting the levels of at least two power-on signals; judging that the power-on environment meets the preset environmental conditions based on the time difference of the changes in the levels of the at least two power-on signals, sending a calibration instruction to the depth sensor of the underwater robot; and judging that the power-on environment meets the preset environmental conditions based on the data sent by the calibrated depth sensor, sending a load control instruction to control the load power of the underwater robot to be less than the preset power.
[0012] According to some embodiments of one aspect of the present application, the preset environmental condition is that the underwater robot is in the air.
[0013] According to one aspect of the present application, the present application provides a control device for an underwater robot. The control device includes a processing unit, which detects the levels of at least two power-on signals and determines the power-on environment of the underwater robot according to the time difference between the changes in the levels of the at least two power-on signals.
[0014] According to some embodiments of one aspect of the present application, the underwater robot includes a depth sensor. When the changing time difference satisfies a first preset condition, the processing unit determines that the power-on environment is that the underwater robot is in the air, and issues a calibration instruction to calibrate the depth sensor.
[0015] According to some embodiments of one aspect of the present application, the processing unit determines, based on the data sent by the calibrated depth sensor, that when the power-on environment meets the preset environmental conditions, it issues a load control instruction to control the load power of the underwater robot to be less than the preset power.
[0016] According to one aspect of the present application, the present application provides an underwater robot, which includes the control device as described above, and the underwater robot also includes at least two switches, and the at least two switches generate at least two power-on signals in response to a power-on instruction.
[0017] According to one aspect of the present application, the present application provides a non-volatile computer-readable storage medium on which a computer program is stored, and the computer program can implement the method for determining the startup environment of the underwater robot as described above.
[0018] According to one aspect of the present application, the present application provides a non-volatile computer-readable storage medium having a computer program stored thereon, which can implement the calibration control method of the depth sensor of the underwater robot as described above.
[0019] According to one aspect of the present application, the present application provides a non-volatile computer-readable storage medium on which a computer program is stored, and the computer program can implement the method for controlling the load power of the underwater robot as described above.
[0020] According to one aspect of the present application, the present application provides an electronic device for judging the startup environment of an underwater robot, comprising: one or more processors; a storage device for storing one or more programs, which, when the one or more programs are executed by one or more processors, enables the one or more processors to implement the method for judging the startup environment of an underwater robot as described above.
[0021] According to one aspect of the present application, the present application provides an electronic device for calibration control of a depth sensor of an underwater robot, comprising: one or more processors; a storage device for storing one or more programs, which, when the one or more programs are executed by one or more processors, enables the one or more processors to implement the calibration control method of the depth sensor of the underwater robot as described above.
[0022] According to one aspect of the present application, the present application provides an electronic device for controlling the load power of an underwater robot, comprising: one or more processors; a storage device for storing one or more programs, which, when the one or more programs are executed by one or more processors, enables the one or more processors to implement the method for controlling the load power of the underwater robot as described above.
[0023] The technical solution of the present application determines the startup environment of the underwater robot by detecting the time difference of the level change of at least two switches of the underwater robot. By determining that the startup environment of the underwater robot meets the preset environmental conditions, a calibration instruction is sent to the depth sensor, so that the depth sensor is calibrated according to the calibration instruction.
[0024] The technical solution of the present application can realize that when the underwater robot is manually turned on, the depth sensor is automatically calibrated immediately, which can avoid the underwater robot being restarted underwater under unexpected circumstances, thereby causing the depth sensor to be calibrated underwater.
[0025] The technical solution of the present application can avoid the situation where the user forgets to calibrate the depth sensor of the underwater robot by himself, especially when the underwater robot is moved to different areas for use, the air pressure in different areas is different, and the user forgets to calibrate the depth sensor. User misoperation may cause the underwater robot to be in the air, and some high-power loads of the underwater robot to overheat and be damaged.
[0026] The technical solution of the present application determines the power-on environment of the underwater robot and limits the power of some high-power loads of the underwater robot when the underwater robot is in the air, thereby controlling the heat generated by the high-power loads of the underwater robot when running in the air and avoiding the problem of overheating and damage of the high-power loads in the air. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0028] Figure 1 Schematic diagram of cooling high-power loads for underwater robots;
[0029] Figure 2 A flow chart showing a method 1000 for determining an underwater robot startup environment according to an exemplary embodiment of the present application;
[0030] Figure 3 A schematic flow chart of step S1200 in a calibration control method 2000 for a depth sensor of an underwater robot according to an embodiment of the present application is shown;
[0031] Figure 4 A schematic flow chart showing a calibration control method 2000 for a depth sensor of an underwater robot according to an embodiment of the present application;
[0032] Figure 5 A schematic flow chart showing a method 3000 for controlling the load power of an underwater robot according to an embodiment of the present application;
[0033] Figure 6 A schematic diagram showing a control device for load power of an underwater robot according to an embodiment of the present application;
[0034] Figure 7 A schematic diagram showing at least two switches of an underwater robot according to an embodiment of the present application;
[0035] Figure 8 A schematic diagram showing the connection between a load power control device of an underwater robot and at least two switches according to an embodiment of the present application. DETAILED DESCRIPTION
[0036] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in many forms and should not be construed as limited to the embodiments set forth herein; rather, these embodiments are provided so that this application will be comprehensive and complete and will fully convey the concepts of the example embodiments to those skilled in the art. The same reference numerals in the figures represent the same or similar parts, and thus their repeated description will be omitted.
[0037] The described features, structures or characteristics may be combined in one or more embodiments in any suitable manner. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present disclosure. However, those skilled in the art will appreciate that the technical solutions of the present disclosure may be practiced without one or more of these specific details, or other modes, components, materials, devices, etc. may be adopted. In these cases, known structures, methods, devices, implementations, materials or operations will not be shown or described in detail.
[0038] In addition, the terms "include" and "have" and any variations thereof are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but may optionally include steps or units that are not listed, or may optionally include other steps or units that are inherent to these processes, methods, products or devices.
[0039] The terms "first", "second" and the like in the specification and claims of this application and the above drawings are used to distinguish different objects rather than to describe a specific order.
[0040] The following is a clear and complete description of the technical solution of the present application in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present application.
[0041] According to one aspect of the present application, the present application provides a method for determining the startup environment of an underwater robot. Figure 2FIG. 1 is a flow chart showing a method 1000 for determining the startup environment of an underwater robot according to an exemplary embodiment of the present application. Figure 2 The method 1000 for determining the startup environment of an underwater robot includes steps S1100-S1200. Exemplarily, the determination method may be executed by a determination device.
[0042] In step S1100, in response to the power-on instruction, the levels of at least two power-on signals are detected. For example, in step S1100, the determination device detects the levels of at least two power-on signals in response to the power-on instruction.
[0043] Optionally, the underwater robot includes at least two switches, and the judging device detects the levels of at least two power-on signals generated by the at least two switches in response to the power-on instruction. The at least two power-on signals are generated by the at least two switches in response to the power-on instruction. The power-on instruction can be generated for a user, for example, the user manually turns on the at least two switches. The power-on instruction can also be generated for the underwater robot after it is powered off and restarted underwater, for example, the underwater robot turns on at least two switches when it is powered off and restarted underwater.
[0044] In step S1200, the power-on environment of the underwater robot is determined according to the time difference between the changes in the levels of at least two power-on signals.
[0045] For example, in step S1200, the judging device judges the power-on environment of the underwater robot according to the time difference between the changes in the levels of at least two power-on signals.
[0046] According to an example embodiment, when the power-on instruction is generated by a user, the user manually turns on at least two switches, and the levels of at least two power-on signals generated by the at least two switches do not change at the same time, that is, the at least two switches are not turned on at the same time. When the power-on instruction is generated after the underwater robot is powered off and restarted, and the underwater robot automatically turns on at least two switches after powering on, the levels of at least two power-on signals change at the same time, that is, the at least two switches are turned on at the same time.
[0047] Optionally, Figure 3 FIG. 1 is a flow chart showing step S1200 in a method 1000 for determining an underwater robot startup environment according to an exemplary embodiment of the present application. Figure 3 If the judging device judges that the time difference between the level changes of at least two power-on signals meets the first preset condition, the power-on environment is judged to be that the underwater robot is in the air. Otherwise, the judging device judges that the time difference between the level changes of at least two power-on signals meets the second preset condition, and the power-on environment is judged to be that the underwater robot is in liquid.
[0048] According to an example embodiment, the first preset condition may be that the time difference between the levels of the at least two power-on signals is greater than 0, and the second preset condition may be that the time difference between the levels of the at least two power-on signals is equal to 0.
[0049] For example, the underwater robot includes at least two switches, namely a first switch and a second switch. When the underwater robot is turned on, the first switch responds to the power-on command and generates a first power-on signal, and the level of the first power-on signal changes at a first time T1, for example, the level of the first power-on signal changes from high to low or from low to high at the first time T1. The second switch responds to the power-on command and generates a second power-on signal, and the level of the second power-on signal changes at time T2, for example, the level of the second power-on signal changes from high to low or from low to high at time T2. The calculation formula for the time difference between the changes in the levels of at least two power-on signals is:
[0050] △T=T2-T1,
[0051] Wherein, T1 is the first time, T2 is the second time, and ΔT is the time difference between the level changes of the first power-on signal and the second power-on signal.
[0052] According to an example embodiment, when the judgment device calculates that ΔT is greater than 0, that is, the time difference between the levels of at least two power-on signals generated by at least two switches meets the first preset condition, the judgment device judges that at least two switches are manually turned on by the user and the underwater robot is in the air.
[0053] According to the example embodiment, when the judgment device calculates that ΔT is greater than 0, that is, the time difference between the levels of at least two power-on signals generated by at least two switches meets the second preset condition, the judgment device judges that at least two switches are automatically turned on after the underwater robot is powered off and restarted, and the power-on environment of the underwater robot is that the underwater robot is in liquid. For example, if the time difference between the changes in the levels of at least two power-on signals is equal to 0, it is judged that the underwater robot is in water.
[0054] The technical solution of the present application determines the power-on environment of the underwater robot by detecting the time difference in the changes in the levels of at least two switches of the underwater robot. It is particularly suitable for the situation where the underwater robot is turned on on shore and then operates underwater. The method is easy to apply and the implementation cost is low.
[0055] According to one aspect of the present application, the present application provides a calibration control method for a depth sensor of an underwater robot. Figure 4 A schematic flow chart of a calibration control method 2000 for a depth sensor of an underwater robot according to an embodiment of the present application is shown.
[0056] See also Figure 4The calibration control method 2000 of the depth sensor of the underwater robot includes steps S2100-S2200. Exemplarily, the calibration control method can be executed by a calibration control device.
[0057] Step S2100 in the underwater robot depth sensor calibration control method 2000 is the same as step S1100 in the underwater robot startup environment determination method 1000, and will not be described in detail herein.
[0058] In step S2200, based on the time difference between the changes in the levels of at least two power-on signals, it is determined that when the power-on environment of the underwater robot meets the preset environmental conditions, a calibration instruction is sent to the depth sensor of the underwater robot.
[0059] For example, in step S2200, the calibration control device determines the power-on environment of the underwater robot according to the judgment logic described in step S1200 in the method 1000 for determining the power-on environment of the underwater robot, and sends a calibration instruction to the depth sensor of the underwater robot when the power-on environment of the underwater robot meets the preset conditions.
[0060] According to an example embodiment, when the power-on instruction is generated by a user, the user manually turns on at least two switches, and the levels of at least two power-on signals generated by the at least two switches do not change simultaneously. When the power-on instruction is generated after the underwater robot is powered off and restarted, and the underwater robot automatically turns on at least two switches after powering on, the levels of at least two power-on signals change simultaneously.
[0061] Optionally, the preset environmental condition is that the underwater robot is in the air.
[0062] In the prior art, when the underwater robot is turned on, the depth sensor is calibrated. Before the depth sensor is calibrated, the power-on environment of the underwater robot is not determined. If the user forgets to calibrate or the depth sensor is calibrated underwater, the underwater robot may not be used normally.
[0063] According to the above-mentioned example embodiment, the calibration control device determines that the time difference between the levels of at least two power-on signals generated by at least two switches meets the first preset condition, that is, the calibration control device determines that at least two switches are manually turned on by the user based on the time difference between the changes in the levels of at least two power-on signals being greater than 0, that is, the underwater robot is in the air and meets the preset environmental conditions. The calibration control device sends a calibration instruction to the depth sensor. The depth sensor receives the calibration instruction and calibrates according to the calibration instruction, thereby calibrating the depth of the underwater robot. After the depth sensor is calibrated, the calibration control device receives the depth data of the depth sensor and can also send instructions to let the user know that the depth sensor has been calibrated.
[0064] According to the exemplary embodiment, the calibration control device determines that the time difference between the levels of at least two power-on signals generated by at least two switches meets the second preset condition, that is, the calibration control device determines that at least two switches are automatically turned on after the underwater robot is powered off and restarted, and the underwater robot is in the water, which does not meet the preset environmental conditions. The calibration control device will not send a calibration instruction to the depth sensor, so that the depth sensor will not be calibrated in the water. This can avoid the situation in the prior art where the depth sensor is calibrated in the water, resulting in the underwater robot being unable to be used normally. For example, the underwater depth is calibrated to 0 meters, resulting in the underwater robot being unable to be used normally.
[0065] The technical solution of the present application determines the startup environment of the underwater robot by detecting the time difference of the level change of at least two switches of the underwater robot. By determining that the startup environment of the underwater robot meets the preset environmental conditions, a calibration instruction is sent to the depth sensor, so that the depth sensor is calibrated according to the calibration instruction. It is particularly suitable for the situation where the underwater robot is turned on on shore and then operated underwater.
[0066] The technical solution of the present application can prevent the underwater robot from restarting underwater under unexpected circumstances, thereby causing the depth sensor to be calibrated underwater, by automatically calibrating the depth sensor immediately when the underwater robot is manually turned on.
[0067] The technical solution of the present application can avoid the situation where the user forgets to calibrate the depth sensor of the underwater robot by himself, especially when the underwater robot is moved to different areas for use, the air pressure in different areas is different, and the user forgets to calibrate the depth sensor. User misoperation may cause the underwater robot to be in the air, and some high-power loads of the underwater robot to overheat and be damaged.
[0068] According to one aspect of the present application, the present application provides a method for controlling the load power of an underwater robot. Figure 5 A schematic flow chart of a load power control method 3000 for an underwater robot according to an embodiment of the present application is shown.
[0069] See also Figure 5 The load power control method 3000 of the underwater robot includes steps S3100-S3300. Exemplarily, the load power control method can be executed by a control device.
[0070] Step S3100 of the underwater robot load power control method 3000 is the same as step S2100 of the underwater robot depth sensor calibration control method 2000, and will not be described in detail here.
[0071] Step S3200 of the underwater robot load power control method 3000 is the same as step S2200 of the underwater robot depth sensor calibration control method 2000, and will not be described in detail here.
[0072] In step S3300, based on the data sent by the calibrated depth sensor, it is determined that when the startup environment meets the preset environmental conditions, a load control instruction is issued to control the power of the load of the underwater robot to be less than the preset power.
[0073] For example, in step S3300, the control device determines, based on the data sent by the calibrated depth sensor, that the startup environment meets the preset environmental conditions, and then issues a load control instruction to control the load power of the underwater robot to be less than the preset power.
[0074] Optionally, the preset environmental condition is that the underwater robot is in the air.
[0075] According to an example embodiment, the control device receives depth data emitted by the depth sensor after calibration, and determines based on the depth data that the power-on environment satisfies the preset environmental conditions, that is, determines that the power-on environment satisfies that the underwater robot is in the air, and then issues a load control instruction to control the power of the load of the underwater robot to be less than the preset power.
[0076] For example, the control device receives the depth data from the depth sensor, and when the depth data is equal to 0 meters, it is determined that the underwater robot is powered on in the air. When the depth data is greater than 0 meters, it is determined that the underwater robot is powered on in the water.
[0077] According to an exemplary embodiment, when the depth data is equal to 0 meters, the control device determines that the underwater robot is in the air and meets the preset environmental conditions, and then issues a load control instruction to control the power of the load of the underwater robot to be less than the preset power, and the preset power can be the rated power of the load when the underwater robot operates normally underwater. When the depth data is greater than 0 meters, the control device determines that the underwater robot is in the water and does not meet the preset environmental conditions, and then continues to receive the depth data of the depth sensor.
[0078] For example, the load of the underwater robot may include a lighting lamp, a motor, a sonar, and a DVL (Doppler VelocityLog). The control device sends a load control instruction to each load to control the power of the load of the underwater robot to be less than a preset power. For example, the control device sends a motor control instruction to control the motor speed to a low speed; the control device controls the lighting lamp control instruction to control the brightness of the lighting lamp to a lower brightness; the control device sends a sonar control instruction to control the sonar to be directly turned off; the control device sends a DVL control instruction to control the DVL to be directly turned off. By controlling the operating power of the load of the underwater robot in the air, the heat generated by the load running in the air is limited, and the problem of overheating and damage of some high-power loads in the air is avoided.
[0079] The technical solution of the present application determines the startup environment of the underwater robot by detecting the time difference of the level change of at least two switches of the underwater robot. By determining that the startup environment of the underwater robot meets the preset environmental conditions, a calibration instruction is sent to the depth sensor, so that the depth sensor is calibrated according to the calibration instruction. It is particularly suitable for the situation where the underwater robot is turned on on shore and then operated underwater.
[0080] The technical solution of the present application can prevent the underwater robot from restarting underwater under unexpected circumstances, thereby causing the depth sensor to be calibrated underwater, by automatically calibrating the depth sensor immediately when the underwater robot is manually turned on.
[0081] The technical solution of the present application can avoid the situation where the user forgets to calibrate the depth sensor of the underwater robot by himself, especially when the underwater robot is moved to different areas for use, the air pressure in different areas is different, and the user forgets to calibrate the depth sensor. User misoperation may cause the underwater robot to be in the air, and some high-power loads of the underwater robot to overheat and be damaged.
[0082] The technical solution of the present application determines the power-on environment of the underwater robot and limits the power of some high-power loads of the underwater robot when the underwater robot is in the air, thereby controlling the heat generated by the high-power loads of the underwater robot when running in the air and avoiding the problem of overheating and damage of the high-power loads in the air.
[0083] The judgment device, calibration control device, and control device described in the above embodiments may be independent devices, or the same device, or an integrated device that integrates the corresponding underwater robot's power-on environment judgment function, the underwater robot's depth sensor calibration control function, and the underwater robot's load power control function.
[0084] According to one aspect of the present application, the present application provides a control device for an underwater robot. Figure 6 A schematic diagram of a control device for load power of an underwater robot according to an embodiment of the present application is shown. Figure 6 The control device 1 of the underwater robot includes a processing unit 10, which detects the levels of at least two power-on signals and determines the power-on environment of the underwater robot according to the time difference between the changes in the levels of the at least two power-on signals.
[0085] According to an example embodiment, the processing unit 10 detects the levels of at least two power-on signals. The at least two power-on signals are generated by at least two switches in response to a power-on instruction. The power-on instruction may be generated by a user, and the user manually turns on at least two switches. The power-on instruction may also be generated by the underwater robot after the underwater robot is powered off and restarted, and the underwater robot turns on at least two switches. The processing unit 10 detects the levels of at least two power-on signals.
[0086] According to an example embodiment, when the power-on instruction is generated by a user, the user manually turns on at least two switches, and the levels of at least two power-on signals generated by the at least two switches do not change simultaneously. When the power-on instruction is generated after the underwater robot is powered off and restarted, and the underwater robot automatically turns on at least two switches after powering on, the levels of at least two power-on signals change simultaneously.
[0087] Exemplarily, the underwater robot includes at least two switches, namely a first switch and a second switch. When the underwater robot is turned on, the first switch responds to the power-on command and generates a first power-on signal, and the level of the first power-on signal changes at a first time T1, for example, the level of the first power-on signal changes from high to low or from low to high at the first time T1. The second switch responds to the power-on command and generates a second power-on signal, and the level of the second power-on signal changes at T2, for example, the level of the second power-on signal changes from high to low or from low to high at T2. The calculation formula for the time difference of the change of the levels of at least two power-on signals is:
[0088] △T=T2-T1,
[0089] Wherein, T1 is the first time, T2 is the second time, and ΔT is the time difference between the level changes of the first power-on signal and the second power-on signal. The first switch may be a main switch of the underwater robot. When the first switch is turned on, the power supply unit of the underwater robot supplies power to the processing unit 10 and various loads of the underwater robot.
[0090] For example, at least two of the switches may be watertight heads of the umbilical cable. Figure 7 A schematic diagram showing at least two switches of an underwater robot according to an embodiment of the present application is shown. Figure 8A schematic diagram showing the connection between a load power control device of an underwater robot according to an embodiment of the present application and at least two switches. Figure 7-Figure 8 The umbilical cable watertight head includes an umbilical cable end watertight head connector CN1 and an underwater drone umbilical cable connector CN2. Long and short pins are arranged inside CN1. The umbilical cable watertight head is screwed to connect the long and short pins of CN1 with CN2. The time difference of the connection between the long and short pins of CN1 and CN2 realizes the time difference of opening the first switch and the second switch.
[0091] According to the exemplary embodiment, five pins are arranged inside CN1, namely, pin A, pin B, pin C, pin D and pin E, wherein pin A, pin B and pin C are short-circuited together. Pin A is arranged as a short pin, and pins B, pin C, pin D and pin E are arranged as long pins. Five jacks are arranged inside CN2, namely, jack a, jack b, jack c, jack d and jack e, jack a corresponds to pin A, jack b corresponds to pin B, jack c corresponds to pin C, jack d corresponds to pin D, and jack e corresponds to pin E. CN1 and CN2 can be a screw-fitting structure or a two-stage snap-fitting structure.
[0092] Optionally, the underwater robot includes a depth sensor. When the changing time difference satisfies a first preset condition, the processing unit 10 determines that the startup environment is that the underwater robot is in the air, and issues a calibration instruction to calibrate the depth sensor.
[0093] According to an example embodiment, the first preset condition may be that the time difference between the levels of at least two power-on signals is greater than 0. The processing unit 10 determines that the time difference between the levels of at least two power-on signals generated by at least two switches satisfies the first preset condition, that is, the time difference between the changes in the levels of at least two power-on signals is greater than 0, then the processing unit 10 determines that at least two switches are manually turned on by the user, and the power-on environment of the underwater robot is that the underwater robot is in the air.
[0094] According to an exemplary embodiment, when the changed time difference satisfies the second preset condition, it is determined that the startup environment is that the underwater robot is in liquid.
[0095] For example, the processing unit 10 determines that the time difference between the levels of at least two power-on signals generated by at least two switches meets the second preset condition, that is, the time difference between the changes in the levels of at least two power-on signals is equal to 0, then the processing unit 10 determines that at least two switches are automatically turned on after the underwater robot is powered off and restarted, and the power-on environment of the underwater robot is that the underwater robot is in liquid. For example, if the time difference between the changes in the levels of at least two power-on signals is equal to 0, then the processing unit 10 determines that the underwater robot is in water.
[0096] According to the exemplary embodiment, when the processing unit 10 calculates that ΔT is greater than 0, the processing unit 10 determines that the first switch and the second switch are manually turned on by the user, the first switch and the second switch are not turned on at the same time, and the power-on environment of the underwater robot is that the underwater robot is in the air. The processing unit 10 sends a calibration instruction to the depth sensor. The depth sensor receives the calibration instruction and calibrates according to the calibration instruction, thereby calibrating the depth of the underwater robot. After the depth sensor is calibrated, the processing unit 10 receives the depth data of the depth sensor and can also send instructions to let the user know that the depth sensor has been calibrated.
[0097] According to the exemplary embodiment, when the processing unit 10 calculates that ΔT is equal to 0, the processing unit 10 determines that the first switch and the second switch are automatically turned on after the underwater robot is powered off and restarted, and the first switch and the second switch are turned on at the same time, and the power-on environment of the underwater robot is that the underwater robot is in water. The processing unit 10 will not send a calibration instruction to the depth sensor. The depth sensor does not receive the calibration instruction and will not be calibrated in water. Avoid the situation where the depth sensor is calibrated in water, for example, the underwater depth is calibrated to 0 meters, which causes the underwater robot to be unable to be used normally.
[0098] For example, see Figure 8 During the screwing process of CN1 and CN2, the pin B in the long pin position is connected to the socket b, and the pin C in the long pin position is connected to the socket c. At this time, the power supply unit of the underwater robot supplies power to the processing unit 10 and various loads of the underwater robot, and the pin B is connected to the socket b to generate the first power-on signal GPIO_B. The processing unit 10 determines that the level of the first power-on signal GPIO_B changes at the first time T1.
[0099] See also Figure 8 When the jack c is grounded and the resistor R2 is connected to the power supply, the resistor R2 is a pull-up resistor of the first power-on signal GPIO_B, and the default level of the first power-on signal GPIO_B is a high level. The processing unit 10 determines that the level of the first power-on signal GPIO_B changes from high to low at the first time T1.
[0100] See also Figure 8 , continue to twist CN1, when CN1 and CN2 are almost completely engaged, the short pin A is connected to the socket a, and the second power-on signal GPIO_A is generated by the corresponding connection between the pin A and the socket a. The processing unit 10 determines that the level of the second power-on signal GPIO_A changes at time T2.
[0101] See also Figure 8, when the jack c is grounded and the resistor R1 is connected to the power supply, the resistor R1 is the pull-up resistor of the second power-on signal GPIO_A, and the default level of the second power-on signal GPIO_A is a high level, then the processing unit 10 determines that the level of the second power-on signal GPIO_A changes from high to low at time T2. The processing unit 10 calculates that △T is greater than 0, and the processing unit 10 determines that the first power-on signal GPIO_B and the second power-on signal GPIO_A successively become low levels. The processing unit 10 calculates that △T is greater than 0, which can be judged that the corresponding connection between pin B and jack b and the corresponding connection between pin A and jack a are manually connected by the user, thereby judging that the connection between CN1 and CN2 is manually screwed by the user. The processing unit 10 sends a calibration instruction to the depth sensor. The depth sensor receives the calibration instruction and calibrates according to the calibration instruction, thereby calibrating the depth of the underwater robot. After the depth sensor is calibrated, the processing unit 10 receives the depth data of the depth sensor, and can also send instructions to let the user know that the depth sensor has been calibrated.
[0102] See also Figure 8 , when the jack c is connected to the power supply, the resistor R1 is grounded, and the resistor R2 is grounded, the resistor R2 is a pull-down resistor of the first power-on signal GPIO_B, so that the default level of the first power-on signal GPIO_B is a low level, and the processing unit 10 determines that the level of the first power-on signal GPIO_B changes from low to high at the first time T1. The resistor R1 is a pull-down resistor of the second power-on signal GPIO_A, so that the default level of the second power-on signal GPIO_A is a high level, and the processing unit 10 determines that the level of the second power-on signal GPIO_A changes from low to high at time T2. The default level states of the first power-on signal GPIO_B and the second power-on signal GPIO_A are not limited here.
[0103] For example, the processing unit 10 calculates that △T is equal to 0, and the processing unit 10 determines that the first power-on signal GPIO_B and the second power-on signal GPIO_A become low levels at the same time, and determines that the corresponding connection between pin B and jack b and the corresponding connection between pin A and jack a are automatically connected after the underwater robot is powered off and restarted, thereby determining that the connection between CN1 and CN2 is automatically connected after the underwater robot is powered off and restarted. The processing unit 10 will not send a calibration instruction to the depth sensor. The depth sensor does not receive a calibration instruction and will not be calibrated in water.
[0104] The technical solution of the present application determines the startup environment of the underwater robot by detecting the time difference of the level change of at least two switches of the underwater robot. By determining that the startup environment of the underwater robot meets the preset environmental conditions, a calibration instruction is sent to the depth sensor, so that the depth sensor is calibrated according to the calibration instruction. It is particularly suitable for the situation where the underwater robot is turned on on shore and then operated underwater.
[0105] The technical solution of the present application is to automatically calibrate the depth sensor immediately after the underwater robot is manually turned on, so as to avoid the underwater robot being restarted underwater under unexpected circumstances, thereby causing the depth sensor to be calibrated underwater.
[0106] The technical solution of the present application can avoid the situation where the user forgets to calibrate the depth sensor of the underwater robot by himself, especially when the underwater robot is moved to different areas for use, the air pressure in different areas is different, and the user forgets to calibrate the depth sensor. User misoperation may cause the underwater robot to be in the air, and some high-power loads of the underwater robot to overheat and be damaged.
[0107] Optionally, the processing unit 10 determines, based on the data sent by the calibrated depth sensor, that when the startup environment meets the preset environmental conditions, it issues a load control instruction to control the load power of the underwater robot to be less than the preset power.
[0108] According to the example embodiment, the processing unit 10 receives the depth data issued after the depth sensor is calibrated, and determines based on the depth data that the power-on environment meets the preset environmental conditions, that is, determines that the power-on environment meets the requirements that the underwater robot is in the air, and then issues a load control instruction to control the power of the load of the underwater robot to be less than the preset power.
[0109] For example, the processing unit 10 receives the depth data of the depth sensor. When the depth data is equal to 0 meters, the processing unit 10 determines that the startup environment of the underwater robot is that the underwater robot is in the air. When the depth data is greater than 0 meters, the processing unit 10 determines that the startup environment of the underwater robot is that the underwater robot is in water.
[0110] According to an exemplary embodiment, when the depth data is equal to 0 meters, the processing unit 10 determines that the underwater robot is powered on in the air, and then issues a load control instruction to control the power of the underwater robot's load to be less than a preset power, and the preset power may be the rated power of the load when the underwater robot operates normally underwater. When the depth data is greater than 0 meters, the processing unit 10 determines that the underwater robot is powered on in the water, and then continues to receive depth data from the depth sensor.
[0111] For example, the load of the underwater robot may include a lighting lamp, a motor, a sonar, and a DVL (Doppler VelocityLog). The processing unit 10 issues a load control instruction to each load to control the power of the load of the underwater robot to be less than a preset power. For example, the processing unit 10 issues a motor control instruction to control the motor speed to a low speed; the processing unit 10 controls the issuance of a lighting lamp control instruction to control the brightness of the lighting lamp to a lower brightness; the processing unit 10 issues a sonar control instruction to control the sonar to be directly turned off; the processing unit 10 issues a DVL control instruction to control the DVL to be directly turned off. By controlling the operating power of the load of the underwater robot in the air, the heat generated by the load in the air is limited, and the problem of overheating and damage of some high-power loads in the air is avoided.
[0112] The technical solution of the present application determines the power-on environment of the underwater robot and limits the power of some high-power loads of the underwater robot when the underwater robot is in the air, thereby controlling the heat generated by the high-power loads of the underwater robot when running in the air and avoiding the problem of overheating and damage of the high-power loads in the air.
[0113] According to one aspect of the present application, the present application provides an underwater robot, which includes the control device as described above, and the underwater robot also includes at least two switches, and the at least two switches generate at least two power-on signals in response to a power-on instruction.
[0114] According to one aspect of the present application, the present application provides a non-volatile computer-readable storage medium on which a computer program is stored, and the computer program can implement the method for determining the startup environment of the underwater robot as described above.
[0115] According to one aspect of the present application, the present application provides a non-volatile computer-readable storage medium having a computer program stored thereon, which can implement the calibration control method of the depth sensor of the underwater robot as described above.
[0116] According to one aspect of the present application, the present application provides a non-volatile computer-readable storage medium on which a computer program is stored, and the computer program can implement the method for controlling the load power of the underwater robot as described above.
[0117] According to one aspect of the present application, the present application provides an electronic device for judging the startup environment of an underwater robot, comprising: one or more processors; a storage device for storing one or more programs, which, when the one or more programs are executed by one or more processors, enables the one or more processors to implement the method for judging the startup environment of an underwater robot as described above.
[0118] According to one aspect of the present application, the present application provides an electronic device for calibration control of a depth sensor of an underwater robot, comprising: one or more processors; a storage device for storing one or more programs, which, when the one or more programs are executed by one or more processors, enables the one or more processors to implement the calibration control method of the depth sensor of the underwater robot as described above.
[0119] According to one aspect of the present application, the present application provides an electronic device for controlling the load power of an underwater robot, comprising: one or more processors; a storage device for storing one or more programs, which, when the one or more programs are executed by one or more processors, enables the one or more processors to implement the method for controlling the load power of the underwater robot as described above.
[0120] Finally, it should be noted that the above is only a preferred embodiment of the present application and is not intended to limit the present application. Although the present application is described in detail with reference to the aforementioned embodiments, those skilled in the art can still modify the technical solutions of the aforementioned embodiments or replace some of the technical features therein by equivalents. Any modification, equivalent replacement, improvement, etc. made within the spirit and principles of the present application shall be included in the protection scope of the present application.
Claims
1. A method for determining the startup environment of an underwater robot, characterized in that: include: In response to a power-on instruction, detecting levels of at least two power-on signals; The power-on environment of the underwater robot is determined according to the time difference between the changes in the levels of the at least two power-on signals.
2. The determination method according to claim 1, characterized in that: The underwater robot comprises at least two switches; In response to the power-on instruction, detecting the levels of at least two power-on signals includes: In response to the power-on instruction, levels of the at least two power-on signals generated by the at least two switches are detected.
3. The determination method according to claim 2, characterized in that: The step of judging the power-on environment of the underwater robot according to the time difference of the level changes of the at least two power-on signals comprises: When the changed time difference satisfies a first preset condition, it is determined that the startup environment is that the underwater robot is in the air; When the changed time difference satisfies a second preset condition, it is determined that the startup environment is that the underwater robot is in liquid.
4. A calibration control method for a depth sensor of an underwater robot, characterized in that: include: In response to a power-on instruction, detecting levels of at least two power-on signals; When it is determined according to the time difference between the changes in the levels of the at least two power-on signals that the power-on environment of the underwater robot meets the preset environmental conditions, a calibration instruction is sent to the depth sensor.
5. The calibration control method according to claim 4, characterized in that: The preset environmental condition is that the underwater robot is in the air.
6. A method for controlling the load power of an underwater robot, characterized in that: include: In response to a power-on instruction, detecting levels of at least two power-on signals; According to the time difference between the changes in the levels of the at least two power-on signals, it is determined that when the power-on environment meets the preset environmental conditions, a calibration instruction is sent to the depth sensor of the underwater robot; According to the data sent by the calibrated depth sensor, when it is determined that the startup environment meets the preset environmental conditions, a load control instruction is issued to control the power of the load of the underwater robot to be less than the preset power.
7. The control method according to claim 6, characterized in that: The preset environmental condition is that the underwater robot is in the air.
8. A control device for an underwater robot, characterized in that: include: The processing unit detects the levels of at least two power-on signals, and determines the power-on environment of the underwater robot according to the time difference between the changes in the levels of the at least two power-on signals.
9. The control device according to claim 8, wherein the underwater robot comprises a depth sensor, characterized in that: When the changed time difference satisfies a first preset condition, the processing unit determines that the startup environment is that the underwater robot is in the air, and issues a calibration instruction to calibrate the depth sensor.
10. The control device according to claim 9, characterized in that: The processing unit determines, based on the data sent by the calibrated depth sensor, that when the startup environment meets the preset environmental conditions, it issues a load control instruction to control the load power of the underwater robot to be less than the preset power.
11. An underwater robot, characterized in that: Including any control device as described in claims 8-10, the underwater robot also includes at least two switches, which generate at least two power-on signals in response to a power-on instruction.
12. A non-volatile computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the method according to any one of claims 1 to 7 is implemented.
13. An electronic device, characterized in that: include: one or more processors; A storage device for storing one or more programs; When the one or more programs are executed by the one or more processors, the one or more processors implement the method according to any one of claims 1 to 7.
