Robot wheel detection method, device and storage medium

By real-time detection of the current value of the robot wheel and adjusting the current threshold, the wheel winding detection problem is solved, timely detection and early warning of the winding of the robot wheel is achieved, and the service life of the robot is extended.

CN114290312BActive Publication Date: 2024-11-15KEENON ROBOTICS CO LTD
View PDF 7 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

The existing technology lacks an effective robot wheel debris winding detection mechanism, which makes it difficult to detect wheel winding in time, affecting the robot's running time and battery life.

Method used

By real-time detection of the current value of the robot wheel motor, calculate the current threshold, and judge whether the wheel is wound based on the frequency and duration of abnormal events, adjust the current threshold based on the inclination angle and friction coefficient, and timely report foreign object winding information.

Benefits of technology

It realizes timely detection of the wounding of the robot wheel, reminds maintenance personnel to clean up, extends the service life of the robot, and avoids shortening of the battery life caused by winding.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114290312B_ABST
    Figure CN114290312B_ABST
Patent Text Reader

Abstract

The present invention relates to a robot wheel detection method, device and storage medium. The method comprises: detecting the current of the real-time wheel motor of the robot to obtain the real-time motor current value; calculating the current current threshold value according to the current influencing factor, and judging whether an abnormal event occurs in the wheel of the robot according to the comparison result between the real-time motor current value and the current current threshold value; judging whether an abnormal state occurs according to the frequency or duration of the abnormal event and a predetermined value. By adopting this method, it is possible to timely know whether the wheel of the robot is entangled with debris through the detection of the real-time motor current value, so as to remind the maintenance personnel to clean the wheel in time, effectively avoiding the influence of the use time of the robot and the service life of the battery due to the wheel being entangled with debris, and effectively extending the service life of the robot.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robots, and in particular to the field of robot state detection technology, and specifically refers to a robot wheel detection method, device and storage medium. Background Art

[0002] Since robots used in daily life do not work in a dust-free environment, their wheels will be entangled with debris after long-term use. Currently, there is no effective detection mechanism for this situation of wheel entanglement, and it is impossible to detect the entanglement of robot wheels in time. It is often necessary to wait until the robot cannot run due to entanglement before cleaning. When the wheels are entangled with debris to a certain extent, the power consumption of the robot during operation will increase, which will reduce the use time of the robot and the battery life. Summary of the invention

[0003] The purpose of the present invention is to overcome the shortcomings of the above-mentioned prior art and provide a robot wheel detection method, device and storage medium that can timely detect when a wheel is entangled by foreign objects.

[0004] In order to achieve the above object, the present invention has the following structure:

[0005] In a first aspect, an embodiment of the present invention provides a robot travel method, comprising:

[0006] Detect the current of the real-time wheel motor of the robot to obtain the real-time motor current value;

[0007] According to the current impact factor, the current current threshold is calculated.

[0008] According to the comparison result between the real-time motor current value and the current current threshold value, determining whether an abnormal event occurs in the wheel of the robot;

[0009] By comparing the frequency or duration of abnormal events with the preset value, it is determined whether an abnormal state has occurred.

[0010] As a preferred technical solution of the above, the step of comparing the duration of the abnormal state with the predetermined time to determine whether the abnormal state occurs includes:

[0011] Determining whether the real-time motor current value exceeds the real-time current threshold;

[0012] If so, it is determined whether the robot is blocked by an obstacle; if not, it is determined as the abnormal event.

[0013] As a preferred technical solution of the above, the method further includes:

[0014] If the abnormal event occurs more than N times, or the accumulated duration of the abnormal event exceeds M, it is determined that the machine is in the abnormal state, and the robot reports foreign body entanglement information.

[0015] As a preferred technical solution of the above, the current current threshold is calculated according to the current impact factor, including:

[0016] The current current threshold is the sum of the current impact factor corresponding to the real-time state of the robot and a system preset basic current value.

[0017] As a preferred technical solution of the above, the current impact factor corresponding to the real-time state of the robot includes at least one of the following current impact factors:

