CN116069045B - Radiation environment detection method and system based on mobile robot - Google Patents
Radiation environment detection method and system based on mobile robot Download PDFInfo
- Publication number
- CN116069045B CN116069045B CN202310356288.5A CN202310356288A CN116069045B CN 116069045 B CN116069045 B CN 116069045B CN 202310356288 A CN202310356288 A CN 202310356288A CN 116069045 B CN116069045 B CN 116069045B
- Authority
- CN
- China
- Prior art keywords
- path
- global
- mobile robot
- objective function
- individual
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 230000005855 radiation Effects 0.000 title claims abstract description 56
- 238000001514 detection method Methods 0.000 title claims abstract description 37
- 238000000034 method Methods 0.000 claims abstract description 52
- 230000004888 barrier function Effects 0.000 claims abstract description 3
- 230000006870 function Effects 0.000 claims description 41
- 230000006399 behavior Effects 0.000 claims description 25
- 230000008569 process Effects 0.000 claims description 17
- 238000004891 communication Methods 0.000 claims description 16
- 238000010845 search algorithm Methods 0.000 claims description 13
- 238000011156 evaluation Methods 0.000 claims description 5
- 230000007246 mechanism Effects 0.000 claims description 5
- 238000004088 simulation Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 3
- 230000003993 interaction Effects 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 claims 1
- 238000005457 optimization Methods 0.000 abstract description 8
- 230000003542 behavioural effect Effects 0.000 description 4
- 238000012544 monitoring process Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001174 ascending effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001066 destructive effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000019637 foraging behavior Effects 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000002028 premature Effects 0.000 description 1
- 230000005258 radioactive decay Effects 0.000 description 1
- 239000000941 radioactive substance Substances 0.000 description 1
- 238000005295 random walk Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a radiation environment detection method and a radiation environment detection system based on a mobile robot, wherein the method comprises the following steps: constructing a two-dimensional environment map of the target area through known barrier information; acquiring coordinates of a starting point and an ending point, and the number of path points to be optimized; constructing obstacle avoidance constraints based on known obstacle information, and establishing an objective function of global path planning by taking the shortest path length as an objective; and solving an objective function of global path planning by using the path points as parameters through an improved social network searching algorithm to obtain a global optimal path. According to the invention, the obstacle avoidance constraint is constructed based on the known obstacle information, the objective function of global path planning is established by taking the shortest route length as a target, the social network searching algorithm is improved through the collaborative searching algorithm, the hybrid intelligent optimization algorithm is formed to solve the objective function, the solving speed is ensured, and meanwhile, the quality of the solution is improved, so that the radiation detection efficiency is improved.
Description
Technical Field
The invention belongs to the field of robot radiation detection path planning, and particularly relates to a radiation environment detection method and system based on a mobile robot.
Background
Radiation environment detection is an important content in research directions such as nuclear facility operation, radiation emergency treatment, environment quality monitoring and the like. The radiation amount of particles or rays emitted by radioactive substances during radioactive decay exceeds a certain range, and thus the influence on people and objects in the environment is caused. Therefore, in order to avoid health damage risk caused by manual radiation detection, it is important to carry out radiation detection on a target area by carrying a radiation detector on advanced equipment such as a mobile robot and an unmanned aerial vehicle.
When radiation detection is performed based on a mobile robot, how to accurately perform path planning of the mobile robot becomes a first consideration. At present, some mobile robot-based radiation detection can realize autonomous path planning, for example, the patent of the invention with the application number of CN107328418A discloses an autonomous planning method for a nuclear radiation detection path of a mobile robot in a strange indoor scene, a global path planning route is generated through a global cost map, the planned route is in a shape of a linear serpentine coil, and all areas to be detected are covered, but the path planning mode is mainly suitable for monitoring the quality of a nuclear facility in normal operation or daily environment and is not suitable for radiation emergency treatment and other scenes.
When an accident occurs in the nuclear facility, radiation detection in the surrounding area needs to be rapidly performed so as to rapidly perform radiation leakage bottoming, and a basis is provided for evaluating the accident result and an emergency measure decision. At the moment, a safe collision-free path with the shortest length from the starting point to the end point needs to be planned, so that the robot is ensured to safely and rapidly perform radiation detection bottoming. In the existing mobile robot path planning method, the path planning mode based on the group intelligent algorithm is popular, but still has the problems of easy local optimization, poor stability and the like, and influences the accuracy of path planning, so that a new mobile robot path planning mode is needed to be suitable for the scenes of radiation emergency treatment and the like, which need to rapidly detect radiation.
Disclosure of Invention
In view of the above, the invention provides a method and a system for detecting a radiation environment based on a mobile robot, which are used for solving the problem of low accuracy of a path planning mode of the mobile robot in a radiation emergency treatment scene.
The invention discloses a radiation environment detection method based on a mobile robot, which is used for planning a radiation detection path of the mobile robot, wherein environment sensing equipment and a radiation detector are carried on the mobile robot, and the method comprises the following steps:
constructing a two-dimensional environment map of the target area through known barrier information;
acquiring coordinates of a starting point and an ending point, and the number of path points to be optimized;
constructing obstacle avoidance constraints based on known obstacle information, and establishing an objective function of global path planning by taking the shortest path length as an objective;
and solving an objective function of global path planning by using the path points as parameters through an improved social network searching algorithm to obtain a global optimal path.
On the basis of the above technical solution, preferably, the objective function of constructing obstacle avoidance constraints based on known obstacle information and establishing global path planning with the shortest path length as the objective specifically includes:
let the number of path points to be optimized beZThe coordinates of the starting point and the end point are respectively%x 0 ,y 0 )、(x Z+1 ,y Z+1 ) The coordinate set of the path points is {x z ,y z )|z=1,2,...,Z};
Objective function for global path planningFThe expression of (2) is:
wherein ,ωin order to penalize the coefficients,Q(t) As a penalty function of the obstacle avoidance constraint,t=1,2,…,T,Tas a total number of obstacles,r t is the firsttRadius of obstacle [ ]a t ,b t ) Is the firsttThe coordinates of the circle centers of the individual obstacles,His a safe distance.
On the basis of the above technical solution, preferably, the solving the objective function of the global path plan by the improved social network search algorithm, to obtain the global optimal path specifically includes:
initializing a population of a social network searching algorithm in a solution space of the path points, and taking the population as a team of a collaborative searching algorithm;
calculating the fitness of each individual by taking the minimum objective function as a fitness function, and selecting M individuals with smaller fitness from the fitness functions as leaders;
randomly selecting any one of behavior modes of imitation, dialogue, dispute or innovation according to a certain probability to update the population position; the team communication thought of the collaborative search algorithm is introduced into the dialogue behavior mode to update the population position;
repeating the above processes and performing iterative operation until the iteration stop condition is met, and outputting the optimal solution.
On the basis of the above technical solution, preferably, the group location updating by introducing the team communication idea of the collaborative search algorithm in the dialogue behavioral mode specifically includes:
wherein ,respectively representing knowledge of one individual randomly selected from M leaders, collective knowledge of the M leaders and collective knowledge of all individuals, R represents interaction effect of the individual i and the randomly selected individual j,the position of the d-th dimension data for the j-th individual at the kth iteration;
the position of the ith dimension of the ith individual at the kth, k+1 iterations,/for each individual>Generating uniformly distributed random numbers within the range of 0-1, ">A historical optimal solution for a randomly selected one of the M leaders,bto obtain a new data set from {1,2, …,Mrandomly selecting a sequence number; />For the position of the mth individual, m=1, 2, …, M, +.>For the optimal solution of the ith individual in the kth iteration, i=1, 2, …, N is the population number; alpha is,βFor the purpose of weight adjustment of the coefficients,f i 、f j the fitness of individuals i, j, respectively.
On the basis of the technical scheme, preferably, the group location updating process of entering any one of the behavior modes of imitation, dialogue, dispute or innovation is randomly selected with a certain probability, and a grouping learning mechanism based on capability evaluation is introduced into the behavior mode of dispute to update the location:
wherein ,for learning ability of individual i, updating by random mode, L is preset ability threshold, P is standard normal distribution with mean value of 0 and variance of 1, and->Is the position mean of M leaders, and lambda is a constant with a value of 1 or 2.
On the basis of the above technical solution, preferably, the random selection of a certain probability is performed in a process of performing population location update in any one of a simulation, a dialogue, a dispute or an innovation, and in the innovation behavior mode, a location update formula is as follows:
On the basis of the above technical solution, preferably, the method further includes:
judging whether an unknown obstacle affecting the current global optimal path occurs or not through environment sensing equipment in the process that the mobile robot moves according to the global optimal path, if so, acquiring unknown obstacle information, updating a two-dimensional environment map of a target area, and carrying out global path planning again by taking the current position as a starting point; the environment sensing device comprises a camera and a laser radar.
In a second aspect of the present invention, a radiation environment detection system based on a mobile robot is disclosed, the system comprising:
the environment map building module: a two-dimensional environment map for constructing a target area by known obstacle information;
an objective function establishment module: the method is used for acquiring coordinates of a starting point and an ending point and the number of path points to be optimized; constructing obstacle avoidance constraints based on known obstacle information, and establishing an objective function of global path planning by taking the shortest path length as an objective;
and a path planning module: the method comprises the steps of using path points as parameters, and solving an objective function of global path planning through an improved social network searching algorithm to obtain a global optimal path;
and a path adjustment module: the method comprises the steps that in the process that a mobile robot moves according to a global optimal path, whether an unknown obstacle affecting the current global optimal path appears or not is judged through environment sensing equipment, if yes, information of the unknown obstacle is obtained, a two-dimensional environment map of a target area is updated, and global path planning is conducted again with the current position as a starting point; the environment sensing device comprises a camera and a laser radar.
In a third aspect of the present invention, an electronic device is disclosed, comprising: at least one processor, at least one memory, a communication interface, and a bus;
the processor, the memory and the communication interface complete communication with each other through the bus;
the memory stores program instructions executable by the processor which the processor invokes to implement the method according to the first aspect of the invention.
In a fourth aspect of the invention, a computer-readable storage medium is disclosed, storing computer instructions that cause a computer to implement the method according to the first aspect of the invention.
Compared with the prior art, the invention has the following beneficial effects:
1) According to the invention, a mobile robot is carried with a radiation detector for radiation environment detection, in the process of path planning, obstacle avoidance constraint is constructed based on known obstacle information, a global path planning objective function is established by taking the shortest path length as a target, a social network searching algorithm is improved through a collaborative searching algorithm, a hybrid intelligent optimization algorithm is formed for solving the objective function, the solving speed is ensured, and meanwhile, the solving quality is improved, so that the radiation detection efficiency is improved;
2) According to the invention, the team communication thought of the collaborative search algorithm is introduced into the dialogue behavioral mode of the social network search algorithm to update the population position, so that the information exchange among individuals is enhanced, and the grouping learning mechanism based on the capability evaluation is introduced into the dispute behavioral mode to update the position, thereby forming an improved social network search algorithm, reducing the defects of poor stability and easy sinking into a local optimal solution caused by strong randomness of the original social network search algorithm, and improving the robustness of the algorithm.
3) In the process that the mobile robot advances according to the global optimal path, the environment sensing equipment judges whether an unknown obstacle affecting the current global optimal path appears or not, and global path planning is conducted again by taking the current position as a starting point, so that the method is suitable for radiation detection under the condition that the environment changes or part of the environment is unknown, and the robustness and the adaptability of the mobile robot radiation detection are improved.
Drawings
In order to more clearly illustrate the embodiments of the invention or the technical solutions in the prior art, the drawings that are required in the embodiments or the description of the prior art will be briefly described, it being obvious that the drawings in the following description are only some embodiments of the invention, and that other drawings may be obtained according to these drawings without inventive effort for a person skilled in the art.
Fig. 1 is a flowchart of a radiation environment detection method based on a mobile robot according to the present invention.
Detailed Description
The following description of the embodiments of the present invention will clearly and fully describe the technical aspects of the embodiments of the present invention, and it is apparent that the described embodiments are only some embodiments of the present invention, not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the present invention without making any inventive effort, are intended to fall within the scope of the present invention.
The invention detects the radiation environment based on the mobile robot carrying environment sensing equipment and the radiation detector, and can be suitable for rapid radiation detection bottoming under the radiation emergency treatment scene. The robot path planning is an NP difficult problem in nature, and the method aims at the path planning problem of the mobile robot, establishes an objective function of global path planning by taking the shortest path length as a target, solves a global optimal path through an improved social network searching algorithm, and improves the path optimization speed. In addition, in the process that the mobile robot advances according to the global optimal path, unknown obstacles influencing the current global optimal path can be perceived in real time through the environment perception device, global path planning is conducted again by taking the current position as a starting point, and the robustness and the adaptability of the mobile robot radiation detection are improved.
Referring to fig. 1, the present invention provides a radiation environment detection method based on a mobile robot, the method includes:
s1, constructing a two-dimensional environment map of the target area through known obstacle information.
The target area is generally safe during the operation of the nuclear facility or during the daily environmental quality monitoring, at this time, the obstacle information in the environment is known, and when an emergency such as radiation leakage occurs, the environment of the target area may be changed, for example, an additional obstacle may occur, but basically, some changes occur on the basis of the original environment, so long as serious and destructive damage does not occur, and prior information such as the known obstacle information in the surrounding environment can be utilized.
The two-dimensional environment map of the target area is constructed by using known obstacle information through a grid method, and the information such as the central position, the occupied range and the like of the circular obstacle is marked in the two-dimensional environment map by abstracting the circular obstacle by taking the central coordinate of the obstacle as the center and the maximum distance of the edge of the obstacle from the central coordinate as the radius obstacle because the common obstacle is not necessarily in a regular shape.
S2, acquiring coordinates of a starting point and an ending point, and optimizing the number of the path points.
When the range of the area to be detected is not too large, directly taking the whole area to be detected as a target area, determining the starting point coordinates and the end point coordinates of the target area, and planning the path of the mobile robot in the target area. When the range of the area to be detected is too large, the area to be detected can be divided to form a plurality of target areas, a starting point and an end point are determined for each target area, mobile robot path planning is respectively carried out on each target area, and then path planning results of adjacent target areas are connected in series to form a complete robot radiation detection path.
In the target area, the number of path points to be optimized is required to be set, the number of the path points determines the dimension of path optimization, and the higher the dimension is, the higher the accuracy of path optimization is.
In the embodiment of the invention, the number of the path points needing to be optimized is set asZThe coordinates of the path points are%x 1 ,y 1 ),(x 2 ,y 2 ),...,(x Z ,y Z ) The coordinate set of the path points is {x z ,y z )|z=1,2,...,ZThe coordinates of the starting point and the end point are respectively%x 0 ,y 0 )、(x Z+1 ,y Z+1 ) The global path planning is to plan a safe path which starts from the starting point, passes through each path point to reach the ending point and does not collide with the obstacle.
S3, constructing obstacle avoidance constraints based on known obstacle information, and building an objective function of global path planning by taking the shortest path length as an objective.
Is provided withTAs the total number of obstacles in the target area,r t is the firsttRadius of obstacle [ ]a t ,b t ) Is the firsttThe coordinates of the circle centers of the individual obstacles,t=1,2,…,T。
since the mobile robot requires a certain safe working space, a safe distance is required to be set in order to avoid the obstacle during the working processHI.e. the minimum distance of the waypoint to the edge of the obstacle.
Establishing an objective function of global path planning by taking shortest path length under obstacle avoidance constraint as a target, wherein the objective function isFThe expression of (2) is:
wherein ,ωin order to penalize the coefficients,Q(t) Is the firsttPenalty function of obstacle avoidance constraints for individual obstacles.
And S4, solving an objective function of global path planning by using the path points as parameters through an improved social network searching algorithm to obtain a global optimal path.
Social network search algorithms (Social Network Search, SNS) mainly simulate the behavior of users when expressing opinion: imitates, dialogues, disputes and innovations, has the advantage of fast convergence speed. The algorithm enters a simulation, dialogue, dispute or innovation behavior mode through a random selection mode, in each behavior mode, opinion exchange is basically carried out in a random selection mode, and although strong randomness can search in a large range in a search space, due to strong randomness, the algorithm can miss an optimal solution to be trapped into local optimization so as to cause premature convergence.
The step S42 specifically includes the following sub-steps:
s421, initializing a population of a social network searching algorithm in a solution space of the path points, and taking the population as a team of the collaborative searching algorithm.
In the invention, a two-dimensional environment map is created by a grid method in the step S1, grids where obstacles are located are removed from the two-dimensional environment map, a feasible path set formed by the remaining grids is a solution space of path points, a population is initialized in the solution space, each individual in the population represents a path, the total number Z of the path points is the same as the vector dimension D of the individual in the population, the number N of the population is set, and the population is used as a team of a collaborative search algorithm. And initializing other initial parameters of the social network searching algorithm, the maximum iteration number K and the like.
S422, calculating fitness of each individual by taking an objective function of global path planning as a fitness function, and selecting M individuals with smaller fitness as leaders.
I.e. the fitness function is F, the smaller the fitness function value, the higher the quality of the representation solution.
And (5) carrying out ascending order on the fitness values of the individuals, and taking the first M individuals as leaders.
S423, randomly selecting any one of behavior modes of imitation, dialogue, dispute or innovation with a certain probability to update the population position.
Specifically, generating a random number r within a range of 0-1, and entering an imitation behavior mode if r is less than or equal to 0.25; entering a dialogue behavior mode when r is more than 0.25 and less than or equal to 0.5; if r is less than or equal to 0.75 and is 0.5, entering a dispute behavior mode, and if r is more than 0.75, entering an innovation behavior mode.
In the simulated behavior mode, a conversation is randomly selectedThe object is imitated by adopting the following position updating mode:
wherein ,the position of the ith dimension of the ith individual at the kth, k+1 iterations,/for each individual>D = 1,2, …, D for the position of the D-th dimension data of the j-th individual at the kth iteration; n is population number; i=1, 2, …, N, k=1, 2, …, K.
In the dialogue behavioral model, team communication ideas of a collaborative search algorithm are introduced to update individual positions:
wherein ,each representing knowledge of one individual randomly selected from M leaders, collective knowledge of all individuals, R representing interaction effect of individual i with randomly selected individual j>The d-th dimension data for the j-th individual is atkThe position at the next iteration;
generating uniformly distributed random numbers within the range of 0-1, ">A historical optimal solution for an individual randomly selected from the M leaders, b is an individual serial number randomly selected from {1,2, …, M }; />For the position of the mth individual, m=1, 2, …, M, +.>Representing the optimal position mean of the M leaders; />For the optimal solution of the ith individual at the kth iteration,/for the kth iteration>Representing a position mean of the population; alpha, & alpha>For the purpose of weight adjustment of the coefficients,f i 、f j the fitness of individuals i, j, respectively.
According to the invention, by introducing the team communication thought of the collaborative search algorithm in the dialogue behavior mode, the information exchange among groups is enhanced, the optimal solution is conveniently and quickly found, and the problems that the information from only one individual exchange generation is limited and is easy to fall into the local optimal solution are avoided.
In the dispute behavior mode, a grouping learning mechanism based on capability evaluation is introduced for individual position updating:
wherein ,for learning ability of individual i, L.sub.L.is updated in a random manner>(0, 1) is a preset capacity threshold, P is a standard normal distribution with mean 0 and variance 1,/for>Is the position mean value of M leaders, and lambda is a constant with the value of 1 or 2.
According to the method, through a grouping learning mechanism based on capability evaluation, a group with strong learning capability is focused on improving the position goodness of the user, the user continues to search for a better solution near the user's position, a group with weak learning capability is focused on breaking through the limitation of the user, and the user searches for a position with possibly higher adaptability in a larger search range, so that the balance between local exploration and global development is considered.
In the innovative behavior mode, a Lewy flight strategy is introduced for position update:
In the innovative behavior mode, the invention replaces the original linear random generation strategy by the Lewy flight strategy, and the Lewy flight is also a random walk strategy, but can simulate animal foraging behavior to a certain extent, and experimental research shows that the searching efficiency is higher.
S424, repeating the processes of the steps S422-S423, and performing iterative operation until the iteration stop condition is met, and outputting the optimal solution as a global optimal path.
In the process of carrying out radiation environment detection path planning by adopting the mobile robot to carry the radiation detector, the invention constructs obstacle avoidance constraint based on known obstacle information, establishes an objective function of global path planning by taking the shortest route length as a target, improves a social network searching algorithm by a collaborative searching algorithm, forms a hybrid intelligent optimization algorithm to solve the objective function, and improves the quality of solution while ensuring the solving speed, thereby improving the efficiency of radiation detection.
S5, in the process that the mobile robot moves according to the global optimal path, two-dimensional environment map updating and global path planning adjustment are carried out through the environment sensing equipment.
And (4) carrying an environment sensing device and an environment detector by the mobile robot to detect radiation according to the globally optimal path solved in the step (S4), wherein the environment sensing device comprises a camera and a laser radar.
In the process of detecting radiation along the global optimal path, the mobile robot senses the surrounding environment in real time through the environment sensing equipment, and when a certain obstacle is sensed, whether the obstacle is a known obstacle is judged. If the target area is the unknown obstacle, judging whether the unknown obstacle affecting the current global optimal path appears, if so, acquiring the information of the unknown obstacle, updating the two-dimensional environment map of the target area, and re-executing the steps S2-S4 to carry out global path planning by taking the current position as a starting point.
The mobile robot of the invention can carry out dynamic path adjustment based on the environmental perception result at any time in the running process according to the planned route, can be suitable for radiation detection under the condition that the environment is changed or the condition that part of the environment is unknown, and can improve the robustness and adaptability of the radiation detection of the mobile robot
Corresponding to the embodiment of the method, the invention also discloses a radiation environment detection system based on the mobile robot, which comprises the following steps:
the environment map building module: a two-dimensional environment map for constructing a target area by known obstacle information;
an objective function establishment module: the method is used for acquiring coordinates of a starting point and an ending point and the number of path points to be optimized; constructing obstacle avoidance constraints based on known obstacle information, and establishing an objective function of global path planning by taking the shortest path length as an objective;
and a path planning module: the method comprises the steps of using path points as parameters, and solving an objective function of global path planning through an improved social network searching algorithm to obtain a global optimal path;
and a path adjustment module: the method comprises the steps that in the process that a mobile robot moves according to a global optimal path, whether an unknown obstacle affecting the current global optimal path appears or not is judged through environment sensing equipment, if yes, information of the unknown obstacle is obtained, a two-dimensional environment map of a target area is updated, and global path planning is conducted again with the current position as a starting point; the environment sensing device comprises a camera and a laser radar.
The system embodiments and the method embodiments are in one-to-one correspondence, and the brief description of the system embodiments is just to refer to the method embodiments.
The invention also discloses an electronic device, comprising: at least one processor, at least one memory, a communication interface, and a bus; the processor, the memory and the communication interface complete communication with each other through the bus; the memory stores program instructions executable by the processor that the processor invokes to implement the aforementioned methods of the present invention.
The invention also discloses a computer readable storage medium storing computer instructions for causing a computer to implement all or part of the steps of the methods of the embodiments of the invention. The storage medium includes: a usb disk, a removable hard disk, a ROM, a RAM, a magnetic disk, or an optical disk, or other various media capable of storing program codes.
The system embodiments described above are merely illustrative, wherein the elements illustrated as separate elements may or may not be physically separate, and the elements shown as elements may or may not be physical elements, i.e., may be distributed over a plurality of network elements. One of ordinary skill in the art may select some or all of the modules according to actual needs without performing any inventive effort to achieve the objectives of the present embodiment.
The foregoing description of the preferred embodiments of the invention is not intended to be limiting, but rather is intended to cover all modifications, equivalents, alternatives, and improvements that fall within the spirit and scope of the invention.
Claims (8)
1. A radiation environment detection method based on a mobile robot, for planning a detection path of the mobile robot, wherein the mobile robot is carried with an environment sensing device and a radiation detector, the method is characterized by comprising the following steps:
constructing a two-dimensional environment map of the target area through known barrier information;
acquiring coordinates of a starting point and an ending point, and the number of path points to be optimized;
constructing obstacle avoidance constraints based on known obstacle information, and establishing an objective function of global path planning by taking the shortest path length as an objective;
solving an objective function of global path planning by using the path points as parameters through an improved social network searching algorithm to obtain a global optimal path;
solving the objective function of the global path plan through the improved social network searching algorithm, wherein the obtaining of the global optimal path specifically comprises the following steps:
initializing a population of a social network searching algorithm in a solution space of the path points, and taking the population as a team of a collaborative searching algorithm;
calculating the fitness of each individual by taking the objective function as a fitness function, and selecting M individuals with smaller fitness from the fitness functions as leaders;
randomly selecting any one of behavior modes of imitation, dialogue, dispute or innovation according to a certain probability to update the population position; the team communication thought of the collaborative search algorithm is introduced into the dialogue behavior mode to update the population position; the group position updating by introducing team communication ideas of a collaborative search algorithm in the dialogue behavior mode specifically comprises the following steps:
wherein ,respectively represent slaveMKnowledge of a randomly selected individual among the leaders,MCollective knowledge of individual leaders and collective knowledge of all individuals,Rrepresenting individualsiWith randomly selected individualsjIs used for the interaction effect of the (a),is the firstjIndividual firstdDimensional data at the firstkThe position at the next iteration;
respectively the firstiIndividual firstdDimensional data at the firstkNext time,kPosition at +1 iterations, +.>Generating uniformly distributed random numbers within the range of 0-1, ">Is thatMA historic optimal solution for an individual randomly selected from among the leaders,bto obtain a new data set from {1,2, …,Mrandomly selecting a sequence number; />Is the firstmThe location of the individual(s),m=1,2,…,M,is the firstiIndividual at the firstkThe optimal solution at the time of the iteration,i=1,2,…,N,Nis the population number;α、βfor the purpose of weight adjustment of the coefficients,f i 、f j respectively individuali、jIs adapted to the degree of adaptation of (a);
repeating the above processes and performing iterative operation until the iteration stop condition is met, and outputting the optimal solution.
2. The mobile robot-based radiation environment detection method according to claim 1, wherein the constructing obstacle avoidance constraints based on the known obstacle information and establishing an objective function of global path planning with the shortest path length as the objective specifically comprises:
let the number of path points to be optimized beZThe coordinates of the starting point and the end point are respectively%x 0 ,y 0 )、(x Z+1 ,y Z+1 ) The coordinate set of the path points is {x z ,y z )|z=1,2,...,Z};
Objective function for global path planningFThe expression of (2) is:
wherein ,ωin order to penalize the coefficients,Q(t) As a penalty function of the obstacle avoidance constraint,t=1,2,…,T,Tas a total number of obstacles,r t is the firsttRadius of obstacle [ ]a t ,b t ) Is the firsttThe coordinates of the circle centers of the individual obstacles,His a safe distance.
3. The method for detecting radiation environment based on mobile robot according to claim 1, wherein the random selection of a certain probability is performed to enter any one of a simulation, a dialogue, a dispute or an innovation behavior mode for updating the population position, and a grouping learning mechanism based on capability evaluation is introduced into the dispute behavior mode for updating the position:
4. The method for detecting radiation environment based on mobile robot according to claim 1, wherein the random selection of a certain probability is performed in any one of a simulation, a dialogue, a dispute or an innovation behavior mode for updating the population position, and in the innovation behavior mode, the position updating formula is as follows:
5. The mobile robot-based radiant environment detection method of claim 2, further comprising:
judging whether an unknown obstacle affecting the current global optimal path occurs or not through environment sensing equipment in the process that the mobile robot moves according to the global optimal path, if so, acquiring unknown obstacle information, updating a two-dimensional environment map of a target area, and carrying out global path planning again by taking the current position as a starting point; the environment sensing device comprises a camera and a laser radar.
6. A mobile robot-based radiation environment detection system to which the method of any one of claims 1 to 5 is applied, the system comprising:
the environment map building module: a two-dimensional environment map for constructing a target area by known obstacle information;
an objective function establishment module: the method is used for acquiring coordinates of a starting point and an ending point and the number of path points to be optimized; constructing obstacle avoidance constraints based on known obstacle information, and establishing an objective function of global path planning by taking the shortest path length as an objective;
and a path planning module: the method comprises the steps of using path points as parameters, and solving an objective function of global path planning through an improved social network searching algorithm to obtain a global optimal path;
and a path adjustment module: the method comprises the steps that in the process that a mobile robot moves according to a global optimal path, whether an unknown obstacle affecting the current global optimal path appears or not is judged through environment sensing equipment, if yes, information of the unknown obstacle is obtained, a two-dimensional environment map of a target area is updated, and global path planning is conducted again with the current position as a starting point; the environment sensing device comprises a camera and a laser radar.
7. An electronic device, comprising: at least one processor, at least one memory, a communication interface, and a bus;
the processor, the memory and the communication interface complete communication with each other through the bus;
the memory stores program instructions executable by the processor, the processor invoking the program instructions to implement the method of any of claims 1-5.
8. A computer readable storage medium storing computer instructions for causing a computer to implement the method of any one of claims 1 to 5.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310356288.5A CN116069045B (en) | 2023-04-06 | 2023-04-06 | Radiation environment detection method and system based on mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310356288.5A CN116069045B (en) | 2023-04-06 | 2023-04-06 | Radiation environment detection method and system based on mobile robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116069045A CN116069045A (en) | 2023-05-05 |
CN116069045B true CN116069045B (en) | 2023-06-20 |
Family
ID=86170136
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310356288.5A Active CN116069045B (en) | 2023-04-06 | 2023-04-06 | Radiation environment detection method and system based on mobile robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116069045B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116661479B (en) * | 2023-07-28 | 2023-11-07 | 深圳市城市公共安全技术研究院有限公司 | Building inspection path planning method, equipment and readable storage medium |
CN116673968B (en) * | 2023-08-03 | 2023-10-10 | 南京云创大数据科技股份有限公司 | Mechanical arm track planning element selection method and system based on reinforcement learning |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107132846B (en) * | 2017-06-21 | 2020-06-05 | 南华大学 | Gamma radiation detection method under strange indoor scene |
KR102629762B1 (en) * | 2017-10-02 | 2024-01-29 | 소니그룹주식회사 | Environmental information update device, environmental information update method and program |
DE102018121365A1 (en) * | 2018-08-31 | 2020-04-23 | RobArt GmbH | EXPLORATION OF A ROBOT APPLICATION AREA BY AN AUTONOMOUS MOBILE ROBOT |
CN111210065A (en) * | 2020-01-03 | 2020-05-29 | 武汉大学 | Logistics network efficient K shortest path algorithm based on re-optimization technology |
CN111813125A (en) * | 2020-07-23 | 2020-10-23 | 北京市劳动保护科学研究所 | Indoor environment detection system and method based on wheeled robot |
CN114200920A (en) * | 2020-09-17 | 2022-03-18 | ***通信集团天津有限公司 | Path planning method, device and control system |
CN112731921A (en) * | 2020-12-11 | 2021-04-30 | 北方信息控制研究院集团有限公司 | Military path planning support system based on parallel simulation |
CN115167442A (en) * | 2022-07-26 | 2022-10-11 | 国网湖北省电力有限公司荆州供电公司 | Power transmission line inspection path planning method and system |
CN115357031B (en) * | 2022-10-19 | 2023-01-03 | 武汉理工大学 | Ship path planning method and system based on improved ant colony algorithm |
CN115729238A (en) * | 2022-11-15 | 2023-03-03 | 湘潭大学 | Dynamic path planning method for autonomous obstacle avoidance of mobile robot |
-
2023
- 2023-04-06 CN CN202310356288.5A patent/CN116069045B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN116069045A (en) | 2023-05-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN116069045B (en) | Radiation environment detection method and system based on mobile robot | |
CN113110482B (en) | Indoor environment robot exploration method and system based on priori information heuristic method | |
Goldhoorn et al. | Continuous real time POMCP to find-and-follow people by a humanoid service robot | |
CN108629288A (en) | A kind of gesture identification model training method, gesture identification method and system | |
CN113792930A (en) | Blind person walking track prediction method, electronic device and storage medium | |
CN115017805B (en) | Method and system for planning optimal path of nuclear retired field based on bidirectional A-x algorithm | |
Zhi et al. | Learning autonomous exploration and mapping with semantic vision | |
Jiang et al. | Intelligent plant cultivation robot based on key marker algorithm using visual and laser sensors | |
Liu et al. | An efficient robot exploration method based on heuristics biased sampling | |
KR20210054355A (en) | Vision and language navigation system | |
CN114397894B (en) | Mobile robot target searching method imitating human memory | |
Cabrita et al. | Odor Guided Exploration and Plume Tracking-Particle Plume Explorer. | |
CN114367110A (en) | Data processing method and device, electronic equipment and storage medium | |
CN112699800A (en) | Vehicle searching method and device, storage medium and terminal | |
Tsardoulias et al. | Cost-based target selection techniques towards full space exploration and coverage for USAR applications in a priori unknown environments | |
Tang | From agent to avatar | |
CN112836852B (en) | Unmanned platform path planning method and device based on reinforcement learning | |
CN111596668A (en) | Mobile robot anthropomorphic path planning method based on reverse reinforcement learning | |
CN117036966B (en) | Learning method, device, equipment and storage medium for point feature in map | |
Hong et al. | Design and Implementation of Path Planning for Wheel‐Track Hybrid Mobile Robot | |
CN117631667B (en) | Dynamic guiding obstacle avoidance evacuation method applied to multi-storey building personnel | |
Yao et al. | Improved artificial fish swarm based optimize rapidly-exploring random trees multi-robot exploration algorithm | |
Cissell | An Adaptive Memory-Based Reinforcement Learning Controller | |
Le | Fire Detection Robot using Type-2 Fuzzy Logic Sensor Fusion | |
CN117804457A (en) | Unmanned aerial vehicle autonomous exploration navigation method based on deep reinforcement learning |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |