Mobile robot following method, device and readable medium based on electromagnetic positioning

Abstract

The present invention discloses a mobile robot following method, device and readable medium based on electromagnetic positioning, which relate to the field of mobile following. The invention obtains an electromagnetic signal sent from a transmitting module to a receiving module, and calculates the posture information of the receiving module relative to the transmitting module through an electromagnetic positioning algorithm according to the electromagnetic signal; determines whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module; in response to determining that the mobile robot is in a single-person following mode, the linear acceleration and angular acceleration of the mobile robot are calculated through a following robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve following of a single pedestrian target; in response to determining that the mobile robot is in a multi-person following mode, the linear acceleration and angular acceleration of the mobile robot are calculated through a multi-person following robot motion control algorithm to achieve following of multiple pedestrian targets, thereby solving the problem of difficulty in stably and reliably tracking human targets.

Description

Technical Field

[0001] The present invention relates to the field of mobile following, and in particular to a mobile robot following method, device and readable medium based on electromagnetic positioning. Background Art

[0002] In scenarios of human-machine integration and collaboration such as mobile care for the elderly / children / special groups, welcoming and guiding guests in exhibition halls / museums, logistics sorting and handling, and restaurant food delivery, it is necessary to realize human-machine interaction actions such as the task of following human targets by mobile robots. In particular, it is necessary to detect, lock and track specific human targets in multi-person, dynamic and unstructured environments.

[0003] Mobile robots rely on sensors to identify and follow pedestrian targets, including two modes: the tracked person wears a transceiver module and the tracked person does not wear a transceiver module. The tracked person does not wear a transceiver module mode mainly includes cameras and laser radars. Among them, the camera sensor depends on the light intensity of the environment and loses the tracking target in strong and weak light; the laser radar sensor input has sparse features, and it is difficult to achieve stable target recognition in scenes with multiple people and complex obstacles. The tracked person wears a transceiver module mode mainly includes Bluetooth, UWB sensors and electromagnetic sensors. The transceiver modules are placed on the mobile robot and the tracked person respectively, and the two are connected wirelessly as the best way. Among them, the communication distance of Bluetooth and UWB sensors is short and the attenuation is large when crossing obstacles, and the signal is lost in multi-person scenes. Electromagnetic sensors can achieve 360° precise posture tracking without optical occlusion, and can achieve a larger tracking range by adjusting the magnetic field strength. Through multiple transceiver modules, 2 or more people can be tracked at the same time.

[0004] There are difficulties in the mobile robot following method and system using electromagnetic positioning:

[0005] (1) The tracking distance of wireless electromagnetic tracking based on permanent magnets as signal sources is limited by the rapid attenuation of static magnetic field strength;

[0006] (2) The alternating electromagnetic tracking method is limited by the wired connection between the transmitter and the receiver. The alternating electromagnetic tracking method with wireless connection between the transmitter and the receiver has not been effectively applied in following robots. Summary of the invention

[0007] In view of the above-mentioned shortcomings of existing following robots in perception and tracking, especially the difficulty in stably and reliably tracking human targets in outdoor and multi-person environments, the purpose of the embodiments of the present application is to propose a mobile robot following method, device and readable medium based on electromagnetic positioning to solve the technical problems mentioned in the above background technology section.

[0008] In a first aspect, the present invention provides a mobile robot following method based on electromagnetic positioning, comprising the following steps:

[0009] S1, obtaining an electromagnetic signal sent by a transmitting module located on the mobile robot to a receiving module located on a pedestrian target, and calculating the position information of the receiving module relative to the transmitting module through an electromagnetic positioning algorithm according to the electromagnetic signal;

[0010] S2, determining whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module;

[0011] S3, in response to determining that the mobile robot is in a single-person following mode, the linear acceleration and angular acceleration of the mobile robot are calculated by a following robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve following of a single pedestrian target;

[0012] S4, in response to determining that the mobile robot is in multi-person following mode, obtain the average value of the posture information of multiple receiving modules relative to the transmitting module, and calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm based on the average value to achieve following of multiple pedestrian targets.

[0013] Preferably, step S1 specifically includes:

[0014] The center of the transmitting module is defined as the origin of the coordinate system, and three orthogonal magnetic induction intensity components are measured by the receiving module ( B x , B y , B z ), the three coordinate axes of the receiving module's coordinate system are parallel to the transmitting module's coordinate system, and the target coordinate system ( x , y , z ) respectively around x axis, y axis, z Axis rotation Euler angles α , β , γ Then we get the target coordinate system ( u , v , w ), the rotation direction is counterclockwise when looking from top to bottom in each axis direction;

[0015] According to the magnetic dipole model, the orthogonal magnetic induction intensity components ( B x , B y , B z ):

[0016] ;

[0017] In the formula, B T is a constant, B T = μIR 2 / 4, μ is the magnetic permeability of air, I is the current magnitude, R is the coil radius of the transmitting module; m , n , p ) is the unit direction vector of the transmitting module, m 2 + n 2 + p 2 =1; r is the distance from the receiving module to the transmitting module, ;

[0018] According to the orthogonal magnetic induction intensity components ( B x , B y , B z ) calculates the receiving module in the target coordinate system ( u , v , w )The magnetic induction intensity component induced by B u , B v , B w ):

[0019] ;

[0020] In the formula, R is the Euler angle, and the rotation process is described as:

[0021] ;

[0022] In the formula, Rot ( z , γ ) is around z Axis rotation γ angle; Rot ( y , β ) is around y Axis rotation β angle; Rot (x , α ) is around x Axis rotation α angle;

[0023] According to the receiving module in the target coordinate system ( u , v , w )The magnetic induction intensity component induced by B u , B v , B w ) The position information of the receiving module relative to the transmitting module is calculated through the electromagnetic positioning algorithm.

[0024] Preferably, the electromagnetic positioning algorithm includes an optimization algorithm, an analytical method or a wireless tracking algorithm based on a neural network.

[0025] Preferably, step S2 specifically includes:

[0026] By checking the number of connection signals of the receiving module connected to the transmitting module, it is determined whether the mobile robot is in a single-person following mode or a multi-person following mode;