[0018] The system preset tilt angle current influence factor corresponding to the real-time tilt angle of the robot, and / or, obtain the friction coefficient current influence factor corresponding to the friction coefficient of the ground on which the robot is located.

[0019] As a preferred technical solution of the above, the value range of the system preset basic current value is: 1 to 1.5 times the average motor current value of the robot when it runs for the third system preset interval time under the system preset ideal environment and normal state.

[0020] As a preferred technical solution of the above, the method further includes:

[0021] The following formula is used to correct the system preset basic current value of the robot in the current system preset working cycle to obtain the system preset basic current value I of the robot in the current system preset working cycle: b ′:

[0022]

[0023] Wherein, i′ is the average motor current of the robot running under normal conditions in the current preset working cycle of the system, i is the average motor current of the robot running under normal conditions in the previous preset working cycle of the system, and I b A system preset basic current value is set for the robot in the last system preset working cycle.

[0024] As a preferred technical solution of the above, the method further includes:

[0025] When the temperature of the wheel motor of the robot exceeds a system preset temperature threshold, it is determined that the wheel of the robot is in an abnormal state.

[0026] In a second aspect, an embodiment of the present invention further provides a robot control device, characterized in that it is configured on a robot and includes:

[0027] The current detection unit detects the current of the real-time wheel motor of the robot and obtains the real-time motor current value;

[0028] The processing unit calculates the current current threshold according to the current impact factor.

[0029] The judgment unit determines whether an abnormal event occurs in the wheel of the robot according to the comparison result of the real-time motor current value and the current current threshold, and determines whether an abnormal state occurs according to the comparison between the duration of the abnormal state and the predetermined time.

[0030] In a third aspect, an embodiment of the present invention further provides a computer-readable storage medium having a computer program stored thereon, wherein the program, when executed by a processor, implements the robot travel method as described in any one of the embodiments of the present invention.

[0031] The technical benefits of the robot wheel winding detection method of the present invention include:

[0032] The robot wheel entanglement detection method of the present invention determines whether the robot's wheel is in an abnormal state by comparing the real-time motor current value with the current current threshold. The method can timely know whether the robot's wheel is entangled with debris through the detection of the real-time motor current value, so as to remind the maintenance personnel to clean the wheels in time, effectively avoiding the impact of the robot's use time and the battery life due to the wheel being entangled with debris, and effectively extending the service life of the robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0033] Figure 1 A flowchart of a robot wheel detection method provided in Embodiment 1 of the present invention;

[0034] Figure 2 A flowchart of a robot wheel detection method provided in Embodiment 2 of the present invention;

[0035] Figure 3 is a flow chart of a robot wheel detection method in Embodiment 3 of the present invention;

[0036] Figure 4 This is a schematic diagram of the structure of a robot control device provided in Embodiment 4 of the present invention. DETAILED DESCRIPTION

[0037] The following will combine some embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments.

[0038] All other embodiments obtained without creative work are within the scope of protection of the present invention.

[0039] In this embodiment, the robot wheel winding detection method includes:

[0040] Figure 1 This is a flow chart of a robot wheel detection method provided in the first embodiment of the present invention. This embodiment is applicable to robot travel in scenes with complex human factors such as restaurants. The method can be executed by the robot control device, which can be implemented in software and / or hardware. Figure 1 As shown, the method specifically includes the following S:

[0041] S110, detecting the current of the real-time wheel motor of the robot to obtain the real-time motor current value; during the detection process, the real-time wheel motor current can be detected once every preset time interval (such as 1 second);

[0042] S120, determining whether an abnormal event occurs in the wheel of the robot according to the comparison result between the real-time motor current value and the current current threshold, wherein S specifically includes:

[0043] Determining whether the real-time motor current value exceeds the current threshold value;

[0044] If the real-time motor current value does not exceed the current current threshold, it is determined that no abnormal event occurs in the robot; if the real-time motor current value exceeds the current threshold preset by the system, it is determined that an abnormal event occurs in the robot;

[0045] S130, determining whether an abnormal state occurs based on the frequency or duration of the abnormal event and a predetermined value.

[0046] Among them, the abnormal state refers to the frequency or duration of abnormal events exceeding the preset value. For example, a wheel entanglement event occurs, the robot's operating output current is too large, causing damage to the machine. Based on this, the robot's wheel cleaning information is reported.

[0047] At the same time, the temperature of the wheel motor of the robot is detected during the detection. When the temperature of the wheel motor of the robot exceeds a system preset temperature threshold, it is determined that the wheel of the robot is in an abnormal state.

[0048] Embodiment 2

[0049] Figure 2 Flow chart of a robot wheel detection method provided in Embodiment 2 of the present invention. This embodiment is refined based on the above embodiment. Figure 2 As shown, the method includes the following specific S:

[0050] S210, detecting the current of the real-time wheel motor of the robot to obtain the real-time motor current value;

[0051] According to the comparison result between the real-time motor current value and the current current threshold value, determining whether an abnormal event occurs in the wheel of the robot;

[0052] Specifically, it may include:

[0053] S221, determining whether the real-time motor current value exceeds the current threshold;

[0054] S222: If yes, determine whether the robot is blocked by an obstacle.

[0055] S223: If not, determine it as the abnormal event.

[0056] Determining whether the robot is blocked or hit;

[0057] If the robot is blocked or hit by an obstacle, then after determining that the robot has the abnormal event, it is determined that the current abnormal event is caused by the blockage or the collision, and the abnormal event is not recorded; if the robot is not blocked or hit, then after determining that the robot has the abnormal event, it is determined that the current abnormal event is caused by the wheels being entangled by foreign objects, and the abnormal event is recorded.

[0058] Optionally, obstacle blocking can be detected by using a laser radar and a collision detection device on the robot to detect the state of the robot's surrounding environment, and the detection results are recorded to determine whether the robot is blocked or collided.

[0059] S230, determining whether an abnormal state occurs based on the frequency or duration of the abnormal event and a predetermined value, specifically including: if the abnormal event exceeds N times, or the accumulated duration of the abnormal event exceeds M, determining that the machine is in the abnormal state;

[0060] S240, the robot reports foreign object entanglement information.

[0061] If within a preset interval, the number of times the abnormal event occurs recorded exceeds a preset threshold for the number of times the abnormal event occurs, or the continuous duration of the abnormal event recorded exceeds a preset threshold for the continuous duration of the abnormal event, it is determined that the wheel of the robot is in the abnormal state.

[0062] Among them, the preset interval time can be set to one hour.

[0063] The records of the abnormal events include:

[0064] After determining that the robot has experienced the abnormal event, the number of times the abnormal event has occurred is counted as one;

[0065] After determining that the robot has experienced the abnormal event, the time when the abnormal event occurred is recorded.

[0066] If within the vehicle entanglement detection cycle preset by the system, the number of recorded occurrences of the abnormal event exceeds the preset threshold of the number of occurrences of the abnormal event, or the continuous duration of the recorded abnormal event exceeds the preset threshold of the continuous duration of the abnormal event, the robot wheel to be cleaned information is reported.

[0067] Among them, the system's preset vehicle entanglement detection cycle can be set to one day.

[0068] In this embodiment, the current current threshold of the robot is the sum of the current impact factor corresponding to the real-time state of the robot and the system preset basic current value. The current impact factor corresponding to the real-time state of the robot includes at least one of the following current impact factors:

[0069] A current weight impact factor corresponding to the real-time load weight of the robot;

[0070] a current influencing factor of the friction coefficient corresponding to the friction coefficient of the ground on which the robot is located;

[0071] A current influencing factor of a system preset inclination angle corresponding to the real-time inclination angle of the robot.

[0072] Generally speaking, the real-time load weight has the greatest influence on the magnitude of the current threshold in the robot.

[0073] In a specific implementation, the real-time load weight of the robot is detected to obtain the real-time load weight, and the current weight influence factor corresponding to the real-time load weight of the robot is obtained through the corresponding relationship between the load weight and the current weight influence factor built into the system;

