IP Library Granted Patent US 11,586,201
Granted Patent B2
US 11,586,201 · App. 17/005,433 · Granted Feb 21, 2023

Method and apparatus for recognizing a stuck status as well as computer storage medium

Inventors: Minghong Zhong (Shenzhen, CN); Lirong Ye (Shenzhen, CN); Ruijun Yan (Shenzhen, CN)
Assignee: ShenZhen Silver Star Intelligent Technology CO.. LTD
G05D1/0055G01C21/3807G05D1/027G05D1/0212G05D1/0272G05D2201/0203
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,586,201
App. No.
17/005,433
Granted
Feb 21, 2023
Kind
B2
Abstract

The present disclosure proposes a method and an apparatus for recognizing a stuck status as well as a computer storage medium, with the method comprising: building an environmental map within a preset extent by taking the current position of the mobile robot as center; real-time monitoring the march information of the mobile robot and predicting whether the mobile robot is stuck or not; acquiring data from multiple sensors of the mobile robot, if the mobile robot is stuck; and recognizing the current stuck status of the mobile robot based on the data from multiple sensors.

Claims (46)

1. A method for recognizing a stuck status, wherein the method comprises:

building an environmental map within a preset extent by taking a current position of a mobile robot as center;

real-time monitoring a march information of the mobile robot and according to a position-pose information of the mobile robot in the environmental map predicting whether the mobile robot is stuck or not, wherein if yes, data from multiple sensors of the mobile robot is acquired, wherein the march information contains the position-pose information of the mobile robot in the environmental map; and

recognizing a current stuck status of the mobile robot based on the data from multiple sensors,

wherein the data from multiple sensors contains current angle information of the mobile robot, wherein the recognizing the current stuck status of the mobile robot based on the data from multiple sensors comprises:

determining an abnormal angle parameter in the current angle information of the mobile robot according to a desired angle,

wherein the angle information contains a course angle, a roll angle, and a pitch angle,

wherein the recognizing the current stuck status of the mobile robot based on the data from multiple sensors comprises:

judging whether an abnormal time for each of the course angle, the roll angle and the pitch angle reaches a third time threshold, if the course angle, the roll angle and the pitch angle are all smaller than a desired value, and the course angle, the roll angle and the pitch angle all fluctuate within a preset range,

wherein if yes, it is determined that the mobile robot is in a fourth type of stuck status, wherein the method further comprises:

controlling the mobile robot to execute a fourth extrication action, if the mobile robot is determined as being in the fourth type of stuck status.

2. The method for recognizing the stuck status according to claim 1 , wherein the position-pose information of the mobile robot in the environmental map contains the current position-pose information of the mobile robot and the position-pose information of a previous node, wherein the real-time monitoring the march information of the mobile robot and according to the position-pose information of the mobile robot in the environmental map predicting whether the mobile robot is stuck or not comprises:

acquiring current position-pose information of the mobile robot and position-pose information of the previous node, and judging whether the current position-pose information is updated with respect to the position-pose information of the previous node, wherein if yes, a target path which the mobile robot generated at the previous node is acquired, wherein the march information contains a march trajectory which is used for judging whether the mobile robot deviates from the target path.

3. The method for recognizing the stuck status according to claim 2 , wherein the real-time monitoring the march information of the mobile robot and according to the position-pose information of the mobile robot in the environmental map predicting whether the mobile robot is stuck or not comprises:

acquiring deviation time, if the mobile robot deviates from the target path; and

predicting that the mobile robot is stuck, if the deviation time exceeds a first time threshold.

4. The method for recognizing the stuck status according to claim 1 , wherein the data from multiple sensors contains dual main wheel coding values, wherein the recognizing the current stuck status of the mobile robot based on the data from multiple sensors comprises:

judging whether the dual main wheel coding values are normal or abnormal, when the course angle deviates from the desired angle by a first angle threshold, wherein if normal, the mobile robot is determined as being in a first type of stuck status; and if at least one of the dual main wheel coding values is abnormal, it is determined that a main wheel with an abnormal coding value breaks down, the mobile robot is determined as being in a second type of stuck status.

5. The method for recognizing the stuck status according to claim 4 , wherein the method further comprises:

controlling the mobile robot to execute a first extrication action, if the mobile robot is determined as being in the first type of stuck status;

controlling the mobile robot to execute a second extrication action, if the mobile robot is determined as being in the second type of stuck status.

6. The method for recognizing the stuck status according to claim 1 , wherein the recognizing the current stuck status of the mobile robot based on the data from multiple sensors comprises:

acquiring the time of abnormal data of the pitch angle and the roll angle and a ground detection strength information, if the pitch angle or the roll angle exceeds a second angle threshold; and

determining that the mobile robot is in a third type of stuck status, if the time of abnormal data of the pitch angle and/or the roll angle exceeds a second time threshold and the ground detection strength information is attenuated.