[0027] If the number of connection signals is 1, it is determined that the mobile robot is in a single-person following mode, and step S3 is executed; if the number of connection signals is greater than 1, it is determined that the mobile robot is in a multi-person following mode, and step S4 is executed.

[0028] Preferably, step S3 specifically includes:

[0029] S31, the state vector of the mobile robot in the world coordinate system is:

[0030] ;

[0031] The state vector of the pedestrian target in the world coordinate system is:

[0032] ;

[0033] The state vector of the mobile robot in the pedestrian coordinate system is expressed as:

[0034] ;

[0035] The calculation formula for the angle between the mobile robot's world coordinate system and the pedestrian coordinate system is as follows:

[0036] ;

[0037] Among them, the transformation matrix F is expressed as:

[0038] ;

[0039] According to the state vector of the mobile robot in the pedestrian coordinate system, the distance between the receiving module and the transmitting module is calculated by following the robot motion control algorithm. d and the angle Φ;

[0040] S32, judging the quadrant information of the pedestrian target relative to the mobile robot according to the angle Φ between the receiving module and the transmitting module, and judging the following mode according to the quadrant information:

[0041] ;

[0042] When Φ=[π / 4, 3π / 4], the mobile robot is judged to be behind the pedestrian target, and the follow-up mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to π / 2;

[0043] When Φ=[3π / 4, π]∪[-π, -3π / 4], the mobile robot is judged to be on the right side of the pedestrian target, and the right following mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to π;

[0044] When Φ=[-3π / 4, -π / 4], the mobile robot is judged to be in front of the pedestrian target, and the front follow mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to -π / 2;

[0045] When Φ=[-π / 4, 0]∪[0, π / 4], the mobile robot is judged to be on the left side of the pedestrian target, and the left-side following mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to 0;

[0046] S33; Based on the relative position between the mobile robot and the pedestrian target, environmental perception information and human-machine interaction strategy, the linear acceleration is calculated by following the robot motion control algorithm a v and angular acceleration a w,The motion control algorithms of the following robot include virtual spring force control algorithm, ,social force model / impedance control algorithm, model predictive control algorithm or ,reinforcement learning algorithm.

[0047] As a preferred embodiment, when the following robot motion control algorithm adopts a virtual spring force control algorithm,

[0048] Assume that there is a connection between the mobile robot and the pedestrian target, the origin of the pedestrian coordinate system E and the robot coordinate system , the relaxation length of the virtual spring is the distance between the mobile robot and the pedestrian target d , the angle between the mobile robot and the pedestrian target is Φ, expressed as:

[0049] ;

[0050] Describe the following relationship between the mobile robot and the pedestrian target as a virtual spring force and calculate the virtual elastic deformation force F 1 and virtual bending deformation elastic force F 2;

[0051] ;

[0052] in, k 1 is the elastic coefficient of the virtual spring, in units of N / m ; k 2 is the curvature coefficient of the virtual spring, in units of N / rad ; l 0 is the original length of the virtual spring, in units of m ;

[0053] The dynamic equations of following motion control are expressed as follows:

[0054] ;

[0055] in, M is the mass of the mobile robot, in units of kg ; k 3 is the damping coefficient related to translation, in Ns / m; k 4 is the rotation-related damping coefficient, in Ns / rad;

[0056] The following motion controller is expressed as:

[0057] ;

[0058] in, I is the moment of inertia of the mobile robot; θ eis the angle of the mobile robot in the pedestrian coordinate system; the following motion controller controls the real-time angle Φ between the mobile robot and the pedestrian target to tend to θ e , enabling the robot to achieve the front following, rear following and side following functions of a single pedestrian target.

[0059] Preferably, step S4 specifically includes:

[0060] Repeat step S31 to calculate the distance between the receiving module and the transmitting module of each pedestrian target in the plurality of pedestrian targets respectively. d and the angle Φ, and take their average value to obtain the average angle, and then repeat steps S32-S33 according to the average angle to achieve the front following, rear following, and side following functions of multiple pedestrian targets.

[0061] In a second aspect, the present invention provides a mobile robot following device based on electromagnetic positioning, comprising:

[0062] A posture information acquisition module is configured to acquire an electromagnetic signal sent from a transmitting module located on the mobile robot to a receiving module located on the pedestrian target, and calculate the posture information of the receiving module relative to the transmitting module through an electromagnetic positioning algorithm according to the electromagnetic signal;

[0063] A following mode determination module is configured to determine whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module;

[0064] A single person following control module is configured to, in response to determining that the mobile robot is in a single person following mode, calculate the linear acceleration and angular acceleration of the mobile robot through a following robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve following of a single pedestrian target;

[0065] The multi-person following control module is configured to, in response to determining that the mobile robot is in a multi-person following mode, obtain the average value of the posture information of multiple receiving modules relative to the transmitting module, and calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm based on the average value to achieve the following of multiple pedestrian targets.

[0066] In a third aspect, the present invention provides an electronic device comprising one or more processors; a storage device for storing one or more programs, wherein when the one or more programs are executed by the one or more processors, the one or more processors implement the method described in any implementation manner in the first aspect.

[0067] In a fourth aspect, the present invention provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the method described in any implementation manner in the first aspect.

[0068] Compared with the prior art, the present invention has the following beneficial effects:

[0069] (1) The present invention uses wireless alternating electromagnetic tracking technology to achieve 360° accurate posture tracking without optical occlusion, and can track one, two or more people at the same time, achieving more accurate and stable human tracking; at the same time, by integrating wireless alternating electromagnetic tracking with inertial sensing, it can achieve more complete perception and action prediction of the motion state of the robot and the tracked human body. In terms of control strategy, by combining intelligent control algorithms such as virtual spring force control algorithm, social force model / impedance control algorithm, model predictive control algorithm or reinforcement learning algorithm, an adaptive motion mode for walking paths and human-machine collaboration scenarios is achieved.

[0070] (2) The present invention realizes the function of a mobile robot following a pedestrian target with more accurate recognition, longer distance and better stability by having the pedestrian target wear a receiving module of an electromagnetic sensor and the mobile robot install a transmitting module of the electromagnetic sensor. The mobile robot can also recognize and follow one or more pedestrian targets in a scene with multiple people and complex obstacles.

[0071] (3) The present invention greatly improves the practicality and intelligence level of the follower robot, and is expected to achieve its wide application in daily life, and creates good conditions for further human-machine interaction in a human-machine integration environment. BRIEF DESCRIPTION OF THE DRAWINGS

[0072] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0073] Figure 1 is an exemplary device architecture diagram to which an embodiment of the present application may be applied;

[0074] Figure 2 A schematic flow chart of a mobile robot following method based on electromagnetic positioning according to an embodiment of the present application;

[0075] Figure 3 A working diagram of a transmitting module and a receiving module of electromagnetic positioning of a mobile robot following method based on electromagnetic positioning according to an embodiment of the present application;

[0076] Figure 4 This is a functional demonstration diagram of a mobile robot following method based on electromagnetic positioning according to an embodiment of the present application;

[0077] Figure 5A schematic diagram of converting the (x, y, z) coordinate system of the mobile robot following method based on electromagnetic positioning according to an embodiment of the present application into the (u, v, w) coordinate system through Euler angles;

[0078] Figure 6 A schematic diagram of four following modes for a single-person target of a mobile robot following method based on electromagnetic positioning according to an embodiment of the present application;

[0079] Figure 7 A schematic diagram of a mobile robot following method based on electromagnetic positioning according to an embodiment of the present application for following motion control of a dual-wheel differential mobile robot;

[0080] Figure 8 A schematic diagram of four following modes for a two-person target of a mobile robot following method based on electromagnetic positioning according to an embodiment of the present application;

[0081] Fig. 9 A schematic diagram of a mobile robot following device based on electromagnetic positioning according to an embodiment of the present application;

[0082] Fig.10 It is a schematic diagram of the structure of a computer device suitable for implementing the electronic device of the embodiment of the present application. DETAILED DESCRIPTION

[0083] In order to make the purpose, technical scheme and advantages of the present invention clearer, the present invention will be further described in detail below with reference to the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0084] Figure 1 An exemplary device architecture 100 is shown to which the mobile robot following method based on electromagnetic positioning or the mobile robot following device based on electromagnetic positioning according to the embodiments of the present application can be applied.

[0085] like Figure 1 As shown, the device architecture 100 may include terminal devices 101, 102, 103, a network 104 and a server 105. The network 104 is used to provide a medium for communication links between the terminal devices 101, 102, 103 and the server 105. The network 104 may include various connection types, such as wired, wireless communication links or optical fiber cables, etc.

[0086] Users can use terminal devices 101, 102, 103 to interact with server 105 through network 104 to receive or send messages, etc. Various applications, such as data processing applications, file processing applications, etc., can be installed on terminal devices 101, 102, 103.

[0087] Terminal devices 101, 102, 103 may be hardware or software. When terminal devices 101, 102, 103 are hardware, they may be various electronic devices, including but not limited to smart phones, tablet computers, laptop computers, desktop computers, etc. When terminal devices 101, 102, 103 are software, they may be installed in the electronic devices listed above. They may be implemented as multiple software or software modules (for example, software or software modules for providing distributed services), or as a single software or software module. No specific limitation is made here.

[0088] The server 105 may be a server that provides various services, such as a background data processing server that processes files or data uploaded by the terminal devices 101, 102, and 103. The background data processing server may process the acquired files or data and generate processing results.

[0089] It should be noted that the mobile robot following method based on electromagnetic positioning provided in the embodiment of the present application can be executed by the server 105, and can also be executed by the terminal devices 101, 102, and 103. Accordingly, the mobile robot following device based on electromagnetic positioning can be set in the server 105, and can also be set in the terminal devices 101, 102, and 103.

[0090] It should be understood that Figure 1 The number of terminal devices, networks and servers in the embodiment is only for illustration. Any number of terminal devices, networks and servers may be provided as required. In the case where the processed data does not need to be obtained remotely, the above device architecture may not include a network, but only a server or a terminal device.

[0091] Figure 2 A mobile robot following method based on electromagnetic positioning provided by an embodiment of the present application is shown, comprising the following steps:

[0092] S1, obtaining an electromagnetic signal sent by a transmitting module located on a mobile robot to a receiving module located on a pedestrian target, and calculating the position information of the receiving module relative to the transmitting module through an electromagnetic positioning algorithm based on the electromagnetic signal.

[0093] In a specific embodiment, step S1 specifically includes:

[0094] The center of the transmitting module is defined as the origin of the coordinate system, and three orthogonal magnetic induction intensity components are measured by the receiving module ( B x , B y , B z ), the three coordinate axes of the receiving module's coordinate system are parallel to the transmitting module's coordinate system, and the target coordinate system ( x , y , z ) respectively around x axis, y axis, z Axis rotation Euler angles α , β , γ Then we get the target coordinate system ( u , v , w ), the rotation direction is counterclockwise when looking from top to bottom in each axis direction;

[0095] According to the magnetic dipole model, the orthogonal magnetic induction intensity components ( B x , B y , B z ):

[0096] ;

[0097] In the formula, B T is a constant, B T = μIR 2 / 4, μ is the magnetic permeability of air, I is the current magnitude, R is the coil radius of the transmitting module; m , n , p ) is the unit direction vector of the transmitting module, m 2 + n 2 + p 2 =1; r is the distance from the receiving module to the transmitting module, ;

[0098] According to the orthogonal magnetic induction intensity components ( B x , B y , Bz ) calculates the receiving module in the target coordinate system ( u , v , w )The magnetic induction intensity component induced by B u , B v , B w ):

[0099] ;

[0100] In the formula, R is the Euler angle, and the rotation process is described as:

[0101] ;

[0102] In the formula, Rot ( z , γ ) is around z Axis rotation γ angle; Rot ( y , β ) is around y Axis rotation β angle; Rot ( x , α ) is around x Axis rotation α angle;

