This disclosure relates generally to the field of guide robots, and more particularly relates to a guide robot and a method of calibrating a moving region thereof, and a computer readable storage medium.
An independent guide robot is a kind of smart robot, which is applied to a place such as an exhibition hall, and is capable of guiding visitors to different functional regions according to a business requirement, making corresponding explanations and answering relevant questions. It can move fast through two driving wheels and one driven wheel that are arranged at the bottom. At the present, the guide robot is positioned and avoids obstacles via its own sensors, but in actual application, people find that various emergencies will occur during moving or steering of the guide robot, for example:
1. in a moving process of the guide robot, if someone stands on its movement track, the guide robot will automatically avoid the obstacle according to feedback information of its own sensors, but due to its unpredictable obstacle avoiding direction, it will avoid the obstacle towards one side based on instinctive reaction, so that such a phenomenon of secondary or multiple times of mutual avoiding between the guide robot and people, which is caused by the fact that the avoiding direction of people is consistent with the obstacle avoiding direction of the guide robot, often occurs, and it takes more time for the robot or the robot selects a non-optimal path to reach a preset region, and even the robot misjudges that there is an unbridgeable obstacle around, and it may not reach the preset region and would go around in circles, thus affecting normal operation of the robot.
2. when the guide robot suddenly moves from a static state, as people do not know that the guide robot would move in advance, and even do not know which direction that the guide robot would move towards, such a phenomenon that people burst in a region, at which the guide robot will arrive, occurs easily, which leads to collision between the guide robot and people, resulting in injury to people or damage, malfunctions and the like of the guide robot.
The disclosure mainly aims to provide a guide robot and a method of calibrating a moving region thereof, and a computer readable storage medium, and aims at enabling the guide robot to display and calibrate regions through which it will pass, and providing a visible movement trend prompt to avoid a phenomenon of collision between people and the robot or multiple times of avoiding and the like.
To achieve the above objective, a method of calibrating a moving region of a guide robot is provided. The guide robot includes a signal receiving unit for receiving a movement instruction, a controller and a light emitting module. The method includes:
a1. detecting and receiving, by the signal receiving unit, the movement instruction, and sending the received movement instruction to the controller;
a2. determining, by the controller, region calibration parameters corresponding to the received movement instruction according to a predetermined mapping relation between the movement instruction and the region calibration parameters, wherein the region calibration parameters include a pending moving region of the guide robot, a light display parameter in the pending moving region, and a driving parameter corresponding to the pending moving region and the light display parameter;
a3. driving, by the controller, the light emitting module to carry out light display calibration in the pending moving region according to the determined region calibration parameters.
Preferably, before the step a1, the method of calibrating the moving region also includes:
obtaining, by the controller, preset normally-on warning region parameters, wherein the normally-on warning region parameters include a normally-on warning region, a light display parameter in the normally-on warning region, and a driving parameter corresponding to the normally-on warning region and the light display parameter in the normally-on warning region, and the normally-on warning region is a region surrounding the guide robot;
driving, by the controller, the light emitting module to carry out light display calibration in the normally-on warning region according to the obtained normally-on warning region parameters.
Preferably, the step a2 includes:
determining, by the controller, the region calibration parameters corresponding to the received movement instruction according to the predetermined mapping relation between the movement instruction and the region calibration parameters, determining a moving prewarning region according to the determined region calibration parameters, and detecting whether an obstacle exists within a preset size range on a movement path corresponding to the movement instruction or not, wherein the region calibration parameters include the pending moving region of the guide robot, the pending moving region includes the normally-on warning region and a maximum warning region, and the moving prewarning region is an annular region surrounded by the normally-on warning region and the maximum warning region;
determining, by the controller, region calibration parameters of the light emitting module in the moving prewarning region according to an obstacle detection result.
Preferably, the step of determining, by the controller, the region calibration parameters of the light emitting module in the moving prewarning region according to the obstacle detection result includes:
detecting, by a provided distance sensor, a distance d between the obstacle and the robot in real time or regularly;
if the detected distance d is shorter than or equal to the minimum warning distance dmin between the obstacle and the normally-on warning region, determining that the region calibration parameters are predetermined first region calibration parameters;
if the detected distance d is longer than the minimum warning distance dmin between the obstacle and the normally-on warning region, and shorter than or equal to the maximum warning distance dmax between the obstacle and the maximum warning region, detecting a current speed v of the robot, calculating current warning parameters according to the detected distance d and the current speed v of the robot based on a preset first warning parameter formula, and determining that second region calibration parameters corresponding to the calculated warning parameters are the region calibration parameters according to a predetermined mapping relation between the warning parameter and the region calibration parameter;
if the detected distance d is longer than the maximum warning distance dmax between the obstacle and the maximum warning region, detecting the current speed v of the robot, determining the maximum design speed vmax of the robot, calculating current warning parameters according to the current speed v and the maximum design speed vmax of the robot based on a preset second warning parameter formula, and determining that third region calibration parameters corresponding to the calculated warning parameters are the region calibration parameters according to a predetermined mapping relation between the warning parameter and the region calibration parameter.
To achieve the above objective, a guide robot is further provided, including a shell, a controller, a memory and a light emitting module arranged on the shell. The light emitting module is electrically connected with the controller; the controller has a signal input end for receiving a movement instruction; the guide robot also includes a moving region calibration program which is stored on the memory and is operated in the controller; and the moving region calibration program is executed by the controller to implement the following steps:
a1. detecting and receiving the movement instruction;
a2. determining region calibration parameters corresponding to the received movement instruction according to a predetermined mapping relation between the movement instruction and the region calibration parameters, wherein the region calibration parameters include a pending moving region of the guide robot, a light display parameter in the pending moving region, and a driving parameter corresponding to the pending moving region and the light display parameter;
a3. driving the light emitting module to carry out light display calibration in the pending moving region according to the determined region calibration parameters.
To achieve the above objective, a computer readable storage medium is further provided, which is applied to the guide robot. The computer readable storage medium stores a moving region calibration program which is executed by a controller to implement the following steps:
a1. detecting and receiving the movement instruction;
a2. determining region calibration parameters corresponding to the received movement instruction according to a predetermined mapping relation between the movement instruction and the region calibration parameters, wherein the region calibration parameters include a pending moving region of the guide robot, a light display parameter in the pending moving region, and a driving parameter corresponding to the pending moving region and the light display parameter;
a3. driving the light emitting module to carry out light display calibration in the pending moving region according to the determined region calibration parameters.
According to the technical solutions of the disclosure, the guide robot determines the pending moving region corresponding to the movement instruction at receiving of the movement instruction, and then controls a display module to carry out the light display calibration in the pending moving region, so that a movement direction and a movement trend of the guide robot may be visibly displayed, and people can accurately avoid the guide robot, thereby avoiding occurrence of a phenomenon of a collision accident between people and the guide robot, which protects the safety of people and the guide robot, and enables the guide robot to move more efficiently.
To make a clearer description to embodiments of the disclosure or technical solutions in the prior art, a brief introduction will be made below to the embodiments or accompanying drawings to be used in description of the prior art. Obviously, the accompanying drawings described below are merely some embodiments of the disclosure. Ordinary persons skilled in the art also can get other accompanying drawings according to structures as shown in these drawings without paying creative work.
Achieving of objectives, functional features, and advantages of this disclosure will be described below in further detail in connection with the accompanying drawings.
A clear and complete description will be made below to the technical solutions in embodiments of the disclosure in combination with the accompanying drawings in the embodiments of the disclosure. Obviously, the embodiments described herein are merely part of embodiments of the disclosure, but not all the embodiments. Based on the embodiments in the disclosure, all the other embodiments obtained by the ordinary persons skilled in the art without paying creative work shall fall within the scope of protection of the disclosure.
A guide robot is provided, as shown in
The guide robot of this embodiment includes a shell (not shown in the figure), the controller 10, the light emitting module 20 arranged on the shell, and a memory 30 electrically connected with the controller 10, and of course, also includes two driving wheels and one driven wheel which are arranged at the bottom end of the shell. The light emitting module 20 is electrically connected with the controller 10; the controller 10 has a signal input end 11 for receiving a movement instruction; the signal input end 11 may include a port for receiving a Bluetooth signal, a port for receiving a network communication signal, a port for receiving own sensor signals, and the like.
The memory 30 at least includes one type of readable storage medium which includes a flash memory, a hard disk, a multimedia card, a card memory (such as a Secure Digital (SD) or DX memory), a Random Access Memory (RAM), a Static Random Access Memory (SRAM), a Read-Only Memory (ROM), an Electrical Erasable Programmable Read-Only Memory (EEPROM), a Programmable Read-Only Memory (PROM), a magnetic memory, a magnetic disk, an optical disk and the like.
In some embodiments, the memory 30 may be an internal storage unit of the guide robot, for example a hard disk of the guide robot. In some other embodiments, the memory 30 also may be external storage equipment of the guide robot, such as a plugin hard disk equipped on the guide robot, a Smart Media Card (SMC), an SD card and a Flash Card (FC). Further, the memory 30 also may include the internal storage unit of the guide robot and the external storage equipment, and may be used for storing application software installed on the guide robot and all types of data, such as a code of a moving region calibration program, and used for temporarily storing data that have been output or are about to output.
The guide robot also includes the moving region calibration program which is stored in the memory 30 and may be operated on the controller 10. The moving region calibration program is executed by the controller 10 to implement the following steps:
a1. the movement instruction is detected and received;
a2. region calibration parameters corresponding to the received movement instruction are determined according to a predetermined mapping relation between the movement instruction and the region calibration parameters, wherein the region calibration parameters include a pending moving region of the guide robot, a light display parameter in the pending moving region, and a driving parameter corresponding to the pending moving region and the light display parameter;
a3. the light emitting module is driven to carry out light display calibration in the pending moving region according to the determined region calibration parameters.
The controller 10 drives the light emitting module 20 according to its received movement instruction to carry out light display on a corresponding region around the shell; the corresponding region is a region (namely a pending moving region) where the guide robot is about to move according to the movement instruction. The mapping relation between the movement instruction and the pending moving region is preset in the controller 10, so that the guide robot may display and calibrate its pending moving region through the light emitting module 20 to visibly reflect a movement trend of the guide robot.
Further, the controller 10 is also used for executing the moving region calibration program to further implement the following steps before the step a1:
preset normally-on warning region parameters are obtained, wherein the normally-on warning region parameters include a normally-on warning region, a light display parameter in the normally-on warning region, and a driving parameter corresponding to the normally-on warning region and the light display parameter in the normally-on warning region, and the normally-on warning region is a region surrounding the guide robot;
the light emitting module is driven to carry out light display calibration in the normally-on warning region according to the obtained normally-on warning region parameters.
The pending moving region includes the normally-on warning region (a circular region D in
Further, the step a2 includes:
the region calibration parameters corresponding to the received movement instruction are determined according to the predetermined mapping relation between the movement instruction and the region calibration parameters, the moving prewarning region is determined according to the determined region calibration parameters, and whether an obstacle exists within a preset size range on a movement path corresponding to the movement instruction or not is detected, wherein the region calibration parameters include the pending moving region of the guide robot, the pending moving region includes the normally-on warning region and the maximum warning region, and the moving prewarning region is an annular region surrounded by the normally-on warning region and the maximum warning region;
the region calibration parameters of the light emitting module in the determined moving prewarning region are determined according to an obstacle detection result.
It should be noted that the step that the region calibration parameters of the light emitting module in the moving prewarning region (the annular region surrounded by the circular regions D and X in
a provided distance sensor detects a distance d between the obstacle and the robot in real time or regularly;
if the detected distance d is shorter than or equal to the minimum warning distance dmin (for example, a distance between an intersection, which is formed by a connecting line of the obstacle and the robot and a boundary line of the normally-on warning region, and the robot is the minimum warning distance between the obstacle and the normally-on warning region) between the obstacle and the normally-on warning region, the region calibration parameters are determined as predetermined first region calibration parameters;
if the detected distance d is longer than the minimum warning distance dmin between the obstacle and the normally-on warning region, and shorter than or equal to the maximum warning distance dmax (for example, a distance between an intersection, which is formed by the connecting line of the obstacle and the robot and a boundary line of the maximum warning region, and the robot is the maximum warning distance between the obstacle and the maximum warning region) between the obstacle and the maximum warning region, a current speed v of the robot is detected, current warning parameters f(d, v) are calculated according to the detected distance d and the current speed v of the robot based on a preset first warning parameter formula (for example, the first warning parameter formula is as follows: f(d, v)=c+m*(v/d), c and m are both constants), and second region calibration parameters corresponding to the calculated warning parameters are determined as the region calibration parameters according to a predetermined mapping relation between the warning parameter and the region calibration parameter;
if the detected distance d is longer than the maximum warning distance dmax between the obstacle and the maximum warning region, the current speed v of the robot is detected, the maximum design speed vmax of the robot is determined, current warning parameters f(d, v) are calculated according to the current speed v and the maximum design speed vmax of the robot based on a preset second warning parameter formula (for example, the second warning parameter formula is as follows: f(d, v)=c+n*(v/vmax), c and m are both constants), and third region calibration parameters corresponding to the calculated warning parameters are determined as the region calibration parameter according to a predetermined mapping relation between the warning parameter and the region calibration parameter.
Further, according to the guide robot of this embodiment, the light emitting module 20 is arranged on the outer surface of a chassis of the shell, so that the light emitting module 20 may not destroy the original appearance of the guide robot, and is closer to the ground to make a light effect displayed on the ground brighter and clearer.
Furthermore, the light emitting module 20 of this embodiment includes a plurality of LED annular light bars which are axially arranged in a spacing manner; and the outer ring walls of the LED annular light bars are luminous surfaces, and tilt downwards. As the outer ring walls of the LED annular light bars tilt downwards, light rays emitted by the LED annular light bars are projected towards the periphery of the shell to form a corresponding annular light display region; the controller 10 controls on-off states of LED light beads at different positions on the LED annular light bars, thus realizing light display in different regions. The LED annular light bars of this embodiment are LED multi-color light bars, so that the controller 10 may adjust and control display colors of the LED annular light bars in the pending moving region, and the pending moving region is more colorful and striking, wherein the LED annular light bar at the innermost ring may be independently connected with the controller 10 so as to be kept in a normally-on state, so that the normally-on warning region is formed around the shell; all the rest LED annular light bars are connected in series with one another, so that only an input pin of the first lamp of the rest LED annular light bars needs to be connected to the signal output end of the controller 10; and the controller 10 controls the rest LED annular light bars to realize light display of the pending moving region.
Further, the light emitting module 20 of this embodiment also includes a plurality of laser devices which are distributed on the chassis of the shell along the LED annular light bars in a spacing manner. As laser emitted by the laser devices has the characteristics of large emission range, bright color, high brightness, high directivity, small light dispersion degree and the like, the multiple laser devices of the light emitting module 20 may highlight edges of the pending moving region and the warning regions, and ranges of the pending moving region and the warning regions are more definite. An edge display mode of the laser devices for the pending moving region and the warning regions is as follows: each laser device displays a curved line segment, and the multiple laser devices are arranged according to a specific mode, so that the curved line segments of the multiple laser devices are spliced to form the edge of the pending moving region or the edges of the warning regions; and the specific arrangement of the laser devices may be correspondingly adjusted according to a display demand.
Further, with reference to
A method of calibrating a moving region of a guide robot is further provided. The guide robot includes a signal receiving unit for receiving a movement instruction, a controller and a light emitting module. The implementation of the method of the disclosure may be based on the above provided technical solution of the guide robot.
As shown in
Step S10, the signal receiving unit detects and receives the movement instruction, and sends the received movement instruction to the controller;
the signal receiving unit detects whether there is a movement instruction request or not in real time, and receives the movement instruction if the movement instruction is detected; the movement instruction may be a network instruction, a Bluetooth signal instruction or own sensor signals and the like, such as a touch signal instruction generated by a touch screen of the guide robot and a voice instruction received by a voice sensor of the guide robot; and after receiving the movement instruction, the signal receiving unit sends the received instruction to the controller to enable the controller to carry out subsequent processing operation.
Step S20, the controller determines region calibration parameters corresponding to the received movement instruction according to a predetermined mapping relation between the movement instruction and the region calibration parameters, wherein the region calibration parameters include a pending moving region of the guide robot, a light display parameter in the pending moving region, and a driving parameter corresponding to the pending moving region and the light display parameter;
a mapping relation table between the movement instruction and the region calibration parameters is preset in the controller; after receiving the movement instruction, the controller may determine the region calibration parameters corresponding to the movement instrument by looking up the preset mapping relation table, wherein the pending moving region of the guide robot is a region where the guide robot is about to move according to the movement instruction; for example, when the movement instruction is forward or backward movement, the pending moving region includes a section of region in front of or behind the guide robot; when the movement instruction is left or right turning, the pending moving region includes a region covering paths through which the guide robot may pass during left or right turning. In addition, the light display parameters in the pending moving region may include a color, brightness, a display form and the like; the display form may include normally-on display, flickering display, flowing display and the like; the light calibration colors and the display modes of the pending moving regions corresponding to different movement instructions may be designed to be different, so that a calibrated region may be displayed in multi-color and diversified manners, attracts the attentions of people more easily, and also would be more beautiful.
Step S30, the controller drives the light emitting module to carry out light display calibration in the pending moving region according to the determined region calibration parameters.
After determining the region calibration parameters corresponding to the movement instruction, the controller drives the light emitting module to carry out the light display with the light color, the brightness and the display form, which are determined, in the determined pending moving region.
According to the method of calibrating the moving region of the guide robot of the embodiment, the guide robot determines the pending moving region corresponding to the movement instruction at receiving of the movement instruction, and then controls a display module to carry out the light display calibration in the pending moving region, so that a movement direction and a movement trend of the guide robot may be visibly displayed, and people can accurately avoid the guide robot, thereby avoiding occurrence of a phenomenon of a collision accident between people and the guide robot, which protects the safety of people and the guide robot, and enables the guide robot to move more efficiently.
As shown in
Step S40, the controller obtains preset normally-on warning region parameters, wherein the normally-on warning region parameters include the normally-on warning region, a light display parameter in the normally-on warning region, and a driving parameter corresponding to the normally-on warning region and the light display parameter in the normally-on warning region, and the normally-on warning region is a region surrounding the guide robot;
after the guide robot is switched on, the controller obtains the normally-on warning region parameters preset in a system; the light display parameters of the normally-on warning region include a color, brightness, a display form and the like in the normally-on warning region, wherein the preset normally-on warning region surrounds the guide robot, and is mainly used for warning people against putting feet or other objects in the normally-on warning region; this normally-on warning region does not need to be very large as long as places outside the normally-on warning region are safe; and the normally-on warning region may be an annular region surrounding the guide robot, and also may be regions in other shapes surrounding the guide robot.
Step S50, the controller drives the light emitting module to carry out light display calibration in the normally-on warning region according to the obtained normally-on warning region parameters.
The controller drives the light emitting module to carry out the light display with the color, the brightness and the form, which are determined, in the normally-on warning region according to the obtained normally-on warning region parameters; the normally-in warning region is kept being displayed when the guide robot is static, moving and steering and in various abnormal states to always keep a safe warning effect to remind people of not moving into this region all the time.
According to the technical solution of this embodiment, after the guide robot is switched on, the light emitting module carries out the light display around the guide robot to display the warning region surrounding the guide robot, thereby warning people of not letting the tips of toes enter the warning region to prevent injury caused by the guide robot to the tips of the toes of a human body and also avoid the influence of the tips of the toes of people on normal movement of the guide robot.
As shown in
Step S202, the controller determines region calibration parameters corresponding to a received movement instruction according to a predetermined mapping relation between the movement instruction and the region calibration parameters, determines a moving prewarning region according to the determined region calibration parameters, and detects whether an obstacle exists within a preset size range on a movement path corresponding to the movement instruction or not, wherein the region calibration parameters include the pending moving region of the guide robot, the pending moving region includes a normally-on warning region and the maximum warning region, and the moving prewarning region is an annular region (which is surrounded by circular regions D and X in
In this solution, the step that after the movement instruction is received, whether the obstacle exists within the preset size range on the movement path corresponding to the movement instruction or not is then detected is mainly to determine whether a danger exists on a path, where the guide robot is about to move, or not, wherein the movement path corresponding to the movement instruction is interpreted as: when the movement instruction is a forward movement instruction, its corresponding movement path is a path where the guide robot passes during forward movement; when the movement instruction is a backward movement instruction, its corresponding movement path is a path where the guide robot passes during backward movement; when the movement instruction is a left turning instruction, its corresponding movement path is a path where the guide robot passes during left turning; and when the movement instruction is a right turning instruction, its corresponding movement path is a path where the guide robot passes during right turning, wherein proper range values may be set for the preset size ranges on the forward movement path and the backward movement path, but for the left turning path and the right turning path, their preset size ranges are required to be correspondingly set as range values capable of covering moving regions where the guide robot passes during turning, so that a detection result is meaningful. Here, the detection operation may be carried out by sensors, such as infrared sensors and ultrasonic sensors, of the guide robot.
Step S203, the controller determines region calibration parameters of the light emitting module in the determined moving prewarning region according to an obstacle detection result.
In one embodiment of the disclosure, the step S203 includes:
a provided distance sensor detects a distance d between the obstacle and the robot in real time or regularly;
if the detected distance d is shorter than or equal to the minimum warning distance dmin (for example, a distance between an intersection, which is formed by a connecting line of the obstacle and the robot and a boundary line of the normally-on warning region, and the robot is the minimum warning distance between the obstacle and the normally-on warning region) between the obstacle and the normally-on warning region, the region calibration parameters are determined as predetermined first region calibration parameters;
if the detected distance d is longer than the minimum warning distance dmin between the obstacle and the normally-on warning region, and shorter than or equal to the maximum warning distance d. (for example, a distance between an intersection, which is formed by the connecting line of the obstacle and the robot and a boundary line of the maximum warning region, and the robot is the maximum warning distance between the obstacle and the maximum warning region) between the obstacle and the maximum warning region, a current speed v of the robot is detected, current warning parameters f(d, v) are calculated according to the detected distance d and the current speed v of the robot based on a preset first warning parameter formula (for example, the first warning parameter formula is as follows: f(d, v)=c+m*(v/d), c and m are both constants), and second region calibration parameters corresponding to the calculated warning parameters are determined as the region calibration parameter according to a predetermined mapping relation between the warning parameter and the region calibration parameter;
if the detected distance d is longer than the maximum warning distance dmax between the obstacle and the maximum warning region, the current speed v of the robot is detected, the maximum design speed vmax of the robot is determined, current warning parameters f(d, v) are calculated according to the current speed v and the maximum design speed vmax of the robot based on a preset second warning parameter formula (for example, the second warning parameter formula is as follows: f(d, v)=c+n*(v/vx), c and m are both constants), and third region calibration parameters corresponding to the calculated warning parameters are determined as the region calibration parameters according to a predetermined mapping relation between the warning parameter and the region calibration parameter.
In the above-mentioned embodiment, different region calibration parameters of the moving warning region are determined according to the distance between the obstacle and the robot, and the moving speed of the robot and a distance between a pedestrian and the robot correspond to the region calibration parameters; the faster the robot, the closer the pedestrian to the robot; the region calibration parameters may be set to be more emergent (for example, the light flickering frequency is higher) to show a greater warning significance.
A display region division mode available for the method of the solution is provided below:
the whole light display range centers on the guide robot, and a circle of lighting region is formed on the ground; and the whole lighting region is selected in accordance with the following conditions:
1. this region may not be too small, which must cover a perpendicular projection region of the guide robot on the ground and keep an allowance;
2. this region has dynamic adjustability, which must mark a possible range of movement of the guide robot and display corresponding regions according to an actual movement trend;
3. the warning region may not be too large; a too large warning region easily causes a psychological line of defense to a user, and the user would get too far away from the guide robot, thus affecting an interaction effect between the user and the guide robot (for example, a camera may not acquire information of the user, a microphone may not collect voices of the user, and the user standing too far away cannot operate the touch screen).
According to the above requirements, a design as shown in
With reference to
If the circular region X is displayed as a whole light and shadow region, the third article of the design principle may not be met as the warning region is too large, so that a division scheme will be further made below:
1) a minimum region (the circular region D as shown in
2) a light and shadow display mode is added for displaying according to cases; the controller of the guide robot controls the light emitting module according to the received movement instruction to mark the corresponding moving region (namely the pending moving region), so that display of unnecessary regions is reduced, and the above-mentioned conditions 2 and 3 are met;
To be specific, a display mode designed for the guide robot may include:
1. the normally-on warning region;
2. a left turning mode, correspondingly displaying and calibrating a region for left turning;
3. a right turning mode, correspondingly displaying and calibrating a region for right turning;
4. a forward movement mode, correspondingly displaying and calibrating a section of fan-shaped region in front of the guide robot;
5. a backward movement mode, correspondingly displaying and calibrating a section of fan-shaped region behind the guide robot;
6. a fast forward movement mode, correspondingly displaying and calibrating a section of fan-shaped region behind the guide robot, and emitting laser towards the front side through the laser devices to display the edge of a path;
wherein distributions of the colors and the brightness and the display forms of all the regions may all be preset according to requirements.
It should be noted that the above is only one region division solution provided by the disclosure, but not intended to limit the scope of protection of the scheme of the disclosure. The method of the disclosure also may be applicable to other region division schemes.
A computer readable storage medium is further provided, which is applied to a guide robot, and stores a moving region calibration program. The moving region calibration program is executed by a controller to implement the following steps:
a1. a movement instruction is detected and received;
a2. region calibration parameters corresponding to the received movement instruction are determined according to a predetermined mapping relation between the movement instruction and the region calibration parameters, wherein the region calibration parameters include a pending moving region of the guide robot, a light display parameter in the pending moving region, and a driving parameter corresponding to the pending moving region and the light display parameter;
a3. the light emitting module is driven to carry out light display calibration in the pending moving region according to the determined region calibration parameters.
Further, the moving region calibration program is executed to further implement the following steps:
preset normally-on warning region parameters are obtained, wherein the normally-on warning region parameters include a normally-on warning region, a light display parameter in the normally-on warning region, and a driving parameter corresponding to the normally-on warning region and the light display parameter in the normally-on warning region, and the normally-on warning region is a region surrounding the guide robot;
the light emitting module is driven to carry out light display calibration in the normally-on warning region according to the obtained normally-on warning region parameters.
Further, the step a2 includes:
the region calibration parameters corresponding to the received movement instruction are determined according to the predetermined mapping relation between the movement instruction and the region calibration parameters, the moving prewarning region is determined according to the determined region calibration parameters, and whether an obstacle exists within a preset size range on a movement path corresponding to the movement instruction or not is detected, wherein the region calibration parameters include the pending moving region of the guide robot, the pending moving region includes the normally-on warning region and the maximum warning region, and the moving prewarning region is an annular region surrounded by the normally-on warning region and the maximum warning region;
region calibration parameters of the light emitting module in the determined moving prewarning region are determined according to an obstacle detection result.
Further, the step that the region calibration parameters of the light emitting module in the moving prewarning region are determined according to the obstacle detection result includes:
a provided distance sensor detects a distance d between the obstacle and the robot in real time or regularly;
if the detected distance d is shorter than or equal to the minimum warning distance dmin between the obstacle and the normally-on warning region, the region calibration parameters are determined as predetermined first region calibration parameters;
if the detected distance d is longer than the minimum warning distance dmin between the obstacle and the normally-on warning region, and shorter than or equal to the maximum warning distance dmax between the obstacle and the maximum warning region, a current speed v of the robot is detected, current warning parameters are calculated according to the detected distance d and the current speed v of the robot based on a preset first warning parameter formula, and second region calibration parameters corresponding to the calculated warning parameters are determined as the region calibration parameters according to a predetermined mapping relation between the warning parameter and the region calibration parameter;
if the detected distance d is longer than the maximum warning distance dmax between the obstacle and the maximum warning region, the current speed v of the robot is detected, the maximum design speed vmax of the robot is determined, current warning parameters are calculated according to the current speed v and the maximum design speed vmax of the robot based on a preset second warning parameter formula, and third region calibration parameters corresponding to the calculated warning parameters are determined as the region calibration parameters according to a predetermined mapping relation between the warning parameter and the region calibration parameter.
The specific embodiment of the computer readable storage medium of the disclosure is basically the same as the above-mentioned embodiments of the method of calibrating the moving region, so that no more details will be given here.
By the description of the foregoing implementation modes, it will be evident to those skilled in the art that the methods according to the above embodiments may be implemented by means of software and a necessary general-purpose hardware platform; they may of course be implemented by hardware, but in many cases the former will be more advantageous. Based on such an understanding, the essential technical solution of the disclosure, or the portion that contributes to the prior art may be embodied as software products. Computer software products can be stored in a storage medium (e.g., an ROM/RAM, a magnetic disk, an optical disc) and may include a plurality of instructions causing a set of terminal equipment (e.g., a mobile phone, a computer, a server, or network equipment) to execute the methods described in the various embodiments of the disclosure.
The foregoing embodiments are only preferred embodiments of the disclosure and therefore are not intended as limiting the patentable scope of the disclosure. Equivalent structure transformations made by contents of the specification and the accompanying drawings of the disclosure, or direct/indirect application to other relevant technical fields shall all fall within the scope of patentable protection of the disclosure under the inventive concept of the disclosure.
Number | Date | Country | Kind |
---|---|---|---|
201610899726.2 | Oct 2016 | CN | national |
This application is a national phase entry of the international application PCT/CN2017/091376, filed on Jun. 30, 2017 and claims priority to China Patent Application No. CN2016108997262, filed on Oct. 14, 2016 and entitled “Guide Robot and Method of Calibrating Moving Region thereof”, which is hereby incorporated by reference in its entirety.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2017/091376 | 6/30/2017 | WO | 00 |