Method for detecting physical forbidden zone and global relocating of service robot
The present disclosure provides a method for detecting a physical forbidden zone and global relocating of a service robot, the method comprising: presetting an identification on an edge of the physical forbidden zone that the service robot cannot enter in a working scenario; constantly detecting whether there is an artificial identification in the working scenario during operations of the service robot; identifying the artificial identification and confirming a position and heading angle information of the service robot relative to the artificial identification when there is artificial identification information in the working scenario; controlling a motion trajectory of the service robot according to the position and heading angle information of the service robot relative to the artificial identification to forbid the service robot from entering a respective physical forbidden zone.
1. A method for detecting a physical forbidden zone and global relocating of a service robot, the method comprising:
presetting an artificial identification on an edge of the physical forbidden zone that the service robot is not allowed to enter in a working scenario;
constantly detecting whether there is the artificial identification in the working scenario by a detection apparatus of the service robot during operations of the service robot;
identifying the artificial identification and confirming position and heading angle information of the service robot relative to the artificial identification when there is artificial identification information in the working scenario;
controlling a motion trajectory of the service robot according to the position and heading angle information of the service robot relative to the artificial identification to forbid the service robot from entering the physical forbidden zone; and
acquiring a possible position and heading angle range of the service robot in a global map of the working scenario according to an absolute position of the artificial identification in the global map, and achieving that an global relocation of the service robot is accurate,
wherein achieving that the global relocation of the service robot is accurate comprises:
S1: acquiring an optimal pose estimation at an current time frame, where the optimal pose estimation is expressed as P k =[p k q k θ k ] T , p k and q k represent a coordinate position of the service robot in a global coordinate system at the current time frame, θ k , represents a heading angle of the service robot in the global coordinate system at the current time frame, and k represents the current time frame;
S2: calculating a global location score Ψ k , at the current time frame according to the optimal pose estimation; and
S3: indicating that the global relocation of the service robot is accurate, when the global location score is greater than a certain threshold,
wherein the S1 comprises:
scanning the working scenario by a navigation 2D laser sensor of the service robot to acquire navigation sensor data at the current time frame;
detecting the artificial identification, calculating the position and heading angle information of the service robot relative to the artificial identification, and acquiring the possible position and heading angle range of the service robot in the global map according to the global absolute position of the artificial identification; and
applying a Monte Carlo location algorithm to acquire the optimal pose estimation, based on the navigation sensor data, a built global map, and the possible position and heading angle range.
2. The method of claim 1 , wherein the artificial identification comprises one or more of an RFID tag, a UWB tag, a magnetic strip, a two-dimensional code or a color identification card; and the detection apparatus comprises one or more of an RFID reader, a UWB base station, a Hall sensor, and a camera having an image processing module,
wherein the detection apparatus comprises the RFID reader when the artificial identification comprises the RFID tag;
the detection apparatus comprises the UWB base station when the artificial identification comprises the UWB tag;
the detection apparatus comprises the Hall sensor when the artificial identification comprises the magnetic strip; and
the detection apparatus comprises the camera having the image processing module when the artificial identification comprises the two-dimensional code or the color identification card.