[0103] According to the receiving module in the target coordinate system ( u , v , w )The magnetic induction intensity component induced by B u , B v , B w ) The position information of the receiving module relative to the transmitting module is calculated through the electromagnetic positioning algorithm.

[0104] In a specific embodiment, the electromagnetic positioning algorithm includes an optimization algorithm, an analytical method, or a wireless tracking algorithm based on a neural network.

[0105] Specifically, refer to Figure 3 and Figure 4, a transmitting module for electromagnetic positioning is placed on the mobile robot, and the pedestrian target to be followed wears a receiving module for electromagnetic positioning. The transmitting module can adopt a single-axis to multi-axis coil mode, and the receiving module adopts a corresponding multi-axis to single-axis coil mode. The transmitting module is placed at the center of the robot. Benefiting from the electromagnetic sensor's 360-degree full-range scanning, long-distance detection, and ability to detect electromagnetic wave signals penetrating obstacles, the receiving module can be placed anywhere on the pedestrian target. Reference Figure 5 ,When the robot follows the pedestrian target, the receiving module is often in a non-orthogonal posture. u , v , w )The magnetic induction intensity component induced by is ( B u , B v , B w ), calculate the position and posture of the receiving module at time t through the electromagnetic positioning algorithm of the pedestrian target ( x h , y h , z h , α h , β h , γ h ). Since there are two or more transmitting coils (different transmitting frequencies), each transmitting coil is equivalent to a magnetic dipole, and the received signal is the superposition of these magnetic dipole signals of different frequencies. The total number of axes of the received signal is greater than 5. The position and posture information of the receiving module relative to the transmitting module can be obtained by analytical methods, optimization algorithms or wireless tracking algorithms based on neural networks; the symbolic solution of the position and posture of the receiving module is achieved by eliminating the ambiguity of the phase-locked loop (XY axis) and the hemisphere ambiguity (Z axis). The calibration algorithm is used to improve the accuracy and performance of position and posture tracking. It should be noted that the analytical method, optimization algorithm or wireless tracking algorithm based on neural networks are existing mature algorithms and will not be described in detail here.

[0106] In addition, wireless electromagnetic tracking technology can achieve better tracking, obstacle avoidance, path planning and other tasks by integrating with visible light cameras, infrared thermal imaging, lidar, millimeter wave radar, ultrasonic arrays, etc.

[0107] S2, determining whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module.

[0108] In a specific embodiment, step S2 specifically includes:

[0109] By checking the number of connection signals of the receiving module connected to the transmitting module, it is determined whether the mobile robot is in a single-person following mode or a multi-person following mode;

[0110] If the number of connection signals is 1, it is determined that the mobile robot is in a single-person following mode, and step S3 is executed; if the number of connection signals is greater than 1, it is determined that the mobile robot is in a multi-person following mode, and step S4 is executed.

[0111] Specifically, a mobile robot can follow at least one pedestrian target, that is, a transmitting module can send an electromagnetic signal to at least one receiving module. According to the number of connection signals of the receiving module connected to the transmitting module, it can be judged whether the pedestrian target followed by the mobile robot is a single person or multiple people. Depending on the number of people, the following robot's motion control steps are different.

[0112] S3, in response to determining that the mobile robot is in single-person following mode, the linear acceleration and angular acceleration of the mobile robot are calculated by following the robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve following of a single pedestrian target.

[0113] In a specific embodiment, step S3 specifically includes:

[0114] S31, the state vector of the mobile robot in the world coordinate system is:

[0115] ;

[0116] The state vector of the pedestrian target in the world coordinate system is:

[0117] ;

[0118] The state vector of the mobile robot in the pedestrian coordinate system is expressed as:

[0119] ;

[0120] The calculation formula for the angle between the mobile robot's world coordinate system and the pedestrian coordinate system is as follows:

[0121] ;

[0122] Among them, the transformation matrix F is expressed as:

[0123] ;

[0124] According to the state vector of the mobile robot in the pedestrian coordinate system, the distance between the receiving module and the transmitting module is calculated by following the robot motion control algorithm. d and the angle Φ;

[0125] S32, judging the quadrant information of the pedestrian target relative to the mobile robot according to the angle Φ between the receiving module and the transmitting module, and judging the following mode according to the quadrant information:

[0126] ;

[0127] When Φ=[π / 4, 3π / 4], the mobile robot is judged to be behind the pedestrian target, and the follow-up mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to π / 2;

[0128] When Φ=[3π / 4, π]∪[-π, -3π / 4], the mobile robot is judged to be on the right side of the pedestrian target, and the right following mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to π;

[0129] When Φ=[-3π / 4, -π / 4], the mobile robot is judged to be in front of the pedestrian target, and the front follow mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to -π / 2;

[0130] When Φ=[-π / 4, 0]∪[0, π / 4], the mobile robot is judged to be on the left side of the pedestrian target, and the left-side following mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to 0;

[0131] S33; Based on the relative position between the mobile robot and the pedestrian target, environmental perception information and human-machine interaction strategy, the linear acceleration is calculated by following the robot motion control algorithm a v and angular acceleration a w ,The motion control algorithms of the following robot include virtual spring force control algorithm, ,social force model / impedance control algorithm, model predictive control algorithm or ,reinforcement learning algorithm.

[0132] Specifically, the electromagnetic positioning algorithm can be used to estimate the six-dimensional relative position of the receiving module (pedestrian target) relative to the transmitting module ( x h, y h , z h ,α h , β h , γ h ), the center of the transmitting module is at the coordinate zero point (0, 0, 0, 0, 0, 0). For scenarios such as mobile robots moving in a flat area, only three-dimensional pose information is needed ( x h , y h , γ h ) can achieve follow-up guidance.

