Multi-agent system motion control method
The topographic map is constructed through the individual data and infrared data of the agent, and the exploration path is updated in real time, which solves the problem that the agent cannot accurately explore in unknown environments, realizes accurate exploration of the unknown environment and safe path planning, and ensures the safety of the agent. and efficient exploration.
Patent Information
- Application Number
- CN202411051400.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-01
- Publication Date
- 2024-11-15
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The failure to consider the impact of the surrounding environment on the agent's operating trajectory in the prior art, resulting in the inability to accurately control the agent to complete the exploration task in an unknown environment.
By collecting individual data and infrared data of the agent, build an initial topographic map, set the initial exploration direction, update the topographic map in real time, re-plan the exploration path, use infrared sensors to detect obstacles, adjust the exploration direction, avoid collisions, and update according to the exploration situation. path.
It realizes the agent's accurate exploration of unknown environments, ensures safety and efficiency, can adapt to environmental changes in real time, avoids the agent's collision with obstacles, and improves exploration efficiency.
Smart Images

Figure CN118963356A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of intelligent body control and relates to Internet of Things technology, and specifically is a multi-agent system motion control method. Background Art
[0002] A multi-agent system is a self-organizing group system composed of a large number of simple autonomous individuals. Although the basic unit intelligence level of the multi-agent system is very low, it exhibits a relatively high level of intelligence as a whole and can complete complex tasks such as search, reconnaissance, and rescue. The motion control of the multi-agent system is the basis of the application of the multi-agent system, that is, to achieve group aggregation movement, consistent speed, and group movement through self-organization.
[0003] The invention patent with publication number CN114326759A discloses a multi-agent formation control method, device and multi-agent system. The invention patent obtains the current first control data through the target operation trajectory of the multi-agent group and the status data of the previous moment, optimizes the first control data based on the target constraint condition and the ADMM algorithm to obtain the second control data, and controls the multi-agents according to the second control data; the invention only considers the target operation trajectory of the multi-agent and the status data of the previous moment to analyze the current control data of the agent, and does not consider the influence of the surrounding environment on the operation trajectory of the agent. When it is necessary to control the agent to explore an unknown environment, only considering the data of the agent will result in the inability to complete the exploration task of the location environment.
[0004] The present invention provides a multi-agent system motion control method to solve the above technical problems. Summary of the invention
[0005] The present invention aims to solve at least one of the technical problems existing in the prior art; to this end, the present invention proposes a multi-agent system motion control method, which is used to solve the technical problem that the prior art does not take into account the detection and analysis of the surrounding environment, resulting in the inability to accurately control the intelligent body to complete the exploration task when exploring an unknown environment.
[0006] To achieve the above object, the first aspect of the present invention provides a multi-agent system motion control method, comprising:
[0007] Step 1: Collect the agent's individual data and infrared data;
[0008] Step 2: Construct an initial topographic map; set an initial exploration direction, and the individual explores according to the initial direction, and obtains the exploration status based on infrared data in real time; based on the exploration status, the initial topographic map is updated to obtain an updated topographic map;
[0009] Step 3: Based on the updated terrain map and subject data, the individual's updated exploration path is replanned, and the individual continues to explore according to the updated exploration path.
[0010] Preferably, the real-time acquisition of exploration conditions based on infrared data includes:
[0011] Extracting infrared data; the infrared data includes a first distance, a second distance, and a third distance from the individual to surrounding obstacles collected by an infrared sensor installed on the surface of the individual;
[0012] Setting a distance threshold; the distance threshold is set according to an individual's safety distance;
[0013] Determine whether the first distance is greater than a distance threshold; if yes, mark the first distance state as a normal state; if no, mark the first distance state as an abnormal state;
[0014] Determine whether the second distance is greater than a distance threshold; if yes, mark the second distance state as a normal state; if no, mark the second distance state as an abnormal state;
[0015] Determine whether the third distance is greater than a distance threshold; if yes, mark the third distance state as a normal state; if no, mark the third distance state as an abnormal state;
[0016] The first distance state, the second distance state, and the third distance state are combined to obtain an exploration situation.
[0017] Preferably, updating the initial topographic map based on the exploration situation to obtain an updated topographic map includes:
[0018] Extract the exploration situation; set the field of view distance n; the field of view distance is set according to the distance clearly captured by the camera installed on the individual;
[0019] With the individual midpoint as the center and the field of view distance n as the radius, the individual exploration range is obtained;
[0020] Determine whether the exploration situation contains abnormal conditions; if yes, mark the explored obstacles on the terrain map, and control the individuals with abnormal conditions to explore and obtain obstacle data; if no, control the individuals to continue exploring;
[0021] All obstacles explored by individuals and their exploration ranges are updated into the terrain map to obtain an updated terrain map.
[0022] Preferably, the controlling the individual in the abnormal state to explore and obtain obstacle data includes:
[0023] Extract the exploration status of individuals in abnormal states;
[0024] The emission direction of the infrared sensor that detects the anomaly is marked as the abnormal exploration direction; the detected obstacle position is marked as the primary obstacle position, the secondary obstacle position detected by the infrared sensor at the next moment is collected, and the line connecting the primary obstacle position and the secondary obstacle position is marked as the obstacle direction; the angle between the abnormal exploration direction and the obstacle direction is marked as the obstacle exploration direction, and the abnormal individual is controlled to drive in the obstacle exploration direction to explore the length, width and surface shape of the obstacle, and the length, width and surface shape of the obstacle are marked as obstacle data.
[0025] Preferably, the controlling of the abnormal individual to travel in the direction of the obstacle to explore and obtain the length, width and surface shape of the obstacle includes:
[0026] A1: After the individual adjusts the direction, it continues to monitor the exploration situation;
[0027] A2: Determine whether the number of abnormal states in the exploration situation has increased; if yes, adjust the direction again and conduct a second obstacle exploration; if no, jump to A3;
[0028] A3: Determine whether the number of abnormal states at the current moment has decreased; if yes, complete obstacle detection, adjust the direction, and continue to complete the exploration; if no, continue to drive in the direction of exploring obstacles to perform obstacle exploration.
[0029] Preferably, the replanning of the updated exploration path of the individual based on the updated topographic map and the subject data includes:
[0030] B1: extract and update the topographic map and main data; the main data includes the individual's driving path, driving speed and driving time;
[0031] B2: After completing the obstacle exploration, detect the secondary infrared data of the individual; select the individual's initial update path based on the secondary infrared data;
[0032] B3: Determine whether the preliminary updated path overlaps with the driving paths of other individuals; if yes, jump to B4; if no, mark the preliminary updated path as the updated exploration path;
[0033] B4: Mark the individuals that are repeated with the initial updated path as repeated individuals, and obtain the individual time for the individual to reach the repeated point and the repeated time for the individual to reach the repeated point based on the driving speed, the current position of the individual and the current position of the repeated individual;
[0034] B5: Determine whether the individual time is the same as the repeated time; if so, control the individual to change the driving speed so that the time it takes to reach the repeated point is different, and repeat step B2; if not, mark the preliminary updated path as the updated exploration path.
[0035] Preferably, the selecting of the individual preliminary update path according to the secondary infrared data comprises:
[0036] Extracting secondary infrared data; the secondary infrared data includes a secondary first distance, a secondary second distance and a secondary third distance detected by the individual;
[0037] Sort the quadratic first distance, the quadratic second distance and the quadratic third distance from large to small, mark the middle direction of the directions of the first two infrared data as the standard direction, and mark the ratio of the first infrared data to the second infrared data as the standard value BJH;
[0038] The update angle JD is obtained by the formula JD=(BJH-1)×90%, the direction of the infrared data with the first position in the standard direction is offset by the update angle to obtain the updated exploration direction, and the path of the updated exploration direction is marked as the preliminary update path.
[0039] Compared with the prior art, the present invention has the following beneficial effects:
[0040] 1. The present invention collects individual data of each intelligent agent, constructs an initial terrain map, sets the initial exploration direction of each intelligent agent, and controls the intelligent agent to explore the terrain. By collecting and processing data in real time, the intelligent agent can update the terrain map in time and respond quickly to environmental changes, so as to make more accurate path planning and decision-making; the exploration of the terrain by each intelligent agent is obtained based on the comparison result of infrared data and a preset distance threshold. Through the distance data collected by the infrared sensor, the intelligent agent can detect the surrounding obstacles in real time and set the distance threshold as a safety limit. When the intelligent agent approaches an obstacle, it can react in advance to avoid collision and ensure the safety of the intelligent agent; the intelligent agent explores the terrain and places the obstacles obtained by exploration on the initial terrain map The intelligent agent can mark the obstacles in the image and change the driving direction of the intelligent agent according to the shape of the detected obstacles, not only to explore the obstacles in an all-round way, but also to prevent the intelligent agent from colliding with the obstacles; the completion of obstacle detection is judged according to the exploration situation detected by the intelligent agent, which can better adapt to the changing environment; after completing the obstacle detection, the secondary infrared data is obtained again, and the preliminary update path is selected according to the secondary infrared data, which can select a more spacious exploration direction and improve the exploration efficiency; the preliminary updated path is compared with the driving paths of other individuals to obtain the overlap and update the exploration path, which can effectively avoid collisions between intelligent agents, ensure the safety of system operation, and adjust the driving route of the intelligent agent in real time to adapt to environmental changes and avoid obstacles.
[0041] 2. The present invention collects the exploration environment around the intelligent agent through infrared sensors. When the collected infrared data is less than or equal to the preset distance threshold, it means that the intelligent agent is close to the obstacle. In order to better detect the shape of the obstacle, the exploration direction of the intelligent agent is changed according to the direction of the obstacle, and the obstacle is completely detected. Accurate obstacle data helps to build a more detailed environmental map. Clarifying the size and shape of the obstacle can avoid unnecessary detours of the intelligent agent during the exploration process, thereby saving time and energy and improving the overall exploration efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art 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.
[0043] Figure 1 The following is a flowchart of an embodiment of the present invention.
[0044] Figure 2 A complete flow chart of the exploration situation is obtained for the present invention.
[0045] Figure 3 A complete flowchart of the updated exploration path is obtained for the present invention. DETAILED DESCRIPTION
[0046] The technical solution of the present invention will be clearly and completely described below in conjunction with the embodiments. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all of 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.
[0047] See also Figure 1-Figure 3 The first embodiment of the present invention provides a multi-agent system motion control method, comprising:
[0048] Step 1: Collect the agent’s individual data and infrared data.
[0049] Exemplarily, a group of small autonomous robots are placed in an unknown environment to explore the terrain of the unknown environment. Each small autonomous robot is equipped with a speed sensor, a locator and an infrared sensor. The infrared sensors are respectively arranged in front, on the left and on the right of the robot. All robots upload the collected data to the central processing unit in real time.
[0050] Step 2: Construct an initial topographic map; set an initial exploration direction, and the individual explores according to the initial direction, and obtains the exploration status based on infrared data in real time; based on the exploration status, the initial topographic map is updated to obtain an updated topographic map.
[0051] Exemplarily, a preliminary topographic map is constructed based on the robot's starting position and the preliminary collected infrared data. In this embodiment, there are three robots, which are marked as robot one, robot two and robot three respectively. In this embodiment, the initial exploration direction of robot one is set to due west, the initial exploration direction of robot two is set to due north, and the initial exploration direction of robot three is set to due east. Robot one, robot two and robot three are controlled to start exploring.
[0052] In this embodiment, the distance threshold is set to 0.5 meters; when the driving time is 3 minutes, the first distance of robot one is 1.2 meters, the second distance is 0.5 meters, and the third distance is 0.8 meters. It is judged whether the first distance is greater than the distance threshold, and it is judged that the first distance is greater than the distance threshold, and the first distance state is marked as a normal state; it is judged whether the second distance is greater than the distance threshold, and it is judged that the second distance is equal to the distance threshold, and the second distance state is marked as an abnormal state; it is judged whether the third distance is greater than the distance threshold, and it is judged that the third distance is greater than the distance threshold, then the third distance state is marked as a normal state, and the first distance state, the second distance state and the third distance state are combined to obtain the exploration situation.
[0053] In this embodiment, the robot's field of view distance n=2 meters is set, and the center of the robot is taken as the center of the circle and the field of view distance n=2 meters is taken as the radius, and the individual exploration range is obtained. Robot 1, robot 2 and robot 3 respectively explore the topographic map of the unknown environment in the initial exploration direction with the individual exploration range, and display the places passed by the individual exploration range on the initial topographic map; judge whether the exploration situation contains abnormal conditions, and judge that the exploration situation of robot 1 contains abnormal conditions after driving for three minutes, then robot 1 has explored obstacle A, and obstacle A is marked on the topographic map.
[0054] If the infrared sensor of the robot detects that the abnormal emission direction is due west, the due west direction is marked as the abnormal exploration direction, and the detected obstacle position is marked as the initial obstacle position. The robot is controlled to continue driving. After 1 second, the secondary obstacle position detected by the infrared sensor is collected, and the line connecting the initial obstacle position and the secondary obstacle position is marked as the obstacle direction. The obstacle direction is 30 degrees west by northwest, so the obstacle exploration direction is 30 degrees west by northwest. The robot is controlled to drive according to the obstacle exploration direction, and the length, width and surface shape of the obstacle are collected by the infrared sensor, and the length, width and surface shape of the obstacle are marked as obstacle data. The obstacle data is sent to the central control unit to update the shape of obstacle A in the topographic map.
[0055] It should be noted that when other robots detect an obstacle that has already been detected again, they control the other robots to avoid the obstacle and continue exploring without the need for multiple exploration updates.
[0056] It should be noted that the robot is set with a warning distance. When the distance between the robot and an obstacle is less than or equal to the warning distance, the robot will automatically deflect in the direction away from the obstacle to avoid collision with the obstacle.
[0057] After the robot adjusts its direction, continue to monitor its exploration situation. When the driving time is 4 minutes, determine whether the number of abnormal states in the exploration situation has increased. If it is determined that the number of abnormal states in the exploration situation has not increased, continue to determine whether the number of abnormal states at the current moment has decreased. If it is determined that the number of abnormal states at the current moment has decreased to 0, the obstacle detection of obstacle A is completed, and the direction is adjusted to continue exploring the terrain of the unknown environment.
[0058] After the detection of obstacle A is completed, the secondary first distance is 2 meters, the secondary second distance is 1.6 meters, and the secondary third distance is 1.4 meters. After sorting, the standard direction is 45 degrees west of northwest, and the standard value BJH is 5 / 4. The updated angle JD = 22.5 degrees is obtained through the formula JD = (BJH-1) × 90%. The updated exploration direction is 22.5 degrees west of northwest, and the path of the individual traveling at 22.5 degrees west of northwest is the preliminary updated path.
[0059] Extract the driving paths of other individuals, determine whether the preliminary updated path overlaps with the driving paths of other individuals, determine that the paths of Robot One and Robot Three overlap, and mark Robot Three as a repeated individual; the distance that Robot One reaches the repeated point is 12 meters, and the distance that the repeated individual reaches the repeated point is 8 meters, the driving speed of Robot One is 2 meters per second, and the driving speed of Robot Three is 1.5 meters per second, so the individual time is 6 seconds and the repetition time is 5.3 seconds; determine whether the individual time is the same as the repetition time, and if it is determined that there is no repetition, mark the preliminary updated path as the updated exploration path, and Robot One continues to explore according to the updated exploration path.
[0060] Part of the data in the above formula is calculated by removing the dimension and taking its numerical value. The formula is a formula closest to the actual situation obtained by software simulation of a large amount of collected data; the preset parameters and preset thresholds in the formula are set by technical personnel in this field according to actual conditions or obtained through simulation of a large amount of data.
[0061] Working principle of the present invention:
[0062] The present invention collects individual data and infrared data of an intelligent agent, constructs an initial topographic map and sets an initial exploration direction of the intelligent agent; compares the infrared data with a preset distance threshold, and obtains the exploration status of the intelligent agent according to the comparison result; improves and updates the initial topographic map in real time according to the exploration status and the exploration field of view of the intelligent agent, and when an obstacle is detected, changes the exploration direction of the intelligent agent according to the shape of the obstacle to explore the obstacle; obtains the completion status of the obstacle exploration according to the exploration status; after the obstacle exploration is completed, formulates an updated exploration direction according to the secondary infrared data collected by the intelligent agent, obtains a preliminary updated path, and improves the preliminary updated path in combination with the driving paths of other intelligent agents to obtain an updated exploration path, and the intelligent agent continues to explore according to the updated exploration path.
[0063] The above embodiments are only used to illustrate the technical method of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical method of the present invention may be modified or replaced by equivalents without departing from the spirit and scope of the technical method of the present invention.
Claims
1. A multi-agent system motion control method, characterized in that: include: Step 1: Collect the agent's individual data and infrared data; Step 2: Construct the initial terrain map; An initial exploration direction is set, and the individual explores according to the initial direction, and obtains the exploration status in real time based on infrared data; based on the exploration status, the initial topographic map is updated to obtain an updated topographic map; Step 3: Based on the updated terrain map and subject data, the individual's updated exploration path is replanned, and the individual continues to explore according to the updated exploration path.
2. A multi-agent system motion control method according to claim 1, characterized in that: The real-time acquisition of exploration conditions based on infrared data includes: Extracting infrared data; the infrared data includes a first distance, a second distance, and a third distance from the individual to surrounding obstacles collected by an infrared sensor installed on the surface of the individual; Setting a distance threshold; the distance threshold is set according to an individual's safety distance; Determine whether the first distance is greater than a distance threshold; if yes, mark the first distance state as a normal state; if no, mark the first distance state as an abnormal state; Determine whether the second distance is greater than a distance threshold; if yes, mark the second distance state as a normal state; if no, mark the second distance state as an abnormal state; Determine whether the third distance is greater than a distance threshold; if yes, mark the third distance state as a normal state; if no, mark the third distance state as an abnormal state; The first distance state, the second distance state, and the third distance state are combined to obtain an exploration situation.
3. A multi-agent system motion control method according to claim 1, characterized in that: The updating of the initial topographic map based on the exploration situation to obtain an updated topographic map includes: Extracting exploration conditions; setting a field of view distance n; wherein the field of view distance is set according to a distance clearly captured by a camera mounted on the individual; With the individual midpoint as the center and the field of view distance n as the radius, the individual exploration range is obtained; Determine whether the exploration situation contains abnormal conditions; if yes, mark the explored obstacles on the terrain map, and control the individuals with abnormal conditions to explore and obtain obstacle data; if no, control the individuals to continue exploring; All obstacles explored by individuals and their exploration ranges are updated into the terrain map to obtain an updated terrain map.
4. A multi-agent system motion control method according to claim 3, characterized in that: The controlling of the individual in the abnormal state to explore and obtain obstacle data includes: Extract the exploration status of individuals in abnormal states; The emission direction of the infrared sensor that detects the anomaly is marked as the abnormal exploration direction; the detected obstacle position is marked as the primary obstacle position, the secondary obstacle position detected by the infrared sensor at the next moment is collected, and the line connecting the primary obstacle position and the secondary obstacle position is marked as the obstacle direction; the angle between the abnormal exploration direction and the obstacle direction is marked as the obstacle exploration direction, and the abnormal individual is controlled to drive in the obstacle exploration direction to explore the length, width and surface shape of the obstacle, and the length, width and surface shape of the obstacle are marked as obstacle data.
5. A multi-agent system motion control method according to claim 4, characterized in that: The control of the abnormal individual to travel in the direction of the obstacle to explore the length, width and surface shape of the obstacle includes: A1: After the individual adjusts the direction, it continues to monitor the exploration situation; A2: Determine whether the number of abnormal states in the exploration situation has increased; if yes, adjust the direction again and conduct a second obstacle exploration; if no, jump to A3; A3: Determine whether the number of abnormal states at the current moment has decreased; if yes, complete obstacle detection, adjust the direction, and continue to complete the exploration; if no, continue to drive in the direction of exploring obstacles to perform obstacle exploration.
6. A multi-agent system motion control method according to claim 1, characterized in that: The step of replanning an individual updated exploration path based on the updated terrain map and subject data includes: B1: extract and update the topographic map and main data; the main data includes the individual's driving path, driving speed and driving time; B2: After completing the obstacle exploration, detect the secondary infrared data of the individual; select the individual's initial update path based on the secondary infrared data; B3: Determine whether the preliminary updated path overlaps with the driving paths of other individuals; if yes, jump to B4; if no, mark the preliminary updated path as the updated exploration path; B4: Mark the individuals that are repeated with the initial updated path as repeated individuals, and obtain the individual time for the individual to reach the repeated point and the repeated time for the individual to reach the repeated point based on the driving speed, the current position of the individual and the current position of the repeated individual; B5: Determine whether the individual time is the same as the repeated time; if so, control the individual to change the driving speed so that the time it takes to reach the repeated point is different, and repeat step B2; if not, mark the preliminary updated path as the updated exploration path.
7. A multi-agent system motion control method according to claim 6, characterized in that: The method of selecting a preliminary update path of an individual according to the secondary infrared data comprises: Extracting secondary infrared data; the secondary infrared data includes a secondary first distance, a secondary second distance and a secondary third distance detected by the individual; Sort the quadratic first distance, the quadratic second distance and the quadratic third distance from large to small, mark the middle direction of the directions of the first two infrared data as the standard direction, and mark the ratio of the first infrared data to the second infrared data as the standard value BJH; The update angle JD is obtained by the formula JD=(BJH-1)×90%, the direction of the infrared data with the first position in the standard direction is offset by the update angle to obtain the updated exploration direction, and the path of the updated exploration direction is marked as the preliminary update path.
