Robot automatic following method and system
By acquiring the location information of the robot and the staff, and using UWB positioning and LiDAR to identify their identities, the robot can be controlled to automatically follow the staff. This solves the problem of inconvenient remote control operation in existing technologies and achieves stable following of the robot and the staff, as well as precise planning of navigation paths.
Patent Information
- Application Number
- CN202210873249.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-22
- Publication Date
- 2024-11-01
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Current mobile robots require users to consciously operate them with a remote control, which is inconvenient.
By acquiring the location information of robots and staff in the work area, using UWB positioning and LiDAR to identify personnel, the robot is controlled to automatically follow the staff, plan navigation routes and avoid obstacles, thus achieving stable following between the robot and the staff.
The robot can automatically identify and follow workers, avoiding incorrect following. It is simple to operate, has good following effect, accurate navigation path, and can recharge itself, making it convenient to use.
Smart Images

Figure CN115291606B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of automatic following, and relates to a robot automatic following method and system. Background Art
[0002] With the recent advancement of sensors and the maturity of control technology, robots are no longer limited to processing components in factories, but are gradually moving from factories to all aspects of work and life, helping people handle repetitive tasks in daily work and life, such as testing, cleaning or carrying. In addition, as the cost of various electronic parts decreases, the manufacturing cost of robots is reduced and they are commercialized, which is gaining more and more attention in the industry.
[0003] Depending on whether the robot base can move, robots are divided into fixed robots and mobile robots. At present, mobile robots have been widely used in more and more fields. In the prior art, there are already some technical solutions for setting electric walking devices, such as a remote-controlled self-propelled luggage bag disclosed in Chinese patent document CN103315484A. This technical solution can remotely control the self-propelled forward, reverse, stop and turn left and right of the luggage bag, saving the user's physical strength to a great extent.
[0004] Although the existing technology solves the problem of mobile robot walking, its walking still requires the user to consciously operate the remote control, and the operator's hands are occupied by the remote control, which still causes the problem of inconvenience in use. Summary of the invention
[0005] The purpose of the present invention is to provide a robot automatic following method and system to realize the robot's automatic following of a worker.
[0006] In order to achieve the above object, the basic scheme of the present invention is: a robot automatic following method, which comprises the following steps:
[0007] S1, obtain the positions of all robots in the work area and the real-time positions of the workers;
[0008] S2, start a robot that is closest to the worker and control the robot to move toward the worker;
[0009] S3, real-time collection of distance signals between the robot and the staff. When the distance between the real-time positions of the robot and the staff is less than a threshold, the robot identifies the staff.
[0010] S4, after the robot recognizes the identity of the staff, it maintains a relative distance with the staff and follows them.
[0011] The working principle and beneficial effect of this basic solution are: according to the real-time position information of the robot and the staff, the robot is controlled to move, and the collected distance signal is used to make the robot automatically follow the staff. The robot can identify the identity information of the staff to ensure that the person it is following is the staff of the area and avoid wrong following.
[0012] Furthermore, during the process of the robot identifying the staff, if the detected staff identity information is not stored in the tag list of the base station, the base station sends the detected staff identity information to the host computer;
[0013] The host computer receives the staff identity information sent by the base station and manually identifies whether to add it as a new tag.
[0014] The operation is simple and label information can be added according to user needs.
[0015] Furthermore, the method for the robot to follow the worker while maintaining a relative distance is as follows:
[0016] The robot uses UWB positioning to obtain the position and distance of the person wearing the UWB positioning bracelet;
[0017] Through laser radar scanning, the position of the legs and the direction of travel of the person wearing the uwb positioning bracelet are determined;
[0018] Control the distance between the robot and the person wearing the uwb positioning bracelet and the relative angle to the direction of travel.
[0019] By using UWB positioning and laser radar, the required position signal, distance signal and travel direction are obtained, so that the distance between the robot and the person wearing the UWB positioning bracelet and the relative angle with the travel direction can be controlled, and the following effect is better.
[0020] Further, the method of controlling the relative angle between the robot and the direction of travel is:
[0021] Identify the speed and direction of movement of people wearing uwb positioning bracelets;
[0022] The coordinate system is established in real time with the line connecting the centers of the two feet of the person wearing the uwb positioning bracelet as the center point and the coordinate origin, the direction of travel as the y-axis and the x-axis perpendicular to the direction of travel as the x-axis;
[0023] Control the robot's speed, keep the distance R from the person, and keep moving in the direction of -45 degrees in the coordinate system.
[0024] Thereby maintaining a stable following effect.
[0025] Furthermore, in the process of controlling the robot to move toward the staff in step S2, and / or automatically following the staff in step S4, a method for autonomous operation of the robot is also included, specifically:
[0026] S11, determining the initial position and target position of the robot in real time;
[0027] S12, obtaining environmental information in real time and determining obstacles in the environment and their locations;
[0028] S13, obtaining a movement curve of the obstacle within the predicted time period according to the position change of the obstacle at adjacent time points;
[0029] S14, dividing the predicted time period into segments, and generating obstacle position matrices corresponding to different time sub-segments;
[0030] S15, obtaining blank position matrices in different time periods, performing an “AND” operation on all blank position matrices in all time periods, and obtaining the end point of a continuous curve with the smallest angle and the longest distance between the matrix and the initial position and the target position as the coordinate of the intermediate target position;
[0031] S16, the robot moves from the initial position to the intermediate target position;
[0032] S17, using the intermediate target position coordinates as the initial position, repeat S12-S16.
[0033] Based on the robot position, obstacle position and target position information, the navigation route is planned, which is simple to operate and conducive to stable control. The navigation path can be predicted, the location of obstacles can be predicted in advance, and the obstacle avoidance effect is better.
[0034] Further, when the robot is controlled to move toward the worker in step S12, the position of the robot is taken as the initial position, and the position at a distance R to the right rear of the worker is taken as the target position;
[0035] In the process of automatically following the worker in step S14, the position of the robot is taken as the initial position, and the position at a distance R to the right rear of the worker is taken as the target position.
[0036] Set the initial position and target position to ensure that the robot follows the staff in real time.
[0037] Furthermore, according to the position change of the obstacle at adjacent time points, the method for obtaining the movement curve of the obstacle within the prediction time period is as follows:
[0038] S21, assuming that the interval between adjacent time points is t, calculate the magnitude of the speed v of the obstacle in the time intervals tm, ..., t-2 and t-1, and the direction of the speed v of the obstacle;
[0039] S22. Obtain the speed magnitude and direction using the first m time intervals, and fit to obtain the speed magnitude and direction of the obstacle at time t;
[0040] S23. Calculate the driving distance smin of the obstacle at time t according to the speed magnitude. If smin < st, accept the speed v, where st is the distance threshold, and execute S24; otherwise, reject the accepted speed, reduce the time interval between adjacent time points to t, increase the fitting order, and continue to execute S23;
[0041] S24. Calculate the position of the obstacle at time t according to the magnitude and direction of the speed v of the obstacle:
[0042] S25. Compare the fitted predicted position with the actual position. If it is within the position threshold range, predict the position, speed magnitude, and direction at time t + 1.
[0043] Predict the position of the obstacle using the speed and direction of the obstacle, which is beneficial for planning the navigation route of the robot.
[0044] Furthermore, the method for performing the "AND" operation on all blank position matrices within all running time periods is as follows:
[0045] Divide the area between the initial position and the target position into multiple area blocks.
[0046]
[0047] Among them, A t , is the blank matrix of the t time sub - segment, x 11 is the area block where the initial position is located, x mn is the area block where the target distance is located, m and n are the row and column numbers of the position matrix, both are positive integers, and t is the time sub - segment number;
[0048] When there is an obstacle in the area block x ij within the t time sub - segment, then x ij takes the value of 1, otherwise 0, 1 ≤ i ≤ m, 1 ≤ j ≤ n;
[0049] Among them, t ∈ [T1, T2], T1 is the start time of the prediction time, and T2 is the end time of the prediction time;
[0050] A = A T1 *......*A h *A h+1 *...*A T2 , A is the final blank matrix of the prediction time, and h is the time sub - segment number.
[0051] Partitioning facilitates the robot's step-by-step movement and makes the navigation route more precise.
[0052] Furthermore, the power information of the robot is monitored in real time. When the power value is less than the power threshold, the robot is navigated with the charging pile as the target location, and the robot is controlled to automatically return to the charging station for charging;
[0053] After charging is completed, the robot is controlled to return to the working area with the working area as the target position.
[0054] The robot can automatically perform charging operations, making it easy to use.
[0055] The present invention also provides a robot automatic following system, including a position information collection unit and a control unit, wherein the position information collection unit is used to collect position information of the robot and the staff, the output end of the position information collection unit is connected to the input end of the control unit, and the control unit executes the method described in the present invention to perform automatic following control of the robot.
[0056] The system has a simple structure, realizes automatic following control of the robot, and is easy to use. BRIEF DESCRIPTION OF THE DRAWINGS
[0057] Figure 1 It is a flow chart of the robot automatic following method of the present invention. DETAILED DESCRIPTION
[0058] Embodiments of the present invention are described in detail below, examples of which are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present invention, and cannot be understood as limiting the present invention.
[0059] In the description of the present invention, it is necessary to understand that the terms "longitudinal", "lateral", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", etc., indicating the orientation or position relationship, are based on the orientation or position relationship shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present invention.
[0060] In the description of the present invention, unless otherwise specified and limited, it should be noted that the terms "installed", "connected" and "connected" should be understood in a broad sense. For example, it can be a mechanical connection or an electrical connection, or it can be the internal connection between two components. It can be a direct connection or an indirect connection through an intermediate medium. For ordinary technicians in this field, the specific meanings of the above terms can be understood according to the specific circumstances.
[0061] The present invention discloses a robot automatic following method, such as Figure 1 As shown, it includes the following steps:
[0062] S1, obtain the positions of all robots in the work area (robots in place refer to robots that are idle and can be put into work) and the real-time position of the staff. The specific robot can periodically transmit its working status signal to the controller, and the working status signal may include its working or idle signal, its position signal, and its power signal.
[0063] In a preferred embodiment, an identification device (for example, set at a location such as the entrance to the work area) is used to automatically identify a mark (such as an RFID tag or a uwb positioning bracelet, etc.) carried by a staff member to determine the staff member entering the work area. The in-place robot waits at the entrance to the work area. The real-time position of the specific robot and the real-time position of the staff member can be obtained and transmitted to the controller based on the positioning device they carry (specifically, any positioning device can be used, for example, information can be sent based on the Bluetooth device, wifi device, etc. carried by them, and multiple identification devices can be positioned according to the parabola method; or the Beidou positioning module they carry can be used for positioning);
[0064] S2, collects the distances between the robots in the work area and the corresponding staff members, compares the distances, starts a robot that is closest to the staff member, and controls the robot to move toward the staff member;
[0065] S3, real-time collection of distance signals between the robot and the staff. When the distance between the real-time position of the robot and the staff is less than a threshold, the robot identifies the staff. For example, the robot obtains the identity information of the staff wearing a UWB positioning bracelet (or an integrated D-DWM-PG1.7 tag module) through UWB (UltraWideband, ultra-wideband technology) and identifies and pairs them.
[0066] S4, after the robot recognizes the identity of the staff, it automatically follows the staff and the robot maintains a relative distance with the staff and follows.
[0067] In a preferred embodiment of the present invention, during the process of the robot identifying the staff, if the detected staff identity information is not stored in the tag list of the base station, the base station sends the detected staff identity information to the host computer;
[0068] The host computer receives the staff identity information sent by the base station and manually identifies whether to add it as a new tag.
[0069] In a preferred embodiment of the present invention, the method for the robot to follow the worker while maintaining a relative distance is as follows:
[0070] The robot uses UWB (Ultra Wideband) positioning to obtain the position and distance of the staff wearing a UWB positioning bracelet (or integrated D-DWM-PG1.7 tag module); of course, the position and distance of the staff can also be obtained through LiDAR.
[0071] Through laser radar scanning, the position of the legs and the direction of travel of the person wearing the uwb positioning bracelet can be determined. Specifically, the image of the staff member can be scanned by laser radar, and the position of the legs and feet and the direction of the feet can be identified using image recognition technology, and the center point of the line connecting the heels of the feet and the center point of the line connecting the toes of the feet can be obtained. The direction from the center point of the heel line to the center point of the toe line is the direction of travel.
[0072] Control the distance between the robot and the person wearing the UWB positioning bracelet (preferably the distance between the center point of the line connecting the centers of the two feet of the person wearing the UWB positioning bracelet) and the relative angle to the direction of travel.
[0073] In a preferred embodiment of the present invention, the method for controlling the relative angle between the robot and the travel direction is:
[0074] Identify the speed and direction of movement of people wearing uwb positioning bracelets;
[0075] The coordinate system is established in real time with the center point of the line connecting the centers of the two feet of the person wearing the uwb positioning bracelet as the coordinate origin, the travel direction as the y-axis, and the x-axis perpendicular to the travel direction; the robot's travel speed is controlled, the distance from the person is kept at R, and the robot is kept moving in the direction of -45 degrees in the coordinate system.
[0076] Preferably, a D-PDOA-Node base station can be installed on the robot. The D-PDOA-Node base station stores a tag list (K list) inside. The K list stores information such as the identity ID of the staff who perform ranging and positioning with the robot. The D-PDOA-Node base station performs two ranging with the identity tag carried by the staff through two DW1000 chips, and establishes an equation based on the time phase difference and distance of the two ranging to solve the x, y coordinates and distance value of the tag relative to the robot. After solving the x and y coordinate values, it is equivalent to knowing the angular deviation from the tag to the base station. Taking the rectangular coordinate axis as an example, from the front direction of the base station, the negative half axis of the x-axis is the right side of the base station, and the positive half axis is the left side of the base station. The positive half axis of the Y-axis is the front of the base station, and the back of the base station cannot obtain the correct coordinates.
[0077] In a preferred embodiment of the present invention, in the process of controlling the robot to move toward the staff in step S2, and / or automatically following the staff in step S4, a method for autonomous operation of the robot is also included, specifically:
[0078] S11, determine the initial position and target position of the robot in real time; the initial position is its current position, and the target position is the final target position or a staged target position, such as the position where the robot is to work, the charging position or the position of the person being followed, and the specific target can be determined in advance.
[0079] S12, real-time acquisition of environmental information, determination of obstacles in the environment and their locations; specifically, environmental image information may be acquired through a camera carried by the robot, or obstacles may be acquired through radar signals acquired by a laser radar carried by the robot. In this embodiment, the camera and the laser radar may preferably be capable of 360-degree horizontal and elevation rotation, thereby ensuring full-range detection around the robot.
[0080] In this embodiment, it is preferred to set up a laser radar and a camera, the camera collects environmental image information, and the laser radar signal detects distance, direction and height; the laser radar transmits the detected distance, direction and height information to the controller and marks it on the image. The specific distance information can be determined according to the time difference between the emission wave and the echo of the laser signal, the direction can be determined according to its horizontal rotation angle (when the robot moves, the robot's moving distance needs to be superimposed with the horizontal rotation angle of the laser radar), and the height can be determined according to its pitch rotation angle and distance.
[0081] S13, obtaining a movement curve of the obstacle within the predicted time period according to the position change of the obstacle at adjacent time points;
[0082] S14, dividing the predicted time period into segments, and generating obstacle position matrices corresponding to different time sub-segments;
[0083] S15, obtaining blank position matrices in different time periods, performing an “AND” operation on all blank position matrices in all time periods, and obtaining the end point of a continuous curve with the smallest angle and the longest distance between the matrix and the initial position and the target position as the coordinate of the intermediate target position;
[0084] S16, the robot moves from the initial position to the intermediate target position;
[0085] S17, using the intermediate target position coordinates as the initial position, repeat S12-S16.
[0086] Preferably, the specific method of determining obstacles and their positions in the environment in step S12 is:
[0087] Collect environmental images and identify objects in the environmental images; obtain the height and width of the objects, specifically using a lidar; according to the height and width of the objects, objects higher than the height of the robot chassis or wider than the width of the robot chassis are obstacles; determine the positions of the obstacles in the environment. When controlling the robot to move towards the staff in step S12, use the position where the robot is located as the initial position and the position at a distance R behind the right side of the staff as the target position; during the process of automatically following the staff in step S14, use the position where the robot is located as the initial position and the position at a distance R behind the right side of the staff as the target position.
[0088] More preferably, the method for obtaining the movement curve of the obstacle within the prediction time period according to the position change of the obstacle at adjacent time points is as follows:
[0089] S21, set the time interval between adjacent time points as t, calculate the magnitude of the speed v of the obstacle within the time intervals of t - m, ……, t - 2, and t - 1, as well as the direction of the speed v of the obstacle;
[0090] S22, use the speed magnitudes and directions obtained in the previous m time intervals to fit and obtain the speed magnitude and direction of the obstacle at time t;
[0091] S23, calculate the driving distance smin of the obstacle at this time t according to the speed magnitude. If smin < st, where st is the distance threshold, accept the speed v and execute S24; otherwise, reject the accepted speed, reduce the time interval between adjacent time points to t, and increase the fitting order, and continue to execute S23;
[0092] S24, calculate the position of the obstacle at time t according to the magnitude and direction of the speed v of the obstacle:
[0093] S25, compare the fitted predicted position with the actual position. If it is within the position threshold range, predict the position, speed magnitude, and direction at time t + 1.
[0094] In a preferred solution of the present invention, the method for performing an "AND" operation on all blank position matrices within all operating time periods is as follows:
[0095] Divide the area between the initial position and the target position into multiple area blocks,
[0096]
[0097] where A t , is the blank matrix of the time sub - segment t, x 11 is the area block where the initial position is located, x mnis the area block where the target distance is located, m and n are the row and column numbers of the position matrix, both of which are positive integers, and t is the time sub-segment number. The size of the specific area block can be determined according to the actual situation, and can be but not limited to being equal to or larger than the area size of the robot cross section, preferably the same area size as the robot, for example, a range of 1m*1m is the size of an area block.
[0098] When t, the area block x in the time subsegment ij If there is an obstacle inside, then x ij The value is 1, otherwise it is 0, 1≤i≤m, 1≤j≤n;
[0099] Among them, t,∈[T1, T2], T1 is the start time of the prediction time, and T2 is the end time of the prediction time;
[0100] A=A T1 *......*A h *A h+1 *...*A T2 , A is the final blank matrix of the prediction time, and h is the time sub-segment number.
[0101] Obtain the end point of the continuous curve with the smallest angle and longest distance between the initial position and the target position in the blank matrix as the coordinate of the intermediate target position, and control the robot to move to this position point, preferably to the center of this position point, so that the robot moves from the initial position to the intermediate target position.
[0102] In a preferred embodiment of the present invention, the power information of the robot is monitored in real time. When the power value is less than the power threshold, the robot is navigated with the charging pile as the target position, and the robot is controlled to automatically return to the charging station for charging. After charging is completed, the robot is controlled to return to the working area with the working area as the target position. When the power value of the robot is less than the power threshold, the robot sends a takeover signal to any robot in the working area that is not in operation, and the robot to be charged moves to the working position to take over the work.
[0103] The present invention also provides a robot automatic following system, including a position information collection unit and a control unit, wherein the position information collection unit is used to collect position information of the robot and the staff, the output end of the position information collection unit is electrically connected to the input end of the control unit, and the control unit executes the method described in the present invention to perform automatic following control of the robot.
[0104] The position information acquisition unit includes laser radar such as R2000), camera (such as depth camera D435), obstacle avoidance radar and distance sensor. The robot is equipped with working indicator light, power interface and communication interface.
[0105] The control unit includes a controller and a tag identifier, both of which are installed on the robot. The controller is connected to the laser radar and obstacle avoidance radar respectively through the RJ45 interface, and the controller can be electrically connected to the camera through the USB interface. The output end of the controller is electrically connected to the control end of the robot's motor driver through the CAN bus. The staff carries an identity information tag ID, and the tag identifier is used to identify the tag ID information carried by the staff.
[0106] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "examples", "specific examples", or "some examples" means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.
[0107] Although the embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the claims and their equivalents.
Claims
1. A robot automatic following method, characterized in that: The steps include: S1, obtain the positions of all robots in the work area and the real-time positions of the workers; S2, start a robot that is closest to the worker and control the robot to move toward the worker; S3, real-time collection of distance signals between the robot and the staff. When the distance between the real-time positions of the robot and the staff is less than a threshold, the robot identifies the staff. S4, after the robot recognizes the identity of the staff, it maintains a relative distance with the staff and follows; In the process of controlling the robot to move toward the staff in step S2, and / or automatically following the staff in step S4, the robot autonomous operation method is also included, specifically: S11, determining the initial position and target position of the robot in real time; S12, obtaining environmental information in real time and determining obstacles in the environment and their locations; S13, obtaining a movement curve of the obstacle within the predicted time period according to the position change of the obstacle at adjacent time points; S14, dividing the predicted time period into segments, and generating obstacle position matrices corresponding to different time sub-segments; S15, obtaining blank position matrices in different time periods, performing an AND operation on all blank position matrices in all time periods, and obtaining the end point of a continuous curve with the smallest angle and the longest distance between the initial position and the target position after the AND operation as the intermediate target position coordinates; S16, the robot moves from the initial position to the intermediate target position; S17, using the intermediate target position coordinates as the initial position, repeat S12-S16.
2. The robot automatic following method according to claim 1, characterized in that: During the process of the robot identifying the staff, if the detected staff identity information is not stored in the tag list of the base station, the base station sends the detected staff identity information to the host computer; The host computer receives the staff identity information sent by the base station and manually identifies whether to add it as a new tag.
3. The robot automatic following method according to claim 1, characterized in that: The method for the robot to maintain a relative distance with the worker and follow is as follows: The robot uses UWB positioning to obtain the position and distance of the person wearing the UWB positioning bracelet; Through laser radar scanning, the position of the legs and the direction of travel of the person wearing the uwb positioning bracelet are determined; Control the distance between the robot and the person wearing the uwb positioning bracelet and the relative angle to the direction of travel.
4. The robot automatic following method according to claim 3, characterized in that: The method to control the relative angle of the robot to the direction of travel is: Identify the speed and direction of movement of people wearing uwb positioning bracelets; The coordinate system is established in real time with the line connecting the centers of the two feet of the person wearing the uwb positioning bracelet as the center point and the coordinate origin, the direction of travel as the y-axis and the x-axis perpendicular to the direction of travel as the x-axis; Control the robot's speed, keep the distance R from the person, and keep moving in the direction of -45 degrees in the coordinate system.
5. The robot automatic following method according to claim 1, characterized in that: When the robot is controlled to move toward the worker in step S2, the position of the robot is taken as the initial position, and the position at a distance R to the right rear of the worker is taken as the target position; In the process of automatically following the worker in step S4, the position of the robot is taken as the initial position, and the position at a distance R to the right rear of the worker is taken as the target position.
6. The robot automatic following method according to claim 1, characterized in that: The method for obtaining the movement curve of an obstacle within a prediction time period based on the position change of the obstacle at adjacent time points is as follows: S21. Set the time interval between adjacent time points as t, and calculate the magnitude of the speed v of the obstacle and the direction of the speed v within the time intervals of t - m, ……, t - 2, and t - 1; S22. Use the speed magnitudes and directions obtained in the previous m time intervals to fit and obtain the speed magnitude and direction of the obstacle in the t time period; S23. Calculate the driving distance smin of the obstacle in the t time period according to the speed magnitude. If smin < st, where st is the distance threshold, accept the speed v of the obstacle and execute S24; otherwise, reject the accepted speed, reduce the time interval t between adjacent time points, increase the fitting order, and continue to execute S23; S24. Calculate the position of the obstacle in the t time period according to the magnitude and direction of the speed v of the obstacle; S25. Compare the fitted predicted position with the actual position. If it is within the position threshold range, predict the position, speed magnitude, and direction in the t + 1 time period.
7. The robot automatic following method according to claim 1, characterized in that: The method for performing an "AND" operation on all blank position matrices within all running time periods is as follows: Divide the area between the initial position and the target position into multiple area blocks; Among them, A t, is a blank matrix of time subsegment t, x 11 is the area block where the initial position is located, x mn is the area block where the target distance is located, m and n are the row and column numbers of the position matrix, both of which are positive integers, and t is the time sub-segment number; When t, the area block x in the time subsegment ij If there is an obstacle inside, then x ij The value is 1, otherwise it is 0, 1≤i≤m, 1≤j≤n; where t ∈ [T1, T2], T1 is the start time of the prediction time, and T2 is the end time of the prediction time; A=A T1 *……*A h *A h+1 *…*A T2 , A is the final blank matrix of the prediction time, h is the time sub-segment number, that is, t,.
8. The robot automatic following method according to claim 1, characterized in that: Real-time monitor the power information of the robot. When the power value is less than the power threshold, use the charging pile as the target position to navigate the robot and control the robot to automatically return to the charging station for charging; After charging is completed, use the work area as the target position to control the robot to return to the work area and take its place.
9. A robot automatic following system, characterized in that: It includes a position information acquisition unit and a control unit. The position information acquisition unit is used to acquire the position information of the robot and the staff. The output end of the position information acquisition unit is connected to the input end of the control unit. The control unit executes the robot automatic following method described in any one of claims 1 - 8 to perform robot automatic following control.