[0133] The mobile robot can adopt a bipedal, dual-wheel differential, three-wheel or multi-wheel differential, tripod or multi-legged mobile platform, and possess basic mobile robot functions such as energy management, motion control and obstacle avoidance. Furthermore, according to the position information of the receiving module (pedestrian target), the quadrant information of the pedestrian target relative to the mobile robot (i.e., front, back, left, right) is determined to determine the following mode. Figure 6 There are four following modes for single-person targets, namely front following mode, rear following mode, left following mode and right following mode. A human-machine following model is constructed based on the positional relationship between the mobile robot and the pedestrian target. x h , y h , θ h ) and the position information of the mobile robot ( x r , y r , θ r ) Design a mobile robot following motion control algorithm. Figure 7 The following motion control diagram for a two-wheel differential mobile robot is shown in the figure. For four-wheel and other driving modes, the motion control method needs to be adjusted accordingly.

[0134] In one embodiment, when the following robot motion control algorithm adopts a virtual spring force control algorithm, it is assumed that there is a connection between the mobile robot and the pedestrian target, the origin E of the pedestrian coordinate system and the robot coordinate system. , the relaxation length of the virtual spring is the distance between the mobile robot and the pedestrian target d , the angle between the mobile robot and the pedestrian target is Φ, expressed as:

[0135] ;

[0136] Describe the following relationship between the mobile robot and the pedestrian target as a virtual spring force and calculate the virtual elastic deformation force F 1 and virtual bending deformation elastic force F 2;

[0137] ;

[0138] in, k 1 is the elastic coefficient of the virtual spring, in units of N / m ; k 2 is the curvature coefficient of the virtual spring, in units of N / rad ; l 0 is the original length of the virtual spring, in units of m ;

[0139] The dynamic equations of following motion control are expressed as follows:

[0140] ;

[0141] in, M is the mass of the mobile robot, in units of kg ; k 3 is the damping coefficient related to translation, in Ns / m; k 4 is the rotation-related damping coefficient, in Ns / rad;

[0142] The following motion controller is expressed as:

[0143] ;

[0144] in, I is the moment of inertia of the mobile robot; θ e is the angle of the mobile robot in the pedestrian coordinate system; the following motion controller controls the real-time angle Φ between the mobile robot and the pedestrian target to tend to θ e , enabling the robot to achieve the front following, rear following and side following functions of a single pedestrian target.

[0145] Specifically, the mobile robot can have functional modules such as autonomous navigation, human-machine interactive control, automatic charging and one-key return. Wireless electromagnetic tracking technology can achieve better tracking, obstacle avoidance and path planning tasks by integrating with visible light cameras, infrared thermal imaging, laser radar, millimeter wave radar, ultrasonic arrays, etc. The mobile robot can predict the direction of movement of pedestrian targets through perception information and algorithms such as Markov to improve tracking stability and reliability.

[0146] S4, in response to determining that the mobile robot is in multi-person following mode, obtain the average value of the posture information of multiple receiving modules relative to the transmitting module, and calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm based on the average value to achieve following of multiple pedestrian targets.

[0147] In a specific embodiment, step S4 specifically includes:

[0148] Repeat step S31 to calculate the distance between the receiving module and the transmitting module of each pedestrian target in the plurality of pedestrian targets respectively. d and the angle Φ, and take their average value to obtain the average angle, and then repeat steps S32-S33 according to the average angle to achieve the front following, rear following, and side following functions of multiple pedestrian targets.

[0149] Specifically, each pedestrian target wears a receiving module. The number of receiving modules worn by multiple pedestrian targets is 1, 2, ..., N;

[0150] S41, the state vector of the mobile robot in the world coordinate system is:

[0151] ;

[0152] The state vector of the first pedestrian target in the world coordinate system is:

[0153] ;

[0154] The state vector of the Nth pedestrian target in the world coordinate system is:

[0155] ;

[0156] The state vector of the mobile robot in the pedestrian coordinate system is expressed as:

[0157] ;

[0158] The calculation formula for the angle between the mobile robot's world coordinate system and the first pedestrian coordinate system is as follows:

[0159] ;

[0160] The calculation formula for the angle between the mobile robot's world coordinate system and the Nth pedestrian coordinate system is as follows:

[0161] ;

[0162] Among them, the transformation matrix F is expressed as:

[0163] ;

[0164] According to the state vector of the mobile robot in the pedestrian coordinate system, the distance between the receiving module and the transmitting module is calculated by following the robot motion control algorithm. d and the angle Φ;

[0165] The following motion control algorithm of the mobile robot describes the position relationship between the mobile robot and the pedestrian target through the virtual spring algorithm. The virtual spring algorithm assumes that there is a connection between the mobile robot and the pedestrian target, connecting the origin of the pedestrian coordinate system E and the robot coordinate system. For the Nth pedestrian target, the relaxation length of the virtual spring is the distance between the robot and the pedestrian target d , the angle between the robot and the pedestrian is Φ, expressed as:

[0166] ;

[0167] S42, judging the quadrant information of the pedestrian target relative to the mobile robot according to the angle Φ between the receiving module and the transmitting module, and judging the following mode according to the quadrant information:

[0168] ;

[0169] When Φ=[π / 4, 3π / 4], the mobile robot is judged to be behind the pedestrian target, and the follow-up mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to π / 2;

[0170] When Φ=[3π / 4, π]∪[-π, -3π / 4], the mobile robot is judged to be on the right side of the pedestrian target, and the right following mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to π;

[0171] When Φ=[-3π / 4, -π / 4], the mobile robot is judged to be in front of the pedestrian target, and the front follow mode is triggered: the linear acceleration of the input is controlled by step S33 a v and angular acceleration a w , so that Φ tends to -π / 2;

[0172] When Φ=[-π / 4, 0]∪[0, π / 4], the mobile robot is judged to be on the left side of the pedestrian target, and the left-side following mode is triggered: the linear acceleration of the input is controlled by step S33 a vand angular acceleration a w , so that Φ tends to 0;

[0173] S43, based on the relative position between the mobile robot and the pedestrian target, environmental perception information and human-machine interaction strategy, the linear acceleration is calculated by following the robot motion control algorithm a v and angular acceleration a w ,The motion control algorithms of the following robot include virtual spring force control algorithm, ,social force model / impedance control algorithm, model predictive control algorithm or ,reinforcement learning algorithm.

[0174] Specifically, Figure 8 Four following modes for two-person targets are shown. For the following mode for multiple people, the center point of the coordinates between the leftmost and rightmost two persons in the pedestrian target is adjusted to be exactly on the axis of the mobile robot.

