CN111399522A - Substation inspection robot formation inspection formation keeping method based on behavior coordination - Google Patents

Substation inspection robot formation inspection formation keeping method based on behavior coordination Download PDF

Info

Publication number
CN111399522A
CN111399522A CN202010395882.1A CN202010395882A CN111399522A CN 111399522 A CN111399522 A CN 111399522A CN 202010395882 A CN202010395882 A CN 202010395882A CN 111399522 A CN111399522 A CN 111399522A
Authority
CN
China
Prior art keywords
formation
inspection robot
behavior
inspection
substation
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.)
Pending
Application number
CN202010395882.1A
Other languages
Chinese (zh)
Inventor
杨强
胡颖泽
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Suzhou Qiuzhen Intelligent Technology Co ltd
Original Assignee
Suzhou Qiuzhen Intelligent Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Suzhou Qiuzhen Intelligent Technology Co ltd filed Critical Suzhou Qiuzhen Intelligent Technology Co ltd
Priority to CN202010395882.1A priority Critical patent/CN111399522A/en
Publication of CN111399522A publication Critical patent/CN111399522A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0291Fleet control
    • G05D1/0295Fleet control by at least one leading vehicle of the fleet
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (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 substation inspection robot formation inspection formation keeping method based on behavior coordination, which is based on sub-behavior design in a behavior control strategy; in the formation patrol inspection process, the substation patrol inspection robot needs to know the position of the substation patrol inspection robot in the formation, and two methods are adopted for determining the target position by the substation patrol inspection robot: a piloting reference point method and a neighbor reference point method; the sub-behaviors of each transformer substation inspection robot have own priority authority, the sub-behaviors of the transformer substation inspection robot are fused by adopting a suppression method, and when the sub-behaviors are under the same condition, the transformer substation inspection robot can select the sub-behavior with high priority as the current behavior of the transformer substation inspection robot. Three basic behaviors controlled by the formation are designed, and in the formation keeping behavior, a piloting reference point method and a neighbor reference point method are adopted to design the formation, so that the inspection formation of the transformer substation inspection robot is effectively kept, and the inspection efficiency of the transformer substation is greatly improved.

Description

Substation inspection robot formation inspection formation keeping method based on behavior coordination
Technical Field
The invention relates to the field of inspection robot collaborative formation control, in particular to a substation inspection robot formation inspection formation shape maintaining method based on behavior collaboration.
Background
With the continuous development of computer technology, a network joint control monitoring system is applied on a large scale in an unattended transformer substation to command a robot to perform patrol and monitoring operation, the transformer substation intelligent patrol robot system with the practical advantages of being free from the influence of weather factors, more flexible in control operation mode and the like is produced, and the outdoor high-voltage equipment patrol task is gradually executed by the transformer substation outdoor intelligent patrol robot. The equipment is essentially based on mobile platforms in different forms, and can effectively complete full-autonomous positioning and navigation in a transformer substation, automatically measure the running state and temperature of various equipment in the transformer substation by carrying infrared and visible light sensors and other equipment, automatically set inspection, record inspection results and complete information interaction with an existing running system in the transformer substation, thereby replacing the original manual inspection mode of the transformer substation, and simultaneously completing fault diagnosis.
At present, in order to further improve the inspection efficiency of substation equipment, all-weather equipment inspection work is carried out, and the multi-substation robot cooperative inspection becomes an important form of future substation inspection. In order to complete the routing inspection task, a formation formed by a plurality of routing inspection robots needs to maintain and change the formation when the formation runs, and the purpose of reaching a destination in an environment with obstacles is achieved. The formation of certain formation is required to be completed when the formation starts to travel; the formation is required to be kept in the environment without the obstacles, the formation is required to be changed to avoid the obstacles in the environment with the obstacles, and finally, the target position of the appointed routing inspection is reached. Through patrolling and examining the robot to a plurality of transformer substations and patrolling and examining the task distribution to the effectual transformer substation of keeping patrols and examines the formation of patrolling and examining of robot, the efficiency that patrols and examines of promotion transformer substation that can be very big.
Disclosure of Invention
The invention aims to provide a substation inspection robot formation inspection formation keeping method based on behavior coordination, so as to solve the problems in the background technology.
In order to achieve the purpose, the invention provides the following technical scheme: a substation inspection robot formation inspection formation keeping method based on behavior coordination comprises the following steps: step A, designing based on child behaviors in a behavior control strategy;
step B, in the process of formation tour inspection, the substation tour inspection robot needs to know the position of the substation tour inspection robot in the formation at every moment, and two methods are adopted for determining the target position by the substation tour inspection robot: a piloting reference point method and a neighbor reference point method;
C. the sub-behaviors of each transformer substation inspection robot have own priority authority, the sub-behaviors of the transformer substation inspection robot are fused by adopting a suppression method, and when the sub-behaviors are under the same condition, the transformer substation inspection robot can select the sub-behavior with high priority as the current behavior of the transformer substation inspection robot.
In the above step a, the child behavior design includes the following three types:
1. the running-to-target behavior refers to a behavior that the inspection robot moves from the current position to the expected position, namely the behavior enables the inspection robot to obtain an output vector pointing to the expected area, so that the inspection robot finishes the movement to the appointed expected position;
2. the obstacle avoidance behavior is a behavior of the inspection robot for avoiding collision with a static obstacle, and in the formation control of the multiple inspection robots, the behavior of the inspection robot for avoiding collision with the static obstacle has important research significance, and the behavior of avoiding collision with the static obstacle can be determined because the obstacle is static;
3. the formation keeping behavior means that after the formation of the inspection robot is known, the target position of the inspection robot in the formation is determined, and the formation keeping behavior generates an output vector pointing to the set position;
in the step B, the navigation reference point method is: firstly, one routing inspection robot is assigned in a formation as a piloting routing inspection robot, the positions of the rest routing inspection robots are used as reference to determine the expected positions of the routing inspection robots in the formation, the piloting routing inspection robot does not need to consider how to stabilize the formation, and the other routing inspection robots need to keep the determined formation at all times;
the neighbor reference point method comprises the following steps: in the formation of the multiple inspection robots, each inspection robot selects the position of the inspection robot closest to the inspection robot in the formation as a reference point, and then determines the position of the inspection robot in the formation according to the position of the adjacent inspection robot;
in the step C, the two kinds of formation reference methods, namely the pilot reference point method and the neighbor reference point method, are adopted, and the fusion mode of the child behaviors is designed by taking the pilot reference point method as the formation method. Three basic behaviors for the inspection robot: the method comprises the following steps of running towards a target, avoiding obstacles and keeping formation, and basically selecting the following steps:
1. for the piloting inspection robot, one of a target running behavior and an obstacle avoidance behavior is selected according to the environment and the motion condition of the piloting inspection robot, so that the autonomous inspection capability of the inspection robot is embodied; in addition, in the process of team routing and inspection, the navigation inspection robot also needs to consider the inspection condition of the following inspection robot, and the cooperation of the navigation inspection robot is reflected.
2. The following inspection robot mainly selects the behavior of obstacle avoidance and the behavior of formation maintenance, the cooperation of the inspection robot is embodied, the following inspection robot does not consider the indication movement of the piloting inspection robot alone, and certain autonomy of the following inspection robot is also embodied.
3. The priority of various behaviors of the piloting inspection robot and the following inspection robot is defined, so that formation inspection is more stable. Defining the highest priority level of obstacle avoidance behaviors for the piloting inspection robot, and then defining the behavior towards the target; and defining the follow-up inspection robot to have the highest priority of obstacle avoidance behaviors and the next order of formation keeping behaviors. And selecting what behavior is distributed according to the level.
Compared with the prior art, the invention has the beneficial effects that: three basic behaviors controlled by the formation are specifically designed, and in the behavior keeping behavior of the formation, the piloting reference point method and the neighbor reference point method are respectively adopted to design the formation, so that the formation can be formed more quickly, the final behavior is fused, the behavior inhibiting method is adopted to obtain the formation control output, the inspection formation of the transformer substation inspection robot is effectively kept, and the inspection efficiency of the transformer substation is greatly improved.
Drawings
FIG. 1 is a schematic view of the pilot reference point method of the present invention;
FIG. 2 is a diagram illustrating a neighbor reference point method according to the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
Referring to fig. 1-2, the present embodiment provides a technical solution: a substation inspection robot formation inspection formation keeping method based on behavior coordination comprises the following steps: step A, designing based on child behaviors in a behavior control strategy;
in step a above, the child behaviors include the following three types:
1. the running-to-target behavior refers to a behavior that the inspection robot moves from the current position to the expected position, namely the behavior enables the inspection robot to obtain an output vector pointing to the expected area, so that the inspection robot finishes the movement to the appointed expected position;
2. and (4) obstacle avoidance behavior, namely behavior of avoiding collision between the inspection robot and a static obstacle. According to the current research, in the motion environment of the multi-inspection robot formation inspection control, a static obstacle is a problem which can be certainly generated and needs to be considered, in the multi-inspection robot formation control, the behavior of the inspection robot for avoiding collision with the static obstacle has important research significance, and the behavior of avoiding collision with the static obstacle can be determined due to the fact that the obstacle is static;
3. the formation keeping behavior means that after the formation of the inspection robot is known, the target position of the inspection robot in the formation is determined, and the formation keeping behavior generates an output vector pointing to the set position;
step B, in the process of formation tour inspection, the substation tour inspection robot needs to know the position of the substation tour inspection robot in the formation at every moment, and two methods are adopted for determining the target position by the substation tour inspection robot: a piloting reference point method and a neighbor reference point method;
in the step B, the navigation reference point method is: firstly, one routing inspection robot is assigned in the formation as a pilot routing inspection robot, and the positions of the rest routing inspection robots are used as references to determine the expected positions of the routing inspection robots in the formation. The piloting inspection robot does not need to consider how to stabilize the formation, while the other inspection robots need to keep well-defined formation every moment, as shown in fig. 1.
The neighbor reference point method comprises the following steps: in formation of the multiple inspection robots, each inspection robot selects the position of the inspection robot closest to itself in the formation as a reference point, and then determines the position of itself in the formation according to the positions of the neighboring inspection robots, as shown in fig. 2.
C. The sub-behaviors of each transformer substation inspection robot have own priority authority, the sub-behaviors of the transformer substation inspection robot are fused by adopting a suppression method, and when the sub-behaviors are under the same condition, the transformer substation inspection robot can select the sub-behavior with high priority as the current behavior of the transformer substation inspection robot.
In the step C, in order to make each child behavior of the inspection robot have its own priority authority, the method adopts a suppression method to fuse the child behaviors of the inspection robot, and when the child behaviors are in the same condition, the inspection robot selects the child behavior with high priority as the current behavior of the movement of the inspection robot. The method adopts the two formation reference methods, namely a pilot reference point method and a neighbor reference point method, and designs a sub-behavior fusion mode by taking the pilot reference point method as the formation method of the formation. Three basic behaviors for the inspection robot: the method comprises the following steps of running towards a target, avoiding obstacles and keeping formation, and basically selecting the following steps:
1. for the piloting inspection robot, one of a target running behavior and an obstacle avoidance behavior is selected according to the environment and the motion condition of the piloting inspection robot, so that the autonomous inspection capability of the inspection robot is embodied; in addition, in the process of team routing and inspection, the navigation inspection robot also needs to consider the inspection condition of the following inspection robot, and the cooperation of the navigation inspection robot is reflected.
2. The following inspection robot mainly selects the behavior of obstacle avoidance and the behavior of formation maintenance, the cooperation of the inspection robot is embodied, the following inspection robot does not consider the indication movement of the piloting inspection robot alone, and certain autonomy of the following inspection robot is also embodied.
3. The priority of various behaviors of the piloting inspection robot and the following inspection robot is defined, so that formation inspection is more stable. Defining the highest priority level of obstacle avoidance behaviors for the piloting inspection robot, and then defining the behavior towards the target; and defining the follow-up inspection robot to have the highest priority of obstacle avoidance behaviors and the next order of formation keeping behaviors. And selecting what behavior is distributed according to the level.
Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that changes, modifications, substitutions and alterations can be made in these embodiments without departing from the principles and spirit of the invention, the scope of which is defined in the appended claims and their equivalents.

Claims (3)

1. A substation inspection robot formation inspection formation keeping method based on behavior coordination is characterized in that: the patrol formation keeping method comprises the following steps: step A, designing based on child behaviors in a behavior control strategy;
step B, in the process of formation tour inspection, the substation tour inspection robot needs to know the position of the substation tour inspection robot in the formation at every moment, and two methods are adopted for determining the target position by the substation tour inspection robot: a piloting reference point method and a neighbor reference point method;
C. the sub-behaviors of each transformer substation inspection robot have own priority authority, the sub-behaviors of the transformer substation inspection robot are fused by adopting a suppression method, and when the sub-behaviors are under the same condition, the transformer substation inspection robot can select the sub-behavior with high priority as the current behavior of the transformer substation inspection robot.
2. The substation inspection robot formation inspection formation keeping method based on behavior coordination according to claim 1, characterized in that: in the step A, the child behavior design comprises the following three types:
(1) the running-to-target behavior refers to a behavior that the inspection robot moves from the current position to the expected position, namely the behavior enables the inspection robot to obtain an output vector pointing to the expected area, so that the inspection robot finishes the movement to the appointed expected position;
(2) the obstacle avoidance behavior is a behavior of the inspection robot for avoiding collision with a static obstacle, and in the formation control of the multiple inspection robots, the behavior of the inspection robot for avoiding collision with the static obstacle has important research significance, and the behavior of avoiding collision with the static obstacle can be determined because the obstacle is static;
(3) and the formation keeping behavior is that after the formation of the inspection robot is known, the target position of the inspection robot in the formation is determined, and an output vector pointing to the set position is generated by the formation keeping behavior.
3. The substation inspection robot formation inspection formation keeping method based on behavior coordination according to claim 1, characterized in that: in the step B, the piloting reference point method is as follows: firstly, one routing inspection robot is assigned in a formation as a piloting routing inspection robot, the positions of the rest routing inspection robots are used as reference to determine the expected positions of the routing inspection robots in the formation, the piloting routing inspection robot does not need to consider how to stabilize the formation, and the other routing inspection robots need to keep the determined formation at all times;
the neighbor reference point method comprises the following steps: in the formation of the multiple inspection robots, each inspection robot selects the position of the inspection robot closest to the inspection robot in the formation as a reference point, and then determines the position of the inspection robot in the formation according to the positions of the adjacent inspection robots.
CN202010395882.1A 2020-05-12 2020-05-12 Substation inspection robot formation inspection formation keeping method based on behavior coordination Pending CN111399522A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010395882.1A CN111399522A (en) 2020-05-12 2020-05-12 Substation inspection robot formation inspection formation keeping method based on behavior coordination

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010395882.1A CN111399522A (en) 2020-05-12 2020-05-12 Substation inspection robot formation inspection formation keeping method based on behavior coordination

Publications (1)

Publication Number Publication Date
CN111399522A true CN111399522A (en) 2020-07-10

Family

ID=71435738

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010395882.1A Pending CN111399522A (en) 2020-05-12 2020-05-12 Substation inspection robot formation inspection formation keeping method based on behavior coordination

Country Status (1)

Country Link
CN (1) CN111399522A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112286179A (en) * 2020-09-07 2021-01-29 西安电子科技大学 Cooperative motion control method and system, computer equipment and robot
CN112433538A (en) * 2020-11-25 2021-03-02 中国航天空气动力技术研究院 AUV formation method, system and storage medium

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106324619A (en) * 2016-10-28 2017-01-11 武汉大学 Automatic obstacle avoiding method of substation inspection robot
CN106647764A (en) * 2017-01-13 2017-05-10 吴海波 Motion track planning method and system for carrying robot
CN107121986A (en) * 2017-05-24 2017-09-01 浙江大学 The method that a kind of unmanned plane flight pattern of Behavior-based control is kept
CN207041486U (en) * 2017-03-08 2018-02-27 小狗电器互联网科技(北京)股份有限公司 the side brush of sweeping robot
CN109528087A (en) * 2017-09-21 2019-03-29 浪速亚洲企业 A kind of floor cleaning device and floor-sweeping dust collector of dust catcher
CN110231821A (en) * 2019-06-03 2019-09-13 哈尔滨工程大学 The adaptive kernel action amalgamation method of the improvement of multi-robot formation
CN110398975A (en) * 2019-09-04 2019-11-01 西北工业大学 A kind of navigator's follower type multiple aircraft formation fault tolerant control method based on broadcast operation framework

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106324619A (en) * 2016-10-28 2017-01-11 武汉大学 Automatic obstacle avoiding method of substation inspection robot
CN106647764A (en) * 2017-01-13 2017-05-10 吴海波 Motion track planning method and system for carrying robot
CN207041486U (en) * 2017-03-08 2018-02-27 小狗电器互联网科技(北京)股份有限公司 the side brush of sweeping robot
CN107121986A (en) * 2017-05-24 2017-09-01 浙江大学 The method that a kind of unmanned plane flight pattern of Behavior-based control is kept
CN109528087A (en) * 2017-09-21 2019-03-29 浪速亚洲企业 A kind of floor cleaning device and floor-sweeping dust collector of dust catcher
CN110231821A (en) * 2019-06-03 2019-09-13 哈尔滨工程大学 The adaptive kernel action amalgamation method of the improvement of multi-robot formation
CN110398975A (en) * 2019-09-04 2019-11-01 西北工业大学 A kind of navigator's follower type multiple aircraft formation fault tolerant control method based on broadcast operation framework

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112286179A (en) * 2020-09-07 2021-01-29 西安电子科技大学 Cooperative motion control method and system, computer equipment and robot
CN112433538A (en) * 2020-11-25 2021-03-02 中国航天空气动力技术研究院 AUV formation method, system and storage medium
CN112433538B (en) * 2020-11-25 2023-06-09 中国航天空气动力技术研究院 AUV formation method, system and storage medium

Similar Documents

Publication Publication Date Title
CN109240290B (en) Method for determining return route of power inspection robot
CN102566576B (en) Multiple inspection robot cooperative operation method for substation sequence control system
CN110471426B (en) Automatic collision avoidance method for unmanned intelligent vehicle based on quantum wolf cluster algorithm
CN111399522A (en) Substation inspection robot formation inspection formation keeping method based on behavior coordination
CN105045274B (en) A kind of intelligent shaft tower connected graph construction method for unmanned plane inspection trajectory planning
Zhao et al. Autonomous live working robot navigation with real‐time detection and motion planning system on distribution line
CN113189977A (en) Intelligent navigation path planning system and method for robot
Jian et al. High-definition map combined local motion planning and obstacle avoidance for autonomous driving
CN113741538A (en) Substation unmanned aerial vehicle inspection path planning method and system and storage medium
CN111176276A (en) Development and application of intelligent warehousing robot
CN112540625A (en) Unmanned aerial vehicle autonomous automatic power grid tower inspection system
Zhang et al. Design of intelligent fire-fighting robot based on multi-sensor fusion and experimental study on fire scene patrol
CN114932562B (en) Underground cable tunnel inspection robot based on laser radar and implementation method
CN117311369B (en) Multi-scene intelligent robot inspection method
CN116795108A (en) Intelligent unmanned vehicle distribution method based on multi-source sensing signals
CN113359739B (en) Intelligent movement device based on energy substitution technology and movement control method thereof
CN114115363B (en) Multi-unmanned aerial vehicle unknown indoor space exploration method based on dynamic target tracking
CN110614639A (en) ROS-based transformer substation inspection robot system and method thereof
Kang et al. Application of PID control and improved ant colony algorithm in path planning of substation inspection robot
Jiang et al. Application of power ubiquitous Internet of Things technology in intelligent inspection of unattended substation
Guan et al. Intelligent obstacle avoidance algorithm for mobile robots in uncertain environment
Ge et al. Research on full traversal path planning based on improved reciprocating algorithm
Han et al. Hybrid path planning algorithm for mobile robot based on a* algorithm fused with dwa
Liu et al. Research on motion path planning method of live working robot manipulator based on reverse splitting calculation
Tse et al. Design of a navigation system for a household mobile robot using neural networks

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20200710

RJ01 Rejection of invention patent application after publication