7. The method for recognizing the stuck status according to claim 6 , wherein the method further comprises:

controlling the mobile robot to execute a third extrication action, if the mobile robot is determined as being in the third type of stuck status.

8. An apparatus for recognizing a stuck status, wherein the apparatus for recognizing the stuck status comprises a controller and an inertial measurement unit, wherein

the inertial measurement unit is configured to acquire a march information of the mobile robot and transmit the same to the controller; and

the controller is at least configured to monitor the march information of the mobile robot, judge whether the mobile robot is stuck based on data from multiple sensors, and recognize a type of the stuck status,

wherein the data from multiple sensors contains current angle information of the mobile robot, the controller ascertains an abnormal angle parameter in the angle information according to a desired angle, and the angle information contains a course angle, a roll angle, and a pitch angle,

wherein the apparatus for recognizing the stuck status comprises a main wheel code disk unit and a ground detection sensor, wherein

the main wheel code disk unit is configured to acquire main wheel code disk data of the mobile robot and transmit the same to the controller; and

the ground detection sensor is configured to acquire information about light reflection strength on a ground and transmit the same to the controller,

wherein the controller is configured in such a way that: when the course angle, the roll angle and the pitch angle received by the controller are all smaller than a desired value, and the course angle, the roll angle, and the pitch angle all fluctuate within a preset range,

the controller acquires an abnormal time for each of the course angle, the roll angle and the pitch angle, and mobile robot is determined as being in a fourth type of stuck status, if the abnormal time reaches a third time threshold,

the controller is also used for controlling the mobile robot to execute a fourth extrication action, if the mobile robot is determined as being in the fourth type of stuck status.

9. The apparatus for recognizing the stuck status according to claim 8 , wherein the data from multiple sensors contains dual main wheel coding values, wherein the controller is configured in such a way that: the controller detects whether dual main wheel coding values are normal or abnormal, when the course angle deviates from the desired angle by a first angle threshold,

wherein the mobile robot is determined as being in a first type of stuck status, if the dual main wheel coding values are normal; and

it is determined that a main wheel with an abnormal coding value breaks down and the mobile is in a second type of stuck status, if at least one of the dual main wheel coding values is abnormal.

10. The apparatus for recognizing the stuck status according to claim 9 ,

wherein the controller is used for controlling the mobile robot to execute a first extrication action, if the mobile robot is determined as being in the first type of stuck status;

the controller is also used for controlling the mobile robot to execute a second extrication action, if the mobile robot is determined as being in the second type of stuck status.

11. The apparatus for recognizing the stuck status according to claim 8 , wherein the controller is configured in such a way that: the controller acquires the time of abnormal data of the pitch angle and the roll angle and a ground detection strength information, when the pitch angle or the roll angle exceeds a second angle threshold; and

the mobile robot is determined as being in a third type of stuck status, if the time of abnormal data of the pitch angle and/or the roll angle exceeds a second time threshold and the ground detection strength information is attenuated.

12. The apparatus for recognizing the stuck status according to claim 11 , wherein the controller is also used for controlling the mobile robot to execute a third extrication action, if the mobile robot is determined as being in the third type of stuck status.

13. A computer storage medium, comprising a processor and a memory, wherein the processor and the memory are in communication connection with each other, and multiple instructions are stored in the memory, and the processor realizes the method of claim 1 for recognizing a stuck status by executing the multiple instructions, the method for recognizing the stuck status comprises: building an environmental map within a preset extent by taking a current position of a mobile robot as center; real-time monitoring a march information of the mobile robot and according to the position-pose information of the mobile robot in the environmental map predicting whether the mobile robot is stuck or not, wherein if yes, data from multiple sensors of the mobile robot is acquired; and recognizing a current stuck status of the mobile robot based on the data from multiple sensors, the march information contains the position-pose information of the mobile robot in the environmental map, wherein the multiple instructions include instructions for controlling the mobile robot when the mobile robot is stuck.

Assignments (3)
CHANGE OF NAME Recorded Mar 29, 2023
From: SHENZHEN SILVER STAR INTELLIGENT TECHNOLOGY CO.,LTD.
To: SHENZHEN SILVER STAR INTELLIGENT GROUP CO., LTD.
Reel/Frame 063138/0953 →
CHANGE OF NAME Recorded Mar 20, 2023
From: SHENZHEN SILVER STAR INTELLIGENT TECHNOLOGY CO.,LTD.
To: SHENZHEN SILVER STAR INTELLIGENT GROUP CO., LTD.
Reel/Frame 063117/0303 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Aug 28, 2020
From: ZHONG, MINGHONG; YE, LIRONG; YAN, RUIJUN
To: SHENZHEN SILVER STAR INTELLIGENT TECHNOLOGY CO., LTD
Reel/Frame 053624/0954 →
Priority Claims (1)
CN 202010119826.5 · Feb 26, 2020 · national
Continuity (1)
Related Publication 20210263514A1 · Aug 26, 2021