[0175] The mobile robot following method based on electromagnetic positioning proposed in the embodiments of the present application can realize the following between the mobile robot and the pedestrian target through a wireless electromagnetic positioning tracking device. The wireless electromagnetic tracking technology can overcome the influence of optical occlusion on the optical imaging module and the shortcomings of UWB in accuracy and non-360-degree tracking, and realize 360°, millimeter-level and large-range posture tracking; and then execute front following, rear following, side following, single-person following mode and multi-person following mode and their adaptive switching through environmental perception and motion control algorithms, so as to realize intelligent following applications in different application scenarios.

[0176] Further references Fig. 9 As an implementation of the methods shown in the above figures, the present application provides an embodiment of a mobile robot following device based on electromagnetic positioning, and the device embodiment is similar to Figure 2 Corresponding to the method embodiment shown, the device can be specifically applied to various electronic devices.

[0177] The embodiment of the present application provides a mobile robot following device based on electromagnetic positioning, which is characterized by comprising:

[0178] The posture information acquisition module 1 is configured to acquire the electromagnetic signal sent by the transmitting module located on the mobile robot to the receiving module located on the pedestrian target, and calculate the posture information of the receiving module relative to the transmitting module through the electromagnetic positioning algorithm according to the electromagnetic signal;

[0179] A following mode determination module 2 is configured to determine whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module;

[0180] The single-person following control module 3 is configured to, in response to determining that the mobile robot is in the single-person following mode, calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve the following of a single pedestrian target;

[0181] The multi-person following control module 4 is configured to, in response to determining that the mobile robot is in a multi-person following mode, obtain the average value of the posture information of multiple receiving modules relative to the transmitting module, and calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm based on the average value to achieve the following of multiple pedestrian targets.

[0182] Furthermore, the embodiment of the present application also proposes a mobile robot following system based on electromagnetic positioning, which includes the following modules: a transmitting module, a receiving module, and a robot control module. The transmitting module includes an electromagnetic transmitter and a transmitting coil group; the receiving module includes a receiving coil group; and the robot control module includes a control development board, a servo motor, and a motor driver. The control development board is provided with the mobile robot following device based on electromagnetic positioning to execute the specific steps of the mobile robot following method based on electromagnetic positioning.

[0183] Furthermore, the transmitting module, the receiving module and the robot control module communicate with each other via wireless communication modes such as Bluetooth, Zigbee and WiFi.

[0184] Reference below Fig.10 , which shows an electronic device (eg Figure 1 A schematic diagram of the structure of a computer device 1000 (a server or terminal device as shown). Fig.10 The electronic device shown is merely an example and should not bring any limitation to the functions and scope of use of the embodiments of the present application.

[0185] like Fig.10 As shown, the computer device 1000 includes a central processing unit (CPU) 1001 and a graphics processing unit (GPU) 1002, which can perform various appropriate actions and processes according to a program stored in a read-only memory (ROM) 1003 or a program loaded from a storage part 1009 to a random access memory (RAM) 1004. In the RAM 1004, various programs and data required for the operation of the device 1000 are also stored. The CPU 1001, GPU 1002, ROM 1003, and RAM 1004 are connected to each other through a bus 1005. An input / output (I / O) interface 1006 is also connected to the bus 1005.

[0186] The following components are connected to the I / O interface 1006: an input section 1007 including a keyboard, a mouse, etc.; an output section 1008 including a display such as a liquid crystal display (LCD), etc. and a speaker, etc.; a storage section 1009 including a hard disk, etc.; and a communication section 1010 including a network interface card such as a LAN card, a modem, etc. The communication section 1010 performs communication processing via a network such as the Internet. A drive 1011 can also be connected to the I / O interface 1006 as needed. A removable medium 1012, such as a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, etc., is installed on the drive 1011 as needed, so that a computer program read therefrom is installed into the storage section 1009 as needed.

[0187] In particular, according to an embodiment of the present disclosure, the process described above with reference to the flowchart can be implemented as a computer software program. For example, an embodiment of the present disclosure includes a computer program product, which includes a computer program carried on a computer-readable medium, and the computer program contains a program code for executing the method shown in the flowchart. In such an embodiment, the computer program can be downloaded and installed from a network through the communication part 1010, and / or installed from a removable medium 1012. When the computer program is executed by the central processing unit (CPU) 1001 and the graphics processing unit (GPU) 1002, the above functions defined in the method of the present application are executed.

[0188] It should be noted that the computer-readable medium described in the present application may be a computer-readable signal medium or a computer-readable medium or any combination of the above two. The computer-readable medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared or semiconductor device, device or component, or any combination of the above. More specific examples of computer-readable media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In the present application, a computer-readable medium may be any tangible medium containing or storing a program that can be used by or in combination with an instruction execution device, device or device. In the present application, a computer-readable signal medium may include a data signal propagated in a baseband or as part of a carrier wave, which carries a computer-readable program code. This propagated data signal may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. The computer-readable signal medium may also be any computer-readable medium other than a computer-readable medium that can send, propagate or transmit a program for use by or in conjunction with an instruction execution device, apparatus or device. The program code contained on the computer-readable medium may be transmitted using any appropriate medium, including but not limited to: wireless, wire, optical cable, RF, etc., or any suitable combination of the above.

[0189] Computer program code for performing the operations of the present application may be written in one or more programming languages ​​or a combination thereof, including object-oriented programming languages, such as Java, Smalltalk, C++, and conventional procedural programming languages, such as "C" or similar programming languages. The program code may be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer via any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., via the Internet using an Internet service provider).

[0190] The flowcharts and block diagrams in the accompanying drawings illustrate the possible architecture, functions and operations of the devices, methods and computer program products according to various embodiments of the present application. In this regard, each box in the flowchart or block diagram can represent a module, a program segment or a part of a code, and the module, a program segment or a part of the code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram and / or flowchart and the combination of boxes in the block diagram and / or flowchart can be implemented with a dedicated hardware-based device that performs a specified function or operation, or can be implemented with a combination of dedicated hardware and computer instructions.

