Speed adjustment method, device, self-mobile device and computer-readable storage medium
By obtaining the current current of the snowplow working motor and using a preset algorithm to adjust the speed of the walking motor, the overload problem of the snowplow when there is a lot of snow is solved, efficiency and stability are improved, and flexible speed adjustment is achieved.
Patent Information
- Application Number
- CN202311477083.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2023-10-24
- Filing Date
- 2023-11-07
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2043-11-07
AI Technical Summary
The existing snowplowers are prone to the snow-rolling motor being blocked or unable to push the snow when there is a lot of snow, resulting in overload, affecting the snow-pumping efficiency and balance, and the motor is unstable and cannot dynamically adjust the speed according to the working conditions. Reduces flexibility in speed adjustment.
By obtaining the current current of the working motor, determining the first speed value using the preset speed adjustment algorithm, adjusting the working current of the walking motor, so that the walking speed of the snowplow adapts to the current changes, thereby improving the flexibility of speed adjustment and avoiding overload conditions. , improve work efficiency and stability.
It realizes flexible adjustment of snow sweeper speed, avoids overload, improves snow sweeping efficiency, balance and motor operation stability, while reducing power consumption.
Smart Images

Figure CN117644773B_ABST
Abstract
Description
[0001] This application claims priority to the Chinese patent application filed with the State Intellectual Property Office of China on October 24, 2023, with application number 202311389330.X and application name “Speed adjustment method, device, self-mobile device and computer-readable storage medium”, the entire contents of which are incorporated by reference in this application. Technical Field
[0002] The present application relates to the technical field of self-moving equipment, and in particular to a speed adjustment method, device, self-moving equipment and computer-readable storage medium. Background Art
[0003] With the development of science and technology, self-moving devices are gradually known to people, and more and more self-moving devices are used in people's daily work and life, such as snowplows. Snowplows are equipped with snow rolling shovels and walking devices, which correspond to snow rolling motors and walking motors respectively. When there is a lot of snow, the snow rolling motor will be blocked or unable to push the snow, and the snowplow will slip. At this time, the snowplow will be overloaded, which will not only affect the efficiency and balance of snow removal, but also damage the operation of the motor, and waste the electrical energy in the robot.
[0004] At present, the parameters of the snow rolling motor and the travel motor in the snowplow are not dynamically adjusted. The snowplow travels at a constant speed, which may cause excessive load and frequent overcurrent of the snow rolling / travel motor, which will affect the snow removal efficiency and the stability of the machine operation. It can be seen that the self-moving device can only work according to the speed set by the user, and cannot adjust the operating speed according to the working situation, which reduces the flexibility of speed adjustment. Summary of the invention
[0005] The embodiments of the present application disclose a speed adjustment method, an apparatus, a self-mobile device, and a computer-readable storage medium, which are used to improve the flexibility of speed adjustment.
[0006] In a first aspect, an embodiment of the present application discloses a speed adjustment method, which is applied to a self-moving device, wherein the self-moving device includes a walking motor and a working motor, including:
[0007] Obtaining the current of the working motor;
[0008] Determine a first speed value using a preset speed adjustment algorithm according to the current current;
[0009] The working current of the travel motor is adjusted so that the travel speed of the self-moving device is equal to the first speed value.
[0010] In a second aspect, an embodiment of the present application discloses a speed adjustment device, which is applied to a self-moving device, wherein the self-moving device includes a walking motor and a working motor, including:
[0011] An acquisition unit, used for acquiring the current current of the working motor;
[0012] a determining unit, configured to determine a first speed value using a preset speed adjustment algorithm according to the current current;
[0013] The adjustment unit is used to adjust the working current of the walking motor so that the walking speed of the self-moving device is the first speed value.
[0014] In a third aspect, an embodiment of the present application discloses a self-moving device, including a walking motor, a working motor and a processor, wherein the processor controls the walking motor according to the working motor to implement the method disclosed in the first aspect.
[0015] In a fourth aspect, an embodiment of the present application discloses a computer-readable storage medium, on which a computer program or computer instructions are stored. When the computer program or computer instructions are executed by a processor, the method disclosed in the first aspect above is implemented.
[0016] In an embodiment of the present application, a self-moving device including a walking motor and a working motor obtains the current current of the working motor, determines a first speed value based on the current current of the working motor using a preset speed adjustment algorithm, and adjusts the working current of the walking motor so that the walking speed of the self-moving device is the first speed value. It can be seen that the walking speed of the self-moving device can be adjusted according to the current of the working motor of the self-moving device, thereby improving the flexibility of speed adjustment. In addition, the walking speed of the self-moving device can be adjusted according to the current of the working motor of the self-moving device, which can avoid the overload of the self-moving device, thereby improving the working efficiency, balance and stability of the self-moving device, and reducing the power consumption of the self-moving device. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] 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 those skilled in the art, other drawings can be obtained based on these drawings without creative work.
[0018] Figure 1 It is a flow chart of a speed adjustment method disclosed in an embodiment of the present application;
[0019] Figure 2 It is a schematic diagram of a process of obtaining the current current of a triggering working motor disclosed in an embodiment of the present application;
[0020] Figure 3 It is a schematic diagram of the principle of a PID algorithm disclosed in an embodiment of the present application;
[0021] Figure 4 It is a schematic diagram of a process of determining a first speed value using a PID algorithm disclosed in an embodiment of the present application;
[0022] Figure 5 It is a structural schematic diagram of a speed adjustment device disclosed in an embodiment of the present application;
[0023] Figure 6 It is a structural schematic diagram of a self-moving device disclosed in an embodiment of the present application. DETAILED DESCRIPTION
[0024] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application.
[0025] The embodiments of the present application disclose a speed adjustment method, device, self-mobile device and computer-readable storage medium, which are used to improve the flexibility of speed adjustment.
[0026] In order to better understand the embodiments of the present application, the relevant technologies of the present application are first introduced below.
[0027] With the development of science and technology, self-moving devices are gradually known to people, and more and more self-moving devices are used in people's daily work and life, such as snowplows. Snowplows are equipped with snow rolling shovels and walking devices, which correspond to snow rolling motors and walking motors respectively. When there is a lot of snow, the snow rolling motor will be blocked or unable to push the snow, and the snowplow will slip. At this time, the snowplow will be overloaded, which will not only affect the efficiency and balance of snow removal, but also damage the operation of the motor, and waste the electrical energy in the robot.
[0028] At present, the parameters of the snow rolling motor and the travel motor in the snowplow are not dynamically adjusted. The snowplow travels at a constant speed, which may cause excessive load and frequent overcurrent of the snow rolling / travel motor, which will affect the snow removal efficiency and the stability of the machine operation. It can be seen that the self-moving device can only work according to the speed set by the user, and cannot adjust the operating speed according to the working situation, which reduces the flexibility of speed adjustment.
[0029] In order to solve the above problem, a self-moving device including a walking motor and a working motor obtains the current current of the working motor, determines a first speed value according to the current current of the working motor using a preset speed adjustment algorithm, adjusts the working current of the walking motor, and adjusts the walking speed of the self-moving device to the first speed value. It can be seen that the walking speed of the self-moving device can be adjusted according to the current of the working motor of the self-moving device, thereby improving the flexibility of speed adjustment.
[0030] See also Figure 1 , Figure 1 1 is a flow chart of a speed adjustment method disclosed in an embodiment of the present application. The speed adjustment method can be applied to a self-moving device, which includes a walking motor and a working motor. Figure 1 As shown, the speed adjustment method may include the following steps.
[0031] 101. Get the current of the working motor.
[0032] The self-moving device is provided with a walking motor and a working motor. The walking motor is a motor that controls the walking or movement of the self-moving device. The working motor is a motor that controls the work of the self-moving device. It should be understood that the work of the self-moving device here does not include the walking or movement of the self-moving device, but refers to work other than walking or movement. The function of the working motor may be different for different types of self-moving devices. For example, in the case where the self-moving device is a snow sweeper, the working motor is a snow rolling motor; in the case where the self-moving device is a lawn mower, the working motor is a lawn mowing motor; in the case where the self-moving device is a leaf blowing robot, the working motor is a blowing motor. The number of working motors of the self-moving device may be one or more.
[0033] The mobile device can obtain the current current of the working motor in real time, periodically, or under certain conditions. The current current of the working motor is the current working current of the working motor.
[0034] In some embodiments, when the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device, the self-moving device can obtain the current current of the working motor. The minimum walking speed of the self-moving device is the stored minimum walking speed of the self-moving device. Exemplarily, the minimum walking speed of the self-moving device can be 0.01m / s, or other values.
[0035] In some embodiments, when the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device, the self-moving device may first determine the difference between the absolute value of the current walking speed of the self-moving device and the second speed value, and then when the difference is less than the speed threshold, the second speed value may be determined as the first speed value; when the difference is not less than the speed threshold and the absolute value of the current walking speed of the self-moving device is greater than the second speed value, the difference between the absolute value of the current walking speed of the self-moving device and the speed threshold may be determined as the first speed value; when the difference is not less than the speed threshold and the absolute value of the current walking speed of the self-moving device is not greater than the second speed value, the sum of the absolute value of the current walking speed of the self-moving device and the speed threshold may be determined as the first speed value. The second speed value is a preset walking speed value of the self-moving device.
[0036] The current walking speed of the self-moving device may include the current walking direction of the self-moving device and the current walking speed value of the self-moving device. The current walking direction of the self-moving device may be forward or backward. The current walking direction of the self-moving device may be indicated by positive and negative. When the current walking direction of the self-moving device is forward, it is positive; when the current walking direction of the self-moving device is backward, it is negative. For example, assuming that the current walking speed of the self-moving device is -0.3m / s, - indicates that the current walking direction is backward, 0.3m / s indicates the current walking speed value of the self-moving device, and -0.3m / s indicates that the self-moving device is moving backward at a speed of 0.3m / s. The current walking speed value of the self-moving device may be the absolute value of the current walking speed of the self-moving device.
[0037] The minimum walking speed of the self-contained device is in the forward direction.
[0038] The self-moving device can first obtain the current walking speed of the self-moving device, and then determine whether the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device. If it is determined that the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device, it indicates that the self-moving device is moving forward, and the current current of the working motor can be obtained. If it is determined that the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device, the difference between the absolute value of the current walking speed of the self-moving device and the second speed value can be determined, and then it can be determined whether the difference is less than the speed threshold. If it is determined that the difference is less than the speed threshold, it indicates that the difference between the current walking speed value of the self-moving device and the second speed is small, and the second speed value can be directly determined as the first speed value. In the case where it is determined that the difference is not less than (i.e., greater than or equal to) the speed threshold, it indicates that the difference between the current walking speed value of the self-moving device and the second speed value is large, and it can be determined whether the absolute value of the current walking speed of the self-moving device is greater than the second speed value. In the case where it is determined that the absolute value of the current walking speed of the self-moving device is greater than the second speed value, it indicates that the current walking speed value of the self-moving device is greater than the second speed value, and the difference between the absolute value of the current walking speed of the self-moving device and the speed threshold can be determined as the first speed value, that is, the walking speed value of the self-moving device is reduced so that the walking speed value of the self-moving device is close to the second speed value. In the case where it is determined that the absolute value of the current walking speed of the self-moving device is not greater than (i.e., less than or equal to) the second speed value, it indicates that the current walking speed value of the self-moving device is less than the second speed value, and the sum of the absolute value of the current walking speed of the self-moving device and the speed threshold can be determined as the first speed value, that is, the walking speed value of the self-moving device is increased so that the walking speed value of the self-moving device is close to the second speed value.
[0039] In some embodiments, when it is determined that the current walking speed of the mobile device is less than the minimum walking speed of the mobile device, it may also be determined whether the current walking speed of the mobile device is less than the maximum negative walking speed of the mobile device. When it is determined that the current walking speed of the mobile device is less than the maximum negative walking speed of the mobile device, it indicates that the current walking speed value is greater than the stored maximum walking speed value for backward movement, and the current walking speed of the mobile device may be set to the maximum negative walking speed of the mobile device so as to update the stored maximum negative walking speed. The maximum negative walking speed of the mobile device is the maximum walking speed of the mobile device stored in the mobile device for backward movement. It can be seen that the maximum negative walking speed of the mobile device is not fixed. Exemplarily, the maximum negative walking speed of the mobile device may be -0.3m / s, -0.4m / s, or other values.
[0040] Only when it is determined that the current walking speed of the mobile device is not less than (i.e., greater than or equal to) the maximum negative walking speed of the mobile device, or after the current walking speed of the mobile device is set to the maximum negative walking speed of the mobile device, can the difference between the absolute value of the current walking speed of the mobile device and the second speed value be determined.
[0041] In some embodiments, when the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device, the time difference value may be determined according to the current time and the previous timestamp.
[0042] In the case where the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device, the time difference can be directly determined based on the current time and the previous timestamp, or it can be first determined whether the second speed value is greater than the maximum walking speed of the self-moving device. When it is determined that the second speed value is greater than the maximum walking speed of the self-moving device, due to the limitation of the maximum walking speed of the self-moving device, the walking speed of the self-moving device cannot reach the second speed value, and therefore, the second speed value can be determined as the maximum walking speed of the self-moving device. In the case where it is determined that the second speed value is not greater than (i.e., less than or equal to) the maximum walking speed of the self-moving device, it indicates that the walking speed of the self-moving device can reach the second speed value, and then the time difference can be determined based on the current time and the previous timestamp.
[0043] After the mobile device determines the time difference according to the current time and the previous timestamp, the current current of the working motor can be obtained.
[0044] In some embodiments, it can be determined whether there is an obstacle. If it is determined that there is an obstacle, the working current of the travel motor can be adjusted to make the travel speed of the self-moving device 0. If it is determined that there is no obstacle, the current current of the working motor can be obtained.
[0045] Before adjusting the speed, the self-moving device can first determine whether there is an obstacle. If it is determined that there is an obstacle, it means that if the self-moving device continues to move in the original direction, the self-moving device may collide with the obstacle. In order to avoid collision between the self-moving device and the obstacle, in one case, the self-moving device can adjust the working current of the walking motor so that the walking speed of the self-moving device is 0, even if the self-moving device stops walking; in another case, the self-moving device can bypass the obstacle, so as to avoid collision between the self-moving device and the obstacle without affecting the operation of the self-moving device. In the case of determining that there is no obstacle, the current current of the working motor can be directly obtained, and the current walking speed of the self-moving device can also be obtained, and then it can be determined whether the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device.
[0046] It should be understood that the above different embodiments can be freely combined. Figure 2 , Figure 2 This is a schematic diagram of a process for obtaining the current current of a triggering working motor disclosed in an embodiment of the present application. Figure 2 This is a case where the above different embodiments are combined. Figure 2 As shown, the process may include the following steps.
[0047] A1. Determine whether there is an obstacle. If there is an obstacle, execute step A2; if there is no obstacle, execute step A3.
[0048] A2. Adjust the working current of the travel motor so that the travel speed of the self-moving device is 0.
[0049] A3. Determine whether the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device. If the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device, execute step A4; if the current walking speed of the self-moving device is not less than (i.e., greater than or equal to) the minimum walking speed of the self-moving device, execute step A11.
[0050] A4. Determine whether the current walking speed of the self-moving device is less than the maximum negative walking speed of the self-moving device. If the current walking speed of the self-moving device is less than the maximum negative walking speed of the self-moving device, execute step A5; if the current walking speed of the self-moving device is not less than the maximum negative walking speed of the mobile device, execute step A6.
[0051] A5. Set the current walking speed of the self-moving device to the maximum negative walking speed of the self-moving device.
[0052] A6. Determine whether the difference between the absolute value of the current walking speed of the self-moving device and the second speed value is less than the speed threshold. If the difference between the absolute value of the current walking speed of the self-moving device and the second speed value is less than the speed threshold, execute step A7; if the difference between the absolute value of the current walking speed of the self-moving device and the second speed value is not less than the speed threshold, execute step A8.
[0053] A7. Determine the second speed value as the first speed value.
[0054] A8. Determine whether the absolute value of the current walking speed of the self-moving device is greater than the second speed value. If the absolute value of the current walking speed of the self-moving device is greater than the second speed value, execute step A9; if the absolute value of the current walking speed of the self-moving device is not greater than the second speed value, execute step A10.
[0055] A9. Determine the difference between the absolute value of the current walking speed of the mobile device and the speed threshold as the first speed value.
[0056] A10. Determine the sum of the absolute value of the current walking speed of the mobile device and the speed threshold as the first speed value.
[0057] A11. Determine whether the second speed value is greater than the maximum walking speed of the self-moving device. If the second speed value is greater than the maximum walking speed of the self-moving device, execute step A12. If the second speed value is not greater than the maximum walking speed of the self-moving device, execute step A13.
[0058] A12. Set the second speed value to the maximum walking speed of the mobile device.
[0059] A13. Determine the time difference based on the current time and the previous timestamp.
[0060] A14. Get the current of the working motor.
[0061] The self-moving device can determine in real time or periodically whether there is an obstacle. When it is determined that there is an obstacle, the self-moving device can adjust the working current of the walking motor to make the walking speed of the self-moving device 0, that is, reduce the walking speed of the self-moving device to 0; the self-moving device can also bypass the obstacle.
[0062] Determining whether there is an obstacle by the mobile device can be understood as determining whether there is an obstacle in front of the mobile device. The mobile device can detect whether there is an obstacle in front of the front through a sensor installed in front of the machine; wherein the sensor includes but is not limited to an image sensor, a laser sensor, a millimeter wave sensor, and an infrared sensor.
[0063] The obstacle can be a living obstacle or an inanimate obstacle. When it is determined that there is a living obstacle, the working current of the travel motor can be directly adjusted to make the travel speed of the self-moving device 0, or the obstacle can be directly bypassed. When it is determined that there is an inanimate obstacle, it can continue to determine whether the travel line speed of the self-moving device is greater than 0. When it is determined that the travel line speed of the self-moving device is greater than 0, the working current of the travel motor can be adjusted to make the travel speed of the self-moving device 0; or the obstacle can be bypassed.
[0064] When it is determined that there is no obstacle, or after bypassing the obstacle, or when it is determined that the linear speed of the self-moving device is equal to 0, the speed threshold can be obtained, and the current walking speed of the self-moving device can be determined. The speed threshold is a preset value. Exemplarily, the speed threshold can be 0.3m / s, or other values, which are not limited here. The current walking speed of the self-moving device is the speed at which the self-moving device is currently walking.
[0065] For example, in the case where the self-moving device walks by rolling the wheels, if the self-moving device includes two left and right wheels, the current walking speed of the self-moving device may be the average of the linear speeds of the two wheels. It should be understood that this example is an exemplary description of determining the current walking speed of the self-moving device and does not constitute a limitation thereto.
[0066] After that, it can be further determined whether the current walking speed of the mobile device is less than the minimum walking speed of the mobile device. When it is determined that the current walking speed of the mobile device is less than the minimum walking speed of the mobile device, it can be further determined whether the current walking speed of the mobile device is less than the maximum negative walking speed of the mobile device. When it is determined that the current walking speed of the mobile device is less than the maximum walking speed of the mobile device, it indicates that the current walking speed value is greater than the stored maximum walking speed value for backward movement. The current walking speed of the mobile device can be set to the maximum negative walking speed of the mobile device so as to update the stored maximum negative walking speed. The maximum negative walking speed of the mobile device is the maximum walking speed of the mobile device for backward movement stored in the mobile device. It can be seen that the maximum negative walking speed of the mobile device is not fixed. Exemplarily, the maximum negative walking speed of the mobile device can be -0.3m / s, -0.4m / s, or other values.
[0067] In the case where it is determined that the current walking speed of the self-mobile device is not less than (i.e., greater than or equal to) the maximum negative walking speed of the self-mobile device, or after the current walking speed of the self-mobile device is set to the maximum negative walking speed of the self-mobile device, the difference between the absolute value of the current walking speed of the self-mobile device and the second speed value can be determined, and it can be determined whether the difference between the absolute value of the current walking speed of the self-mobile device and the second speed value is less than the speed threshold. In the case where it is determined that the difference between the absolute value of the current walking speed of the self-mobile device and the second speed value is less than the speed threshold, it indicates that the difference between the current walking speed value of the self-mobile device and the second speed value is small, and the second speed value can be directly determined as the first speed value, and then step 103 can be executed. The second speed value is a preset walking speed value of the self-mobile device.
[0068] In the case where it is determined that the difference between the absolute value of the current walking speed of the mobile device and the second speed value is not less than (greater than or equal to) the speed threshold, it indicates that the difference between the current walking speed value of the mobile device and the second speed value is large, and it can be determined whether the absolute value of the current walking speed of the mobile device is greater than the second speed value. In the case where it is determined that the absolute value of the current walking speed of the mobile device is greater than the second speed value, the difference between the absolute value of the current walking speed of the mobile device and the speed threshold can be determined as the first speed value, that is, the difference between the current walking speed value of the mobile device and the second speed value is large, and the current walking speed value of the mobile device is greater than the second speed value, the walking speed value of the mobile device can be reduced so that the walking speed value of the mobile device is close to the second speed value. In the case where it is determined that the absolute value of the current walking speed of the mobile device is less than the second speed value, the sum of the absolute value of the current walking speed of the mobile device and the speed threshold can be determined as the first speed value, that is, the difference between the current walking speed value of the mobile device and the second speed value is large, and the current walking speed value of the mobile device is less than the second speed value, the walking speed value of the mobile device can be increased so that the walking speed value of the mobile device is close to the second speed value. It can be seen that when the difference between the current walking speed value of the self-moving device and the second speed value is large, the walking speed value of the self-moving device can be adjusted to make the walking speed value of the self-moving device close to the second speed value, rather than adjusting it to the second speed value at one time, so that the speed can be adjusted in stages. The walking speed value can be understood as the value of the walking speed.
[0069] In one case, the difference between the absolute value of the current walking speed of the self-moving device and the second speed value may be directly compared with the speed threshold. In another case, the absolute value of the difference between the absolute value of the current walking speed of the self-moving device and the second speed value may be first determined, and then the absolute value of the difference may be compared with the speed threshold. In this case, step A6 may be replaced by: determining whether the absolute value of the difference between the absolute value of the current walking speed of the self-moving device and the second speed value is less than the speed threshold, and if the absolute value of the difference between the absolute value of the current walking speed of the self-moving device and the second speed value is less than the speed threshold, executing step A7, and if the difference between the absolute value of the current walking speed of the self-moving device and the second speed value is not less than the absolute value of the speed threshold, executing step A8.
[0070] In the case where it is determined that the current walking speed of the self-mobile device is not less than (i.e., greater than or equal to) the minimum walking speed of the self-mobile device, it can be further determined whether the second speed value is greater than the maximum walking speed of the self-mobile device. In the case where it is determined that the second speed value is greater than the maximum walking speed of the self-mobile device, due to the limitation of the maximum walking speed of the self-mobile device, the walking speed of the self-mobile device cannot reach the second speed value, therefore, the second speed value can be set to the maximum walking speed of the self-mobile device. In the case where it is determined that the second speed value is not greater than (i.e., less than or equal to) the maximum walking speed of the self-mobile device, or after the second speed value is set to the maximum walking speed of the self-mobile device, it indicates that the walking speed of the self-mobile device can reach the second speed value, and the time difference can be determined according to the current time and the last timestamp, and the last timestamp can be updated to the current time. Then the current current of the working motor can be obtained. The maximum walking speed of the self-mobile device is the maximum walking speed of the self-mobile device stored by the self-mobile device. It can be seen that the maximum walking speed of the self-mobile device is not fixed. Exemplarily, the maximum walking speed of the self-mobile device can be 0.3m / s, 0.4m / s, or other values.
[0071] It should be understood that Figure 2 The process shown is an exemplary description of the triggering conditions for obtaining the current current of the working motor, and does not limit the specific triggering conditions. Exemplarily, step A1 and step A2 may not be executed. Exemplarily, step A3-step A10 may not be executed. At this time, if the judgment result of step A1 is no, step A11 may be executed directly. Exemplarily, step A4 and step A5 may not be executed. At this time, if the judgment result of step A3 is yes, step A6 may be executed directly. Exemplarily, step A11 and step A12 may not be executed. At this time, if the judgment result of step A3 is no, step A13 may be executed directly. Exemplarily, step A13 may not be executed. Exemplarily, step A3-step A13 may not be executed. Exemplarily, step A3-step A13 may not be executed. At this time, if the judgment result of step A1 is no, step A14 may be executed directly. Exemplarily, step A1-step A13 may not be executed.
[0072] like Figure 2As shown, when the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device, the difference between the absolute value of the current walking speed of the self-moving device and the second speed value can also be determined. When the difference is less than the speed threshold, the second speed value can be determined as the first speed value; when the difference is not less than the speed threshold, and the absolute value of the current walking speed of the self-moving device is greater than the second speed value, the difference between the absolute value of the current walking speed of the self-moving device and the speed threshold can be determined as the first speed value; when the difference is not less than the speed threshold, and the absolute value of the current walking speed of the self-moving device is not greater than the second speed value, the sum of the absolute value of the current walking speed of the self-moving device and the speed threshold can be determined as the first speed value. After determining the first speed value, step 103 can be performed.
[0073] It can be seen that the first speed value can be determined by step 102 or by the above method. In different situations, the method of determining the first speed value is different. In the case where the preset speed adjustment algorithm is satisfied, the first speed value can be determined by the preset speed adjustment algorithm. In the case where the preset speed adjustment algorithm is not satisfied, the first speed value can be determined by other methods, which can ensure that the speed can be adjusted in different situations and improve the flexibility of speed adjustment. In addition, the scope of application of speed adjustment can be improved, which can avoid the situation where the speed can only be adjusted in one situation and cannot be adjusted in other situations.
[0074] In some embodiments, the speed value of the travel motor can also be adjusted according to the environmental information, that is, step 101-step 103 is executed. In the case where the self-moving device is a snowplow, the thickness of the snow can be determined, and then the travel speed value of the snowplow can be adjusted according to the thickness of the snow. The thickness of the snow can be determined by sensors such as visual sensors and radars, or by the load of the snow rolling shovel corresponding to the snow rolling motor. The thickness of the snow can be determined before using the snowplow to clear the snow, or during the process of using the snowplow to clear the snow.
[0075] 102. Determine a first speed value using a preset speed adjustment algorithm according to a current current of the working motor.
[0076] After the current current of the working motor is obtained, the first speed value can be determined using a preset speed adjustment algorithm according to the current current of the working motor. The preset speed adjustment algorithm can be a proportional integral derivative (PID) algorithm or other algorithms.
[0077] In some embodiments, during the movement of the self-moving device, it can be determined whether the self-moving device needs to turn or make a turn. If it is determined that the self-moving device does not need to turn or make a turn, step 102 is executed. If it is determined that the self-moving device needs to turn or make a turn, since the self-moving device has a slow turning speed when turning on the spot, there is no problem of overcurrent in the working motor, that is, there is no need to adjust the parameters, and therefore, step 102 is not executed.
[0078] In some embodiments, the self-moving device can determine the speed adjustment ratio using a preset speed adjustment algorithm according to the current current of the working motor, and can determine the first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device.
[0079] In some embodiments, when the speed adjustment ratio is greater than or equal to 0, and the current current of the working motor is greater than the starting current of the working motor or the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device, the first speed value can be determined according to the speed adjustment ratio and the current walking speed of the self-moving device.
[0080] In some embodiments, when the speed adjustment ratio is less than 0, the first speed value can be determined according to the minimum walking speed of the self-moving device. When the speed adjustment ratio is greater than or equal to 0, the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting walking speed of the self-moving device, and the current walking speed of the self-moving device is less than the starting speed of the self-moving device, the second speed value can be determined as the first speed value. When the speed adjustment ratio is greater than or equal to 0, the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting walking speed of the self-moving device, and the current walking speed of the self-moving device is not less than the starting speed of the self-moving device, the starting speed of the self-moving device can be determined as the first speed value.
[0081] The self-moving device can first determine the speed adjustment ratio according to the current current of the working motor using a preset speed adjustment algorithm. After that, the self-moving device can directly determine the first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device, or it can first determine whether the speed adjustment ratio is less than 0. When it is determined that the speed adjustment ratio is greater than or equal to (i.e. not less than) 0, it can be determined whether the current current of the working motor is greater than the starting current of the working motor, or whether the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device or the ratio of the starting walking speed of the self-moving device to the speed adjustment ratio. When it is determined that the current current of the working motor is greater than the starting current of the working motor, or the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device or the ratio of the starting walking speed of the self-moving device to the speed adjustment ratio, the first speed value can be determined according to the speed adjustment ratio and the current walking speed of the self-moving device. When it is determined that the speed adjustment ratio is less than 0, the self-moving device can determine the first speed value according to the minimum walking speed of the self-moving device. When it is determined that the current current of the working motor is not greater than (i.e., less than or equal to) the starting current of the working motor, and the current walking speed of the self-moving device is not greater than (i.e., less than or equal to) the starting walking speed of the self-moving device or the ratio of the starting walking speed of the self-moving device to the speed adjustment ratio, it can be determined whether the current walking speed of the self-moving device is less than the starting speed of the self-moving device. When it is determined that the current walking speed of the self-moving device is less than the starting speed of the self-moving device, the second speed value can be determined as the first speed value. When it is determined that the current walking speed of the self-moving device is not less than the starting speed of the self-moving device, the starting speed of the self-moving device can be determined as the first speed value.
[0082] In some embodiments, the third speed value may be determined according to the speed adjustment ratio and the current walking speed of the self-moving device. When the third speed value is less than or equal to the second speed value and greater than or equal to the minimum walking speed of the self-moving device, the third speed value may be determined as the first speed value. When the third speed value is greater than the second speed value, the second speed value may be determined as the first speed value. When the third speed value is less than the minimum walking speed of the self-moving device, the first speed value may be determined according to the minimum walking speed of the self-moving device.
[0083] The self-moving device may first determine the third speed value according to the speed adjustment ratio and the current walking speed of the self-moving device. After that, the self-moving device may directly determine the third speed value as the first speed value, or may first determine whether the third speed value is greater than the second speed value. In the case where the third speed value is less than or equal to (i.e., not greater than) the second speed value, it may continue to determine whether the third speed value is less than the minimum walking speed of the self-moving device. In the case where it is determined that the third speed value is greater than or equal to the minimum walking speed of the self-moving device, the third speed value may be determined as the first speed value. In the case where it is determined that the third speed value is greater than the second speed value, the second speed value may be determined as the first speed value. In the case where the third speed value is less than the minimum walking speed of the self-moving device, the first speed value may be determined according to the minimum walking speed of the self-moving device.
[0084] In some embodiments, when the time difference is greater than 0 and less than or equal to 1, the first speed value may be determined using a preset speed adjustment algorithm according to the current current of the working motor. When the time difference is equal to 0, the second speed value may be determined as the first speed value.
[0085] After obtaining the current current of the working motor, the first speed value can be determined directly according to the current current of the working motor using a preset speed adjustment algorithm; or it can be determined first whether the current current of the working motor is equal to 0. If it is determined that the current current of the working motor is not equal to 0, it can be determined whether the time difference is greater than 1. If it is determined that the time difference is less than or equal to (i.e., not greater than) 1, the first speed value can be determined according to the current current of the working motor using a preset speed adjustment algorithm. If it is determined that the time difference is equal to 0, the second speed value can be determined as the first speed value.
[0086] It should be understood that the above different embodiments can be freely combined, and the specific combination is not limited.
[0087] The following is an explanation using the preset speed adjustment algorithm as the PID algorithm as an example.
[0088] When the preset speed adjustment algorithm is a PID algorithm, the first speed value may be determined using the PID algorithm according to the current current, the steady-state current of the working motor, and the current control range of the working motor.
[0089] The steady-state current of the working motor is the value required to stabilize the current of the working motor. PID control is to stabilize the current of the working motor to a stable value, and the steady-state current of the working motor is this value.
[0090] The current control range of the working motor is the current range in which the current of the working motor needs to be stable. For example, when the self-moving device is working, the current of the working motor can be stabilized in the range of (0,30A], and the current control range of the working motor is 30A. For example, when the self-moving device is working, the current of the working motor can be stabilized in the range of (10,30A], and the current control range of the working motor is 20A.
[0091] See also Figure 3 , Figure 3 Schematic diagram of the principle of a PID algorithm disclosed in the embodiment of the present application. Figure 3 As shown, the output U(t) of the PID algorithm can be expressed as follows:
[0092]
[0093] Among them, E(t) represents the ratio, represents the integral of the proportion, Represents the differential of the ratio, K p Represents the proportionality coefficient, K i Indicates the integral coefficient, K d represents the differential coefficient, and dt represents the time difference.
[0094] It can be seen that the output of the PID algorithm is the weighted sum of proportion, integration and differentiation.
[0095] The speed adjustment ratio may be first determined using a PID algorithm according to the current current of the working motor, and then the first speed value may be determined according to the speed adjustment ratio and the current walking speed of the self-moving device.
[0096] When determining the speed adjustment ratio, the proportional result of the PID algorithm can be determined based on the current current of the working motor first, and then the differential result of the PID algorithm can be determined based on the proportional result of the PID algorithm, and the integral result of the PID algorithm can be determined based on the proportional result of the PID algorithm, and then the speed adjustment ratio can be determined based on the proportional result, differential result and integral result of the PID algorithm. The proportional result of the PID algorithm is the above E(t), and the integral result of the PID algorithm is the above The differential result of the PID algorithm is the above
[0097] Exemplarily, the proportional result E(t) of the PID algorithm can be expressed as follows:
[0098]
[0099] Among them, A represents the current current of the working motor, B represents the steady-state current of the working motor, C represents the current control range of the working motor, and D represents the power constant, which is a given value.
[0100] It should be understood that the above formula is an exemplary description of determining the proportional result of the PID algorithm according to the current current of the working motor, the steady-state current of the working motor and the current control range of the working motor, and does not constitute a limitation thereto. For example, various modified formulas of the above formula can be used to determine the proportional result of the PID algorithm according to the current current of the working motor, the steady-state current of the working motor and the current control range of the working motor.
[0101] In one case, the speed adjustment ratio may be U(t). In another case, the speed adjustment ratio may be 1-U(t). The speed adjustment ratio may be greater than 0, less than 0, or equal to 0.
[0102] The first speed value can be the product of the speed adjustment ratio and the absolute value of the current walking speed of the self-moving device, or it can be the ratio of the absolute value of the current walking speed of the self-moving device to the speed adjustment ratio, or it can be other values determined based on the speed adjustment ratio and the absolute value of the current walking speed of the self-moving device.
[0103] In some embodiments, after obtaining the current current of the working motor, it can be determined whether the current current of the working motor is within a threshold range. If it is determined that the current current of the working motor is within the threshold range, the first speed value can be determined using a PID algorithm based on the current current of the working motor. If it is determined that the current current of the working motor is outside the threshold range, no processing can be performed, or the current of the walking motor can be adjusted so that the walking speed of the self-moving device can be reduced to 0.
[0104] For example, assuming that the self-moving device is a snowplow, the current of the snow rolling motor when it is unloaded is 10A, and the current of the snow rolling motor when it is overcurrent is 60A. It is expected that the current can be stabilized within the range of 30A. When the current of the snow rolling motor is lower than 30A, and the walking speed of the intelligent motor has not reached the second speed value, the walking speed value of the self-moving device can be accelerated, and the smaller the current, the faster the speed increase. When the current of the snow rolling motor is within the range of 30A-50A, the walking speed value of the self-moving device can be reduced by controlling the current of the working motor, so that the current of the snow rolling motor can be stabilized at 30A, and the acceleration of the deceleration will be faster as the current is higher. When the current of the snow rolling motor exceeds 50A, the walking speed value of the self-moving device can be reduced to 0 so as to avoid the situation of overcurrent of the snow rolling motor. Since the walking speed value of the snowplow is reduced, the snow eaten per unit time will become less, and the snow that the snow rolling motor needs to throw out will also become less, thereby reducing the load of the snow rolling motor. At this time, the steady-state current of the working motor is 30A, the current control range of the working motor is 30A, and the threshold range is (0,50].
[0105] For example, see Figure 4 , Figure 4 : is a schematic diagram of a process for determining a first speed value using a PID algorithm disclosed in an embodiment of the present application. Figure 4 As shown, the process may include the following steps.
[0106] B1. Determine the proportional result of the PID algorithm based on the current current of the working motor.
[0107] B2. Determine the differential result of the PID algorithm based on the proportional result of the PID algorithm.
[0108] B3. Determine whether the time difference is equal to 0. If the time difference is equal to 0, execute step B4. If the time difference is greater than 0, execute step B5.
[0109] B4. Determine the second speed value as the first speed value.
[0110] B5. Determine whether the time difference is greater than 1. If the time difference is greater than 1, execute step B6. If the time difference is less than or equal to 1, execute step B7.
[0111] B6. Set the error result, differential result and integral result of the PID algorithm to 0.
[0112] B7. Determine the integral result of the PID algorithm based on the proportional result of the PID algorithm.
[0113] B8. Determine the speed adjustment ratio based on the proportional result, differential result and integral result of the PID algorithm.
[0114] B9. Determine whether the speed adjustment ratio is less than 0. If the speed adjustment ratio is less than 0, execute step B10. If the speed adjustment ratio is greater than or equal to 0, execute step B11.
[0115] B10. Determine a first speed value according to the minimum walking speed of the self-moving device.
[0116] B11. Determine whether the current current of the working motor is greater than the starting current of the working motor, or whether the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device or the ratio of the starting walking speed to the speed adjustment ratio. If the judgment is yes, execute step B12; if the judgment is no, execute step B18.
[0117] B12. Determine a third speed value according to the speed adjustment ratio and the current walking speed of the mobile device.
[0118] B13. Determine whether the third speed value is greater than the second speed value. If the third speed value is greater than the second speed value, execute step B14. If the third speed value is less than or equal to the second speed value, execute step B15.
[0119] B14. Determine the second speed value as the first speed value.
[0120] B15. Determine whether the third speed value is less than the minimum walking speed of the self-moving device. If the third speed value is less than the minimum walking speed of the self-moving device, execute step B16; if the third speed value is greater than or equal to the minimum walking speed of the self-moving device, execute step B17.
[0121] B16. Determine a first speed value according to the minimum walking speed of the self-moving device.
[0122] B17. Determine the third speed value as the first speed value.
[0123] B18. Determine whether the current walking speed of the self-moving device is less than the starting speed of the self-moving device. If the judgment is yes, execute step B19; if the judgment is no, execute step B20.
[0124] B19. Determine the second speed value as the first speed value.
[0125] B20. Determine the startup speed of the mobile device as the first speed value.
[0126] After obtaining the current current of the working motor, the proportional result of the PID algorithm can be determined according to the current current of the working motor, and the differential result of the PID algorithm can be determined according to the proportional result of the PID algorithm. After that, it can be determined whether the time difference is equal to 0. When it is determined that the time difference is equal to 0, it indicates that the current time is the same as the last time stamp, and the second speed value can be directly determined as the first speed value. When it is determined that the time difference is greater than 0, it can continue to determine whether the time difference is greater than 1. When it is determined that the time difference is greater than 1, it indicates that the time interval between the current time and the last time stamp is large, and the last time stamp is not referenceable. The error result, differential result and integral result of the PID algorithm can be directly set to 0. When it is determined that the time difference is less than or equal to 1, the integral result of the PID algorithm can be determined according to the proportional result of the PID algorithm. After determining the integral result of the PID algorithm, it can be determined whether the absolute value of the integral result of the PID algorithm is greater than the integral upper limit. When it is determined that the absolute value of the integral result of the PID algorithm is greater than the integral upper limit, the integral upper limit can be determined as the final integral result of the PID algorithm, which can avoid the final integral result of the PID algorithm being too large.
[0127] Exemplarily, assuming that the integral interval is 0-0.5, the integral result of the PID algorithm is (-2.25)*0.5=-1.125, and the absolute value 1.125 of the integral result of the PID algorithm is greater than the integral upper limit 0.5. Therefore, the final integral result of the PID algorithm is 0.5.
[0128] The speed adjustment ratio can be determined according to the proportional result, differential result and integral result (or final integral result) of the PID algorithm, and then it can be determined whether the speed adjustment ratio is less than 0. If it is determined that the speed adjustment ratio is less than 0, the first speed value can be determined according to the minimum walking speed of the self-moving device. The product of the minimum walking speed of the self-moving device and N can be determined as the first speed value. N is a value greater than or equal to 1. Exemplarily, N can be 2 or a value greater than 2.
[0129] In the case where it is determined that the speed adjustment ratio is greater than or equal to 0, it can be further determined whether the current current of the working motor is greater than the starting current of the working motor, or whether the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device or the ratio of the starting walking speed to the speed adjustment ratio. In the case where it is determined that the current current of the working motor is greater than the starting current of the working motor, or the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device or the ratio of the starting walking speed to the speed adjustment ratio, the third speed value can be determined according to the speed adjustment ratio and the current walking speed of the self-moving device. The product of the speed adjustment ratio and the absolute value of the current walking speed of the self-moving device can be determined as the third speed value. Afterwards, it can be determined whether the third speed value is greater than the second speed value. In the case where it is determined that the third speed value is greater than the second speed value, the second speed value can be determined as the first speed value, and then step 103 can be executed. In the case where it is determined that the third speed value is less than or equal to the second speed value, it can be further determined whether the third speed value is less than the minimum walking speed of the self-moving device. In the case where it is determined that the third speed value is less than the minimum walking speed of the self-moving device, it indicates that the third speed value is too small. Therefore, the first speed value can be determined according to the minimum walking speed of the self-moving device. In the case where it is determined that the third speed value is greater than or equal to the minimum walking speed of the self-moving device, the third speed value can be determined as the first speed value. For a detailed description of determining the first speed value according to the minimum walking speed of the self-moving device, reference can be made to the above related description. The starting current of the working motor is the current of the working motor when the self-moving device starts working this time. The starting walking speed of the self-moving device is the walking speed of the self-moving device when it starts working this time.
[0130] When it is determined that the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting walking speed of the self-moving device or the ratio of the starting walking speed to the speed adjustment ratio, it can be further determined whether the current walking speed of the self-moving device is less than the starting speed of the self-moving device. When it is determined that the current walking speed of the self-moving device is less than the starting speed of the self-moving device, the second speed value can be determined as the first speed value. When it is determined that the current walking speed of the self-moving device is not less than the starting speed of the self-moving device, the starting speed of the self-moving device can be determined as the first speed value. The starting speed of the self-moving device is the time taken from the mobile device receiving the starting instruction to the completion of the starting.
[0131] like Figure 4 As shown, when the speed adjustment ratio is less than 0, the first speed value can also be determined according to the minimum walking speed of the self-moving device; when the speed adjustment ratio is greater than or equal to 0, the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting speed of the self-moving device, and the current walking speed of the self-moving device is less than the starting speed of the self-moving device, the second speed value can also be determined as the first speed value; when the speed adjustment ratio is greater than or equal to 0, the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting speed of the self-moving device, and the current walking speed of the self-moving device is not less than the starting speed of the self-moving device, the starting speed of the self-moving device can be determined as the first speed value. After determining the first speed value, step 103 can be performed.
[0132] For example, assume that the last current of the working motor is 20A, A is 30A, B is 60A, C is 20A, D is 2, and K is p =1.0, K i =0.1, K d is 0.2 and the time difference is 0.5s. This time Since 1.125 is greater than the integral upper limit of 0.5, the final integral result is 0.5. Speed adjustment ratio=1-(1.0*2.25+0.1*1.125+0.2*(-3.5))=-0.675, therefore, the first speed value is determined according to the minimum walking speed of the self-moving device.
[0133] For example, assume that the last current of the working motor is 20A, A is 40A, B is 30A, C is 20A, D is 2, and K is p =1.0, Ki =0.1, K d is 0.2 and the time difference is 0.5s. This time Speed adjustment ratio = 1-(1.0*0.25+0.1*0.125+0.2*0) = 0.7375. Therefore, the first speed value = 0.7375*absolute value of the current walking speed. It can be seen that the self-moving device is slowing down.
[0134] It should be understood that in the process of self-mobile equipment working, K in the PID algorithm p , K p and K d It can be fixed or adjusted according to actual conditions, and the best result is taken as the final value.
[0135] It should be understood that Figure 4 The process shown is an exemplary description of using a preset speed adjustment algorithm to determine the first speed value, and does not limit it. For example, steps B1-B2 can be performed in steps B3-
[0136] Execute after step B6. Exemplarily, the preset speed adjustment algorithm may be other preset speed adjustment algorithms. In this case, step B1, step B2 and step B7 may not be executed, and step B8 may be replaced by: determining the speed adjustment ratio using other preset speed adjustment algorithms according to the current current of the working motor. Exemplarily, steps B3-B6 may not be executed. Exemplarily, steps B9 and B10 may not be executed. Exemplarily, steps B9-B10 and steps B10-B20 may not be executed. Exemplarily, steps B13-B17 may not be executed. In this case, step B12 may be replaced by: determining the first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device.
[0137] 103. Adjust the working current of the travel motor so that the travel speed of the self-moving device is a first speed value.
[0138] After determining the first speed value, the working current of the travel motor can be adjusted so that the travel speed of the self-moving device is the first speed value, that is, the travel speed of the self-moving device is adjusted to the first speed value by adjusting the working current of the travel motor.
[0139] exist Figure 1In the described speed adjustment method, the self-moving device including the walking motor and the working motor obtains the current current of the working motor, determines the first speed value according to the current current of the working motor using the preset speed adjustment algorithm, and adjusts the working current of the walking motor so that the walking speed of the self-moving device is the first speed value. It can be seen that the walking speed of the self-moving device can be adjusted according to the current of the working motor of the self-moving device, thereby improving the flexibility of speed adjustment. In addition, the walking speed of the self-moving device can be adjusted according to the current of the working motor of the self-moving device, which can avoid the overload of the self-moving device, thereby improving the working efficiency, balance and stability of the self-moving device, and reducing the power consumption of the self-moving device.
[0140] See also Figure 5 , Figure 5 1 is a schematic diagram of a speed adjustment device disclosed in an embodiment of the present application. The speed adjustment device is applied to a self-moving device, which includes a walking motor and a working motor. Figure 5 As shown, the speed adjustment device may include:
[0141] An acquisition unit 501 is used to acquire the current of the working motor;
[0142] A determination unit 502, configured to determine a first speed value using a preset speed adjustment algorithm according to a current current of the working motor;
[0143] The adjustment unit 503 is used to adjust the working current of the walking motor so that the walking speed of the self-moving device is a first speed value.
[0144] In some embodiments, the determining unit 502 is specifically configured to:
[0145] Determine the speed adjustment ratio using a preset speed adjustment algorithm according to the current current of the working motor;
[0146] A first speed value is determined according to the speed adjustment ratio and the current walking speed of the self-moving device.
[0147] In some embodiments, the determining unit 502 determines the first speed value according to the speed adjustment ratio and the current walking speed of the mobile device, including:
[0148] When the speed adjustment ratio is greater than or equal to 0, and the current current of the working motor is greater than the starting current of the working motor or the current walking speed of the self-moving device is greater than the starting walking speed of the self-moving device, the first speed value is determined according to the speed adjustment ratio and the current walking speed of the self-moving device.
[0149] In some embodiments, the determining unit 502 is further configured to:
[0150] When the speed adjustment ratio is less than 0, the first speed value is determined according to the minimum walking speed of the self-moving device;
[0151] When the speed adjustment ratio is greater than or equal to 0, the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting walking speed of the self-moving device, and the current walking speed of the self-moving device is less than the starting speed of the self-moving device, the second speed value is determined as the first speed value, and the second speed value is a preset walking speed value of the self-moving device;
[0152] When the speed adjustment ratio is greater than or equal to 0, the current current of the working motor is not greater than the starting current of the working motor, the current walking speed of the self-moving device is not greater than the starting walking speed of the self-moving device, and the current walking speed of the self-moving device is not less than the starting speed of the self-moving device, the starting speed of the self-moving device is determined as the first speed value.
[0153] In some embodiments, the determining unit 502 determines the first speed value according to the speed adjustment ratio and the current walking speed of the mobile device, including:
[0154] Determine a third speed value according to the speed adjustment ratio and the current walking speed of the self-moving device;
[0155] When the third speed value is less than or equal to the second speed value and greater than or equal to the minimum walking speed of the self-moving device, the third speed value is determined as the first speed value, and the second speed value is a preset walking speed value of the self-moving device;
[0156] The determining unit 502 is further configured to:
[0157] When the third speed value is greater than the second speed value, determining the second speed value as the first speed value;
[0158] When the third speed value is less than the minimum walking speed of the self-moving device, the first speed value is determined according to the minimum walking speed of the self-moving device.
[0159] In some embodiments, the acquisition unit 501 is specifically configured to obtain the current walking speed of the mobile device.
[0160] When the current of the working motor is greater than or equal to the minimum walking speed of the self-moving device, the current current of the working motor is obtained;
[0161] The determining unit 502 is further configured to:
[0162] When the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device, determining the difference between the current walking speed of the self-moving device and a second speed value, where the second speed value is a preset walking speed value of the self-moving device;
[0163] When the difference is less than the speed threshold, determining the second speed value as the first speed value;
[0164] When the difference is not less than the speed threshold and the current walking speed of the self-moving device is greater than the second speed value, the difference between the current walking speed of the self-moving device and the speed threshold is determined as the first speed value;
[0165] When the difference is not less than the speed threshold and the current walking speed of the mobile device is not greater than the second speed value, the sum of the current walking speed of the mobile device and the speed threshold is determined as the first speed value.
[0166] In some embodiments, the determining unit 502 determines the first speed value using a preset speed adjustment algorithm according to the current current of the working motor, including:
[0167] When the current current of the working motor is within the threshold range, a preset speed adjustment algorithm is used to determine the first speed value according to the current current of the working motor.
[0168] In some embodiments, the determining unit 502 is further configured to determine the time difference value according to the current time and the previous timestamp when the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device;
[0169] The determining unit 502 is specifically configured to determine a first speed value using a preset speed adjustment algorithm according to a current current of the working motor when the time difference is greater than 0 and less than or equal to 1;
[0170] The determining unit 502 is further configured to determine the second speed value as the first speed value when the time difference value is equal to 0, and the second speed value is a preset walking speed value of the self-moving device.
[0171] Technicians in the relevant field can clearly understand that for the convenience and simplicity of description, the specific working processes of the speed adjustment device, acquisition unit 501, determination unit 502 and adjustment unit 503 described above can refer to the corresponding processes in the aforementioned method embodiment and will not be repeated here.
[0172] In several embodiments provided in the present application, the coupling between the units may be electrical, mechanical or other forms of coupling.
[0173] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or software.
[0174] It is implemented in the form of a functional unit.
[0175] Please refer to Figure 6 , Figure 6 Schematic diagram of a self-moving device disclosed in the embodiment of the present application. Figure 6 As shown, the self-moving device may include a walking motor 601, a working motor 602, a processor 603 and a memory 604. The memory 604 may store one or more computer programs. The one or more computer programs are configured to execute the method described in the above method embodiment. The memory 604 may exist independently or be integrated with the processor 603.
[0176] The processor 603 may include one or more processing cores. The processor 603 may use various interfaces and lines to connect the various parts of the entire mobile device, and may execute various functions and process data of the mobile device by running or executing instructions, programs, code sets or instruction sets stored in the memory 604, and calling data stored in the memory 604. Optionally, the processor 603 may be implemented in at least one hardware form of digital signal processing (DSP), field programmable gate array (FPGA), and programmable logic array (PLA). The processor 603 may integrate one or a combination of a central processing unit (CPU), a graphics processing unit (GPU), and a modem. Among them, the CPU mainly processes the operating system, user interface, and application programs; the GPU is responsible for rendering and drawing display content; and the modem is used to process wireless communications. It is understandable that the above-mentioned modem may not be integrated into the processor 603, but may be implemented separately through a communication chip.
[0177] The memory 604 may include a random access memory (RAM) or a read-only memory (ROM). The memory 604 may be used to store instructions, programs, codes, code sets or instruction sets. The memory 604 may include a program storage area and a data storage area, wherein the program storage area may store instructions for implementing an operating system, instructions for implementing at least one function (such as a touch function, a sound playback function, an image playback function, etc.), instructions for implementing the above-mentioned various method embodiments, etc. The data storage area may also store data (such as a phone book, audio and video data, chat record data) created by the mobile device during use.
[0178] When the computer program instructions stored in the memory 604 are executed, the processor 603 can be used to perform various operations performed by the mobile device in the above method embodiment, specifically, to control the travel motor according to the working motor to implement various operations performed by the mobile device in the above method embodiment.
[0179] The specific implementation of the operation can be found in the previous embodiments and will not be described in detail here.
[0180] The present application also discloses a computer-readable storage medium, in which a computer program code is stored, and the computer program code can be called by a processor to perform various operations in the above method embodiment. The specific implementation of each of the above operations can be referred to the previous embodiment, and will not be repeated here.
[0181] The computer readable storage medium may be an electronic memory such as a flash memory, an electrically erasable programmable read only memory (EEPROM), an erasable programmable read only memory (EPROM), a hard disk or a ROM. Alternatively, the computer readable storage medium may include a non-transitory computer-readable storage medium. The computer readable storage medium has storage space for program codes that execute any of the method steps in the above method. These computer program codes may be read from or written to one or more computer program products. The computer program code may be compressed, for example, in an appropriate form.
[0182] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit it. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the embodiments of the present application.
Claims
1. A speed adjustment method, characterized in that: The method is applied to a self-moving device, which includes a walking motor and a working motor, including: Obtaining the current of the working motor; Determine a first speed value using a preset speed adjustment algorithm according to the current current; Adjusting the working current of the travel motor so that the travel speed of the self-moving device is equal to the first speed value; Determining the first speed value using a preset speed adjustment algorithm according to the current current includes: Determine a speed adjustment ratio using a preset speed adjustment algorithm according to the current current; Determining a first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device; Determining the first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device includes: When the speed adjustment ratio is greater than or equal to 0, and the current current is greater than the starting current of the working motor or the current walking speed is greater than the starting walking speed of the self-moving device, a first speed value is determined according to the speed adjustment ratio and the current walking speed of the self-moving device; The method further comprises: When the speed adjustment ratio is less than 0, determining the first speed value according to the minimum walking speed of the self-moving device; When the speed adjustment ratio is greater than or equal to 0, the current current is not greater than the starting current of the working motor, the current walking speed is not greater than the starting walking speed of the self-moving device, and the current walking speed is less than the starting speed of the self-moving device, the second speed value is determined as the first speed value, and the second speed value is a preset walking speed value of the self-moving device; When the speed adjustment ratio is greater than or equal to 0, the current current is not greater than the starting current of the working motor, the current walking speed is not greater than the starting walking speed of the self-moving device, and the current walking speed is not less than the starting speed of the self-moving device, the starting speed is determined as the first speed value.
2. The method according to claim 1, characterized in that Determining the first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device includes: Determining a third speed value according to the speed adjustment ratio and the current walking speed of the self-moving device; When the third speed value is less than or equal to the second speed value and greater than or equal to the minimum walking speed of the self-moving device, the third speed value is determined as the first speed value, and the second speed value is a preset walking speed value of the self-moving device; The method further comprises: In a case where the third speed value is greater than the second speed value, determining the second speed value as the first speed value; In a case where the third speed value is less than the minimum walking speed of the self-moving device, the first speed value is determined according to the minimum walking speed.
3. The method according to claim 1, characterized in that The obtaining of the current current of the working motor comprises: When the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device, obtaining the current current of the working motor; The method further comprises: When the current walking speed of the self-moving device is less than the minimum walking speed of the self-moving device, determining the difference between the absolute value of the current walking speed and a second speed value, where the second speed value is a preset walking speed value of the self-moving device; When the difference is less than the speed threshold, determining the second speed value as the first speed value; When the difference is not less than the speed threshold and the absolute value of the current walking speed is greater than the second speed value, the difference between the absolute value of the current walking speed and the speed threshold is determined as the first speed value; When the difference is not less than the speed threshold and the absolute value of the current walking speed is not greater than the second speed value, the sum of the absolute value of the current walking speed and the speed threshold is determined as the first speed value.
4. The method according to claim 1, characterized in that: Determining the first speed value using a preset speed adjustment algorithm according to the current current includes: In a case where the current current is within a threshold range, a first speed value is determined according to the current current using a preset speed adjustment algorithm.
5. The method according to claim 1, characterized in that The method further comprises: When the current walking speed of the self-moving device is greater than or equal to the minimum walking speed of the self-moving device, determining the time difference according to the current time and the previous timestamp; Determining the first speed value using a preset speed adjustment algorithm according to the current current includes: When the time difference is greater than 0 and less than or equal to 1, a first speed value is determined according to the current current using a preset speed adjustment algorithm; The method further comprises: When the time difference is equal to 0, the second speed value is determined as the first speed value, and the second speed value is a preset walking speed value of the self-moving device.
6. A speed adjustment device, characterized in that: The device is applied to a self-moving device, and the self-moving device includes a walking motor and a working motor, including: An acquisition unit, used for acquiring the current current of the working motor; a determining unit, configured to determine a first speed value using a preset speed adjustment algorithm according to the current current; An adjustment unit, used for adjusting the working current of the travel motor so that the travel speed of the self-moving device is equal to the first speed value; The determining unit is specifically used for: Determine a speed adjustment ratio using a preset speed adjustment algorithm according to the current current; Determining a first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device; The determining unit determines the first speed value according to the speed adjustment ratio and the current walking speed of the self-moving device, including: When the speed adjustment ratio is greater than or equal to 0, and the current current is greater than the starting current of the working motor or the current walking speed is greater than the starting walking speed of the self-moving device, a first speed value is determined according to the speed adjustment ratio and the current walking speed of the self-moving device; The determining unit is further configured to: When the speed adjustment ratio is less than 0, determining the first speed value according to the minimum walking speed of the self-moving device; When the speed adjustment ratio is greater than or equal to 0, the current current is not greater than the starting current of the working motor, the current walking speed is not greater than the starting walking speed of the self-moving device, and the current walking speed is less than the starting speed of the self-moving device, the second speed value is determined as the first speed value, and the second speed value is a preset walking speed value of the self-moving device; When the speed adjustment ratio is greater than or equal to 0, the current current is not greater than the starting current of the working motor, the current walking speed is not greater than the starting walking speed of the self-moving device, and the current walking speed is not less than the starting speed of the self-moving device, the starting speed is determined as the first speed value.
7. A self-propelled device, characterized in that: It comprises a walking motor, a working motor and a processor, and the processor controls the walking motor according to the working motor to implement the method according to any one of claims 1 to 5.
8. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program or a computer instruction. When the computer program or the computer instruction is executed by a processor, the method according to any one of claims 1 to 5 is implemented.