[0074] Determine the friction coefficient of the ground on which the robot is located according to the preset ground information of the system, and obtain the current influencing factor of the friction coefficient corresponding to the friction coefficient of the ground on which the robot is located through the correspondence between the friction coefficient and the current influencing factor of the friction coefficient built into the system;

[0075] The real-time tilt angle of the robot is detected by the gyroscope and inertial sensor in the robot, and the current tilt angle influencing factor corresponding to the real-time tilt angle of the robot is obtained through the tilt angle and the current tilt angle influencing factor built into the system.

[0076] This method is based on the principle that when the resistance increases, the output power needs to be increased due to the constant voltage, and the current will increase. When the robot is running, the current of the wheel motor is detected in real time and compared with the current current threshold to determine whether the robot's wheel is in an abnormal state. At the same time, after obtaining the real-time motor current value, the robot's load, ground friction coefficient and real-time tilt angle are queried, and the specific value of the current current threshold is adaptively adjusted, wherein the current current threshold is: the sum of the current impact factor corresponding to the real-time state of the robot and the system preset basic current value. In this embodiment, the current impact factor corresponding to the real-time state of the robot includes the current impact factor of the weight corresponding to the real-time load weight of the robot, the current impact factor of the friction coefficient corresponding to the friction coefficient of the ground where the robot is located, and the current impact factor of the system preset tilt angle corresponding to the real-time tilt angle of the robot. That is, in this embodiment, the current current threshold is the sum of the current impact factor of the weight corresponding to the real-time load weight of the robot, the current impact factor of the friction coefficient corresponding to the friction coefficient of the ground where the robot is located, the current impact factor of the system preset tilt angle corresponding to the real-time tilt angle of the robot, and the system preset basic current value.

[0077] At the same time, in this embodiment, the radar and collision detection device arranged on the body of the robot can also be used to detect whether the robot is blocked or hit.

[0078] By detecting these conditions, the influence of external factors on the test results can be effectively avoided.

[0079] In this embodiment, the value range of the system preset basic current value is: 1 to 1.5 times the average motor current value of the robot running in the ideal environment preset by the system and under normal conditions.

[0080] That is, the system preset basic current value is the default threshold value (ideal value) of the current set by the internal personnel, and its value range is 1 to 1.5 times the average motor current value of the robot running for a certain interval of time in the ideal environment and normal state preset by the system. In this embodiment, 1.5 times the average motor current value of the robot running for a long time in the ideal environment and normal state preset by the system is taken. Such a setting reserves the space for influencing fluctuations and avoids misdetection caused by accidental fluctuations in current.

[0081] Embodiment 3

[0082] Figure 3 This is a flow chart of the robot wheel detection method in the third embodiment of the present invention. Figure 1 , the implementation process of the above robot wheel winding detection method is described in detail:

[0083] S310: Detect the current of the real-time wheel motor of the robot to obtain the real-time motor current value;

[0084] S320: Acquire the real-time load weight, the friction coefficient of the ground, and the real-time tilt angle of the robot, and add the current impact factor corresponding to the real-time state of the robot obtained according to the real-time load weight, the friction coefficient of the ground, and the real-time tilt angle to the system preset basic current value to obtain a current current threshold;

[0085] S330: Determine whether the real-time motor current value is greater than the current current threshold;

[0086] If the real-time motor current value is not greater than the current current threshold, it is determined that the robot has no abnormal event, and the process returns to the above S310; if the real-time motor current value is greater than the current current threshold, it is determined that the robot has an abnormal event, and the process continues to the subsequent S340;

[0087] S340: Determine whether the robot is blocked by an obstacle;

[0088] If yes, then the abnormal event is not recorded and the process returns to S310; if no, then the process continues to S350;

[0089] S350: Determine that the current abnormal event is caused by the wheel being entangled by a foreign object, record the abnormal event, count the number of occurrences of the abnormal event as one, and record the time when the abnormal event occurs;