[0191] The modules involved in the embodiments described in this application may be implemented by software or hardware, and the modules described may also be set in a processor.

[0192] As another aspect, the present application also provides a computer-readable medium, which may be included in the electronic device described in the above embodiment; or it may exist independently without being assembled into the electronic device. The above computer-readable medium carries one or more programs, and when the above one or more programs are executed by the electronic device, the electronic device: obtains the electromagnetic signal sent by the transmitting module located on the mobile robot to the receiving module located on the pedestrian target, and calculates the posture information of the receiving module relative to the transmitting module through the electromagnetic positioning algorithm according to the electromagnetic signal; determines whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module; in response to determining that the mobile robot is in a single-person following mode, the linear acceleration and angular acceleration of the mobile robot are calculated by the following robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve the following of a single pedestrian target; in response to determining that the mobile robot is in a multi-person following mode, the average value of the posture information of multiple receiving modules relative to the transmitting module is obtained, and the linear acceleration and angular acceleration of the mobile robot are calculated by the following robot motion control algorithm according to the average value to achieve the following of multiple pedestrian targets.

[0193] The above description is only a preferred embodiment of the present application and an explanation of the technical principles used. Those skilled in the art should understand that the scope of the invention involved in the present application is not limited to the technical solution formed by a specific combination of the above technical features, but should also cover other technical solutions formed by any combination of the above technical features or their equivalent features without departing from the above invention concept. For example, the above features are replaced with the technical features with similar functions disclosed in this application (but not limited to) by each other to form a technical solution.

Claims

1. A mobile robot following method based on electromagnetic positioning, characterized in that: The following steps are involved: S1, obtaining an electromagnetic signal sent by a transmitting module located on a mobile robot to a receiving module located on a pedestrian target, and calculating the position information of the receiving module relative to the transmitting module by an electromagnetic positioning algorithm according to the electromagnetic signal; S2, determining whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module; S3, in response to determining that the mobile robot is in single-person following mode, according to the posture information of the receiving module relative to the transmitting module, the linear acceleration and angular acceleration of the mobile robot are calculated by following the robot motion control algorithm to achieve following of a single pedestrian target, wherein step S3 specifically includes: S31, the state vector of the mobile robot in the world coordinate system is: The state vector of the pedestrian target in the world coordinate system is: The state vector of the mobile robot in the pedestrian coordinate system is expressed as: Among them, θ e is the angle of the mobile robot in the pedestrian coordinate system; The calculation formula of the angle between the world coordinate system and the pedestrian coordinate system of the mobile robot is as follows: Among them, the transformation matrix F is expressed as: Calculate the distance d and the angle Φ between the receiving module and the transmitting module according to the state vector of the mobile robot in the pedestrian coordinate system by following the robot motion control algorithm; S32, judging the quadrant information of the pedestrian target relative to the mobile robot according to the angle Φ between the receiving module and the transmitting module, and judging the following mode according to the quadrant information: When Φ=[π / 4,3π / 4], it is determined that the mobile robot is behind the pedestrian target, and the follow-up mode is triggered: the input linear acceleration a is controlled by step S33. v and angular acceleration a w , so that Φ tends to π / 2; When Φ=[3π / 4,π]∪[-π,-3π / 4], it is determined that the mobile robot is on the right side of the pedestrian target, and the right following mode is triggered: the linear acceleration a of the input is controlled by step S33. v and angular acceleration a w , so that Φ tends to π; When Φ=[-3π / 4,-π / 4], it is determined that the mobile robot is in front of the pedestrian target, and the front following mode is triggered: the input linear acceleration a is controlled by step S33. v and angular acceleration a w , so that Φ tends to -π / 2; When Φ=[-π / 4,0]∪[0,π / 4], it is determined that the mobile robot is on the left side of the pedestrian target, and the left-side following mode is triggered: the linear acceleration a of the input is controlled by step S33. v and angular acceleration a w , so that Φ tends to 0; S33: Based on the relative position between the mobile robot and the pedestrian target, the environmental perception information and the human-machine interaction strategy, the linear acceleration a is calculated by the following robot motion control algorithm v and angular acceleration a w , the following robot motion control algorithm includes a virtual spring force control algorithm, a social force model / impedance control algorithm, a model predictive control algorithm or a reinforcement learning algorithm; S4, in response to determining that the mobile robot is in multi-person following mode, obtain the average value of the posture information of the multiple receiving modules relative to the transmitting module, and calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm based on the average value to achieve following of multiple pedestrian targets.

2. The mobile robot following method based on electromagnetic positioning according to claim 1, characterized in that: The step S1 specifically includes: The center of the transmitting module is defined as the origin of the coordinate system, and three orthogonal magnetic induction intensity components (B x ,B y ,B z ), the three coordinate axes of the coordinate system of the receiving module are parallel to the coordinate system of the transmitting module, and the target coordinate system (x, y, z) is rotated around the x-axis, y-axis, and z-axis by Euler angles α, β, and γ, respectively, to obtain the target coordinate system (u, v, w), and the rotation direction is counterclockwise from top to bottom from each axis direction; According to the magnetic dipole model, the orthogonal magnetic induction intensity component (B x ,B y ,B z ): In the formula, B T is a constant, B T =μIR 2 / 4, μ is the magnetic permeability of air, I is the current, R is the coil radius of the transmitting module; (m,n,p) is the unit direction vector of the transmitting module, m 2 +n 2 +p 2 =1; r is the distance from the receiving module to the transmitting module, According to the orthogonal magnetic induction intensity component (B x ,B y ,B z ) calculates the magnetic induction intensity component (B) sensed by the receiving module in the target coordinate system (u, v, w) u ,B v ,B w ): (B u ,B v ,B w ) T =R(B x ,B y ,B z ) T ; Where R is the Euler angle, and the rotation process is described as: R=Rot(z,γ)Rot(y,β)Rot(x,α); Where, Rot(z,γ) is the rotation of γ angle around the z axis; Rot(y,β) is the rotation of β angle around the y axis; Rot(x,α) is the rotation of α angle around the x axis; According to the magnetic induction intensity component (B u ,B v ,B w ) The position information of the receiving module relative to the transmitting module is calculated by the electromagnetic positioning algorithm.

3. The mobile robot following method based on electromagnetic positioning according to claim 1, characterized in that: The electromagnetic positioning algorithm includes an optimization algorithm, an analytical method or a wireless tracking algorithm based on a neural network.

4. The mobile robot following method based on electromagnetic positioning according to claim 1, characterized in that: The step S2 specifically includes: By checking the number of connection signals of the receiving module connected to the transmitting module, determining whether the mobile robot is in a single-person following mode or a multi-person following mode; If the number of connection signals is 1, it is determined that the mobile robot is in a single-person following mode, and step S3 is executed; if the number of connection signals is greater than 1, it is determined that the mobile robot is in a multi-person following mode, and step S4 is executed.

5. The mobile robot following method based on electromagnetic positioning according to claim 1, characterized in that: When the following robot motion control algorithm adopts a virtual spring force control algorithm, Assume that there is a connection between the mobile robot and the pedestrian target, the origin of the pedestrian coordinate system E and the robot coordinate system The relaxation length of the virtual spring is the distance d between the mobile robot and the pedestrian target, and the angle between the mobile robot and the pedestrian target is Φ, which is expressed as: Describing the following relationship between the mobile robot and the pedestrian target as a virtual spring force, and calculating a virtual telescopic deformation elastic force F1 and a virtual bending deformation elastic force F2; Among them, k1 is the elastic coefficient of the virtual spring, the unit is N / m; k2 is the curvature coefficient of the virtual spring, the unit is N / rad; l0 is the original length of the virtual spring, the unit is m; The dynamic equations of following motion control are expressed as follows: Wherein, M is the mass of the mobile robot, in kg; k3 is the damping coefficient related to translation, in Ns / m; k4 is the damping coefficient related to rotation, in Ns / rad; The following motion controller is expressed as: Where I is the moment of inertia of the mobile robot; the following motion controller controls the real-time angle Φ between the mobile robot and the pedestrian target to tend to θ e , enabling the robot to achieve the front following, rear following and side following functions of a single pedestrian target.

6. The mobile robot following method based on electromagnetic positioning according to claim 1, characterized in that: The step S4 specifically includes: Repeat step S31 to respectively calculate the distance d and the angle Φ between the receiving module and the transmitting module of each of the multiple pedestrian targets, and take the average value thereof to obtain the average angle, and then repeat steps S32-S33 according to the average angle to realize the front following, rear following, and side following functions of the multiple pedestrian targets.

7. A mobile robot following device based on electromagnetic positioning, characterized in that: include: A posture information acquisition module is configured to acquire an electromagnetic signal sent from a transmitting module located on the mobile robot to a receiving module located on the pedestrian target, and calculate the posture information of the receiving module relative to the transmitting module through an electromagnetic positioning algorithm according to the electromagnetic signal; A following mode determination module, configured to determine whether the mobile robot is in a single-person following mode or a multi-person following mode according to the number of connection signals of the receiving module connected to the transmitting module; A single person following control module is configured to, in response to determining that the mobile robot is in the single person following mode, calculate the linear acceleration and angular acceleration of the mobile robot through a following robot motion control algorithm according to the posture information of the receiving module relative to the transmitting module to achieve following of a single pedestrian target, and the single person following control module specifically includes: Module S31, the state vector of the mobile robot in the world coordinate system is: The state vector of the pedestrian target in the world coordinate system is: The state vector of the mobile robot in the pedestrian coordinate system is expressed as: Among them, θ e is the angle of the mobile robot in the pedestrian coordinate system; The calculation formula of the angle between the world coordinate system and the pedestrian coordinate system of the mobile robot is as follows: Among them, the transformation matrix F is expressed as: Calculate the distance d and the angle Φ between the receiving module and the transmitting module according to the state vector of the mobile robot in the pedestrian coordinate system by following the robot motion control algorithm; Module S32, judging the quadrant information of the pedestrian target relative to the mobile robot according to the angle Φ between the receiving module and the transmitting module, and judging the following mode according to the quadrant information: When Φ=[π / 4,3π / 4], it is determined that the mobile robot is behind the pedestrian target, and the follow-up mode is triggered: the linear acceleration a of the input is controlled by module S33. v and angular acceleration a w , so that Φ tends to π / 2; When Φ=[3π / 4,π]∪[-π,-3π / 4], it is determined that the mobile robot is on the right side of the pedestrian target, and the right following mode is triggered: the linear acceleration a of the input is controlled by module S33 v and angular acceleration a w , so that Φ tends to π; When Φ=[-3π / 4,-π / 4], it is determined that the mobile robot is in front of the pedestrian target, and the front follow mode is triggered: the linear acceleration a of the input is controlled by module S33 v and angular acceleration a w , so that Φ tends to -π / 2; When Φ=[-π / 4,0]∪[0,π / 4], it is determined that the mobile robot is on the left side of the pedestrian target, and the left-side following mode is triggered: the linear acceleration a of the input is controlled by module S33 v and angular acceleration a w , so that Φ tends to 0; Module S33: Based on the relative position between the mobile robot and the pedestrian target, environmental perception information and human-machine interaction strategy, the linear acceleration a is calculated by the following robot motion control algorithm. v and angular acceleration a w , the following robot motion control algorithm includes a virtual spring force control algorithm, a social force model / impedance control algorithm, a model predictive control algorithm or a reinforcement learning algorithm; The multi-person following control module is configured to, in response to determining that the mobile robot is in the multi-person following mode, obtain the average value of the posture information of the multiple receiving modules relative to the transmitting module, and calculate the linear acceleration and angular acceleration of the mobile robot through the following robot motion control algorithm based on the average value to achieve the following of multiple pedestrian targets.

8. An electronic device comprising: one or more processors; a storage device for storing one or more programs, When the one or more programs are executed by the one or more processors, the one or more processors implement the method according to any one of claims 1 to 6.

9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the program is executed by a processor, the method according to any one of claims 1 to 6 is implemented.

Images