[0090] S360: Determine whether the number of occurrences of the abnormal event recorded exceeds a preset abnormal event occurrence number threshold, or whether the continuous duration of the occurrence exceeds a preset abnormal event occurrence continuous duration threshold;

[0091] If within the vehicle entanglement detection cycle preset by the system, the number of occurrences of the abnormal event recorded does not exceed the preset abnormal event occurrence number threshold, and the continuous duration of occurrence does not exceed the preset abnormal event occurrence continuous duration threshold, then return to the above S310; if within the vehicle entanglement detection cycle preset by the system, the number of occurrences of the abnormal event recorded exceeds the preset abnormal event occurrence number threshold, or the continuous duration of occurrence exceeds the preset abnormal event occurrence continuous duration threshold, then continue to the subsequent S370;

[0092] S370: Report information that the robot wheels need to be cleaned.

[0093] When executing the above method, the real-time motor current value may be detected every 1 second, or the detection frequency may be adjusted according to actual conditions.

[0094] Among them, the initial current impact factor corresponding to the real-time state of the robot and the system preset basic current value are set by the operator when the robot leaves the factory. However, considering that the equipment will age due to the passage of time, if the initial set parameters are always used as the judgment standard, misjudgment may occur. In this method, the following precautions are adopted to correct the current current threshold to ensure the accuracy of the detection result.

[0095] The robot records the average value of the motor current running under normal operation every day. If the average value of the motor current increases, the current impact factor corresponding to the real-time state of the robot and the system preset basic current value are adjusted according to the increase ratio; if the average value of the motor current decreases, the current impact factor corresponding to the real-time state of the robot and the system preset basic current value are slightly reduced. The specific adjustment method is as follows:

[0096] In some embodiments, the system preset basic current value of the robot in the current system preset working cycle is corrected by the following formula to obtain the system preset basic current value I of the robot in the current system preset working cycle: b ′:

[0097]

[0098] Wherein, i′ is the average motor current of the robot running under normal conditions in the current preset working cycle of the system, i is the average motor current of the robot running under normal conditions in the previous preset working cycle of the system, and I b A system preset basic current value is set for the robot in the last system preset working cycle.

[0099] The current impact factor of the robot in the current system preset working cycle is corrected by the following formula to obtain the current impact factor I of the robot in the current system preset working cycle: r ′:

[0100]

[0101] Wherein, i′ is the average motor current of the robot running under normal conditions in the current preset working cycle of the system, i is the average motor current of the robot running under normal conditions in the previous preset working cycle of the system, and I r It is the current impact factor of the robot in the previous system preset working cycle.

[0102] In order to enable those skilled in the art to better understand the correction method, the correction method is described below with reference to specific figures:

[0103] Assume: the preset working cycle of the system is one day, the average motor current i' of the robot detected today in normal operation is 5A, the average motor current i of the robot detected yesterday in normal operation is 4A, and the preset basic current value I of the robot yesterday is b The current impact factor of the robot yesterday was 5.2. r is 0.5;

[0104] Then, the robot's current value I is preset by the system b ′ is equal to:

[0105]

[0106] The current impact factor of Robotics Today r ′ is equal to:

[0107]

[0108] In this embodiment, the system preset working cycle can be set to one day. By reporting the robot operation data within one day, the parameters in the current threshold are corrected in time to ensure the accuracy of the detection.

[0109] In this embodiment, the method further comprises:

[0110] It is determined whether the average motor current of the robot during the current system preset working cycle is greater than the motor limit current value preset by the system. If so, a motor aging warning is issued.

[0111] The average motor current of the robot running under normal conditions is related to the performance of the motor. After the motor is aged, it will consume more power. If the average motor current is higher than the motor limit current value preset by the system (that is, the worst motor current value set at the factory), it means that the motor is aged and should be replaced. In this embodiment, by setting the motor aging warning function, the operator can be notified in time to replace the aged motor without affecting the use of the battery and other components in the robot.

[0112] When the running mileage of the robot exceeds the system preset mileage threshold, or the running time of the robot exceeds the system preset mileage time threshold, a corresponding mileage alarm message is generated.

[0113] In this solution, the background generates alarm rules based on the user input data and sets the warning threshold. When the robot uploads mileage information that triggers the mileage threshold or mileage time threshold, the corresponding mileage alarm information is generated. The background notifies the corresponding personnel (after-sales personnel or merchants) through the rules, and the after-sales personnel provide door-to-door service (or the merchant solves the problem by themselves).

[0114] When the temperature of the wheel motor of the robot exceeds a system preset temperature threshold, it is determined that the wheel of the robot is in an abnormal state.

[0115] Since the temperature of the wheel motor of the robot will be high after the wheels are entangled with debris, this solution uses a temperature sensor to detect the temperature of the wheel motor of the robot, and uses the temperature detection to integrate and judge whether the wheel is in an abnormal state, thereby increasing the accuracy of the detection.

[0116] The above technical solution can analyze whether the current rotation state of the robot's wheel motor is in an abnormal event by detecting and counting the robot's posture, load weight, real-time motor current value and historical data, and when the time and frequency of the abnormal event exceed the preset threshold, it is determined that the robot's wheel is in the abnormal state.

[0117] At the same time, when comparing the real-time motor current value with the current threshold value, the robot's tilt angle, ground friction conditions and load weight are detected, and the current threshold value is adjusted accordingly according to the detected robot's tilt angle, ground friction conditions and load weight during detection, effectively avoiding misjudgment caused by the increase in the real-time motor current value due to the increase in the robot's tilt angle, different ground smoothness and increased load. At the same time, it also detects whether the robot is blocked or collided, avoiding misjudgment caused by the increase in the real-time motor current value due to a sudden drop in speed caused by obstruction or collision. The accuracy of detection is higher.

[0118] During the detection, a weight detection sensor can be installed on the robot's storage platform (such as a dinner plate) to detect the real-time load weight of the robot and obtain the real-time load weight. The weight of the robot itself is a fixed weight, which is input into the robot by the operator. After the robot starts running, the total weight of the current robot can be obtained by adding the load weight obtained by detecting the weight of the items on the storage platform and the recorded weight of the robot itself.

[0119] The current weight influence factor corresponding to the real-time load weight of the robot is obtained through the correspondence between the load weight and the current weight influence factor (ie, the weight influence factor) built into the system.

[0120] In order to enable those skilled in the art to better understand the method of obtaining the current weight influence factor corresponding to the real-time load weight of the robot, an example is given below for illustration:

[0121] Assume that the motor current of the robot in normal operation without load is 1A, and after the robot has an additional load of 3KG, the motor current value in normal operation is 1.5A, then the corresponding relationship between the load weight and the weight current influence factor built into the system (i.e., the weight influence factor) is that for every increase of 3KG load, the current will increase by (1.5-1)A, that is, the weight influence factor is the corresponding relationship between the unit weight and the current value. This corresponding relationship is pre-input into the robot by the operator. When the robot is running, it only needs to detect the increased load of the robot to obtain the weight current influence factor corresponding to the real-time load weight of the robot.

[0122] To prevent abnormal detection errors caused by the site friction coefficient value, the deployment personnel examine the material of the robot's operating site and input the corresponding ground friction coefficient into the robot. The robot can obtain the current friction coefficient influence factor corresponding to the friction coefficient of the ground where the robot is located through the correspondence between the friction coefficient and the current friction coefficient influence factor built into the system, thereby avoiding false detection due to increased current caused by high site friction.

[0123] Among them, the corresponding relationship between the friction coefficient in the system and the current influencing factor of the friction coefficient is pre-input into the robot by the operator, and different ground materials correspond to different current influencing factors of the friction coefficient.

[0124] During the operation of the robot, the real-time tilt angle of the robot can be detected by using a gyroscope and an inertial sensor (i.e., IMU). Then, the current inclination angle influence factor of the system preset tilt angle corresponding to the real-time tilt angle of the robot is obtained by comparing the tilt angle built into the system with the current inclination angle influence factor of the system preset tilt angle (i.e., tilt angle influence factor).

[0125] In order to enable those skilled in the art to better understand the method of obtaining the current influencing factor of the system preset tilt angle corresponding to the real-time tilt angle of the robot, an example is given below for explanation:

[0126] Assume that the motor current of the robot is 1A in normal operation on a flat surface, and when the robot is running on a ground with an inclination of 2 degrees, the motor current value in its normal operation is 1.5A. Then the corresponding relationship between the inclination angle built into the system and the current influencing factor of the system preset inclination angle (that is, the inclination angle influencing factor) is that for every 2 degrees increase in the inclination angle, the current will increase by (1.5-1)A, that is, the inclination angle influencing factor is the corresponding relationship between the unit inclination angle and the current value. This corresponding relationship is pre-input into the robot by the operator. When the robot is running, it only needs to detect the inclination angle of the ground on which the robot is located, and you will get the current influencing factor of the system preset inclination angle corresponding to the inclination angle of the robot.

[0127] The above method can detect the wheels of the robot being entangled with debris in time when the wheels are inevitably entangled with debris due to long-term use, and issue an early warning to remind maintenance personnel to clean the wheels and replace vulnerable parts in time to avoid circuit burnout, effectively extending the service life of the robot.

[0128] The technical benefits of the robot wheel winding detection method of the present invention include:

[0129] The robot wheel entanglement detection method of the present invention determines whether the robot's wheel is in an abnormal state by comparing the real-time motor current value with the current current threshold. The method can timely know whether the robot's wheel is entangled with debris through the detection of the real-time motor current value, so as to remind the maintenance personnel to clean the wheels in time, effectively avoiding the impact of the robot's use time and the battery life due to the wheel being entangled with debris, and effectively extending the service life of the robot.

[0130] Embodiment 4

[0131] Figure 4This is a schematic diagram of the structure of a robot control device provided in the fourth embodiment of the present invention. The robot control device provided in the embodiment of the present invention can execute a robot travel method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method. The device can be implemented in software and / or hardware, such as Figure 4 As shown, the robot control device specifically includes: a current detection unit 410 , a processing unit 420 , and a judgment unit 430 .

[0132] Among them, the current detection unit detects the current of the real-time wheel motor of the robot to obtain the real-time motor current value;

[0133] The processing unit calculates the current current threshold according to the current impact factor.

[0134] The judgment unit determines whether an abnormal event occurs in the wheel of the robot according to the comparison result of the real-time motor current value and the current current threshold, and determines whether an abnormal state occurs according to the comparison between the duration of the abnormal state and the predetermined time.

[0135] Embodiment 5

[0136] Embodiment 5 of the present invention further provides a computer-readable storage medium, wherein the computer-executable instructions are used to execute a robot travel method when executed by a computer processor, the method comprising:

[0137] Detect the current of the real-time wheel motor of the robot to obtain the real-time motor current value;

[0138] According to the current impact factor, the current current threshold is calculated.

[0139] According to the comparison result between the real-time motor current value and the current current threshold value, determining whether an abnormal event occurs in the wheel of the robot;

[0140] Determine whether an abnormal state has occurred based on the comparison between the frequency or duration of abnormal events and the preset value.

[0141] Of course, the storage medium containing computer executable instructions provided by an embodiment of the present invention, whose computer executable instructions are not limited to the method operations described above, can also execute related operations in the robot travel method provided by any embodiment of the present invention.

[0142] Through the above description of the implementation method, the technicians in the relevant field can clearly understand that the embodiments of the present invention can be implemented by means of software and necessary general hardware, and of course can also be implemented by hardware, but in many cases the former is a better implementation method. It is worth noting that in the embodiment of the above-mentioned robot travel device, the various units and modules included are only divided according to functional logic, but are not limited to the above-mentioned division, as long as the corresponding functions can be realized; in addition, the specific names of the functional units are only for the convenience of distinguishing each other, and are not used to limit the protection scope of the embodiments of the present invention.

[0143] In this specification, the present invention has been described with reference to specific embodiments thereof. However, it is apparent that various modifications and variations may be made without departing from the spirit and scope of the present invention. Therefore, the specification and drawings should be regarded as illustrative rather than restrictive.

Claims

1. A robot wheel detection method, It is characterized in that include: Detect the current of the real-time wheel motor of the robot to obtain the real-time motor current value; According to the current impact factor, the current current threshold is calculated. According to the comparison result between the real-time motor current value and the current current threshold value, determining whether an abnormal event occurs in the wheel of the robot; Determine whether an abnormal state occurs based on the frequency or duration of abnormal events compared with a predetermined value; According to the current impact factor, the current current threshold is calculated, including: The current current threshold is the sum of the current impact factor corresponding to the real-time state of the robot and the system preset basic current value; The method further comprises: The following formula is used to correct the system preset basic current value of the robot in the current system preset working cycle to obtain the system preset basic current value I of the robot in the current system preset working cycle: b ′: Wherein, i′ is the average motor current of the robot running under normal conditions in the current preset working cycle of the system, i is the average motor current of the robot running under normal conditions in the previous preset working cycle of the system, and I b A system preset basic current value is set for the robot in the last system preset working cycle.

2. The robot wheel detection method according to claim 1, wherein the frequency or duration of the abnormal event is compared with a predetermined value to determine whether an abnormal state occurs. include: Determining whether the real-time motor current value exceeds a current threshold value; If so, it is determined whether the robot is blocked by an obstacle; if not, it is determined as the abnormal event.

3. The robot wheel detection method according to claim 2, further comprising: include: If the abnormal event occurs more than N times, or the accumulated duration of the abnormal event exceeds M, it is determined that the machine is in the abnormal state, and the robot reports foreign body entanglement information.

4. The robot wheel detection method according to claim 1, It is characterized in that The current impact factor corresponding to the real-time state of the robot includes at least one of the following current impact factors: A current influencing factor of a system preset inclination angle corresponding to the real-time inclination angle of the robot, and / or a current influencing factor of a friction coefficient corresponding to the friction coefficient of the ground on which the robot is located is obtained.

5. The robot wheel detection method according to claim 4, It is characterized in that The value range of the system preset basic current value is: 1 to 1.5 times the average current value of the robot running in the ideal environment preset by the system and under normal conditions.

6. The robot wheel detection method according to claim 1, It is characterized in that The method further comprises: When the temperature of the wheel motor of the robot exceeds a system preset temperature threshold, it is determined that the wheel of the robot is in an abnormal state.

7. A robot control device, It is characterized in that Configured on the robot, including: The current detection unit detects the current of the real-time wheel motor of the robot and obtains the real-time motor current value; The processing unit calculates the current current threshold according to the current impact factor. A judgment unit, which judges whether an abnormal event occurs in the wheel of the robot according to a comparison result between the real-time motor current value and the current current threshold value, and judges whether an abnormal state occurs according to a comparison between the duration of the abnormal state and a predetermined time; Among them, according to the current impact factor, the current current threshold is calculated, including: The current current threshold is the sum of the current impact factor corresponding to the real-time state of the robot and the system preset basic current value; The processing unit is further used to correct the system preset basic current value of the robot in the current system preset working cycle according to the following formula to obtain the system preset basic current value I of the robot in the current system preset working cycle b ′: Wherein, i′ is the average motor current of the robot running under normal conditions in the current preset working cycle of the system, i is the average motor current of the robot running under normal conditions in the previous preset working cycle of the system, and I b A system preset basic current value is set for the robot in the last system preset working cycle.

8. A computer-readable storage medium having a computer program stored thereon, It is characterized in that When the program is executed by a processor, a robot wheel detection method as described in any one of claims 1 to 6 is implemented.

Citation Information

Patent Citations

  • Robot collision detection method and robot

    CN110355786A

  • Floor mopping robot fault diagnosis method and floor mopping robot

    CN110658006A

  • Robot and collision detection method and device thereof

    CN111168665A

  • Autonomous mobile device and program

    JP2016148950A

  • Method for automatically removing obstructions from robotic floor-cleaning devices

    US10524627B1