[go: up one dir, main page]

CN112678208B - Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics - Google Patents

Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics Download PDF

Info

Publication number
CN112678208B
CN112678208B CN202110078115.2A CN202110078115A CN112678208B CN 112678208 B CN112678208 B CN 112678208B CN 202110078115 A CN202110078115 A CN 202110078115A CN 112678208 B CN112678208 B CN 112678208B
Authority
CN
China
Prior art keywords
star
satellite
cluster
master
zone
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
Application number
CN202110078115.2A
Other languages
Chinese (zh)
Other versions
CN112678208A (en
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.)
Harbin Institute of Technology Shenzhen
Original Assignee
Harbin Institute of Technology Shenzhen
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 Harbin Institute of Technology Shenzhen filed Critical Harbin Institute of Technology Shenzhen
Priority to CN202110078115.2A priority Critical patent/CN112678208B/en
Publication of CN112678208A publication Critical patent/CN112678208A/en
Application granted granted Critical
Publication of CN112678208B publication Critical patent/CN112678208B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于包含动态规避和阻尼特性人工势场法的卫星集群控制方法,包括:以主星为中心,对其通信区域进行划分,在不同的区域采用不同的人工势场,从而维持卫星集群的构型稳定;根据卫星集群中成员的相对位置和相对速度,设计以每颗成员卫星为中心的包含动态规避的人工势场法控制器,保证集群中的成员卫星在任务期间不发生碰撞;针对空间任务需求增加,现有卫星个数不足以完成任务的情况,设计了包含阻尼特性的人工势场法控制器,能够有效的保证,新加入的卫星能安全可靠的加入当前集群,构成新的集群。该方法适用于空间摄动条件下卫星集群的构型维持,碰撞规避,以及集群重组。

Figure 202110078115

The invention discloses a satellite cluster control method based on an artificial potential field method including dynamic avoidance and damping characteristics. The configuration of the satellite cluster is stable; according to the relative positions and relative speeds of the members in the satellite cluster, an artificial potential field method controller with dynamic avoidance centered on each member satellite is designed to ensure that the member satellites in the cluster do not occur during the mission. Collision; for the situation that the demand for space missions increases and the number of existing satellites is insufficient to complete the mission, an artificial potential field method controller with damping characteristics is designed, which can effectively ensure that the newly added satellites can join the current cluster safely and reliably. form a new cluster. The method is suitable for configuration maintenance, collision avoidance, and swarm reorganization of satellite swarms under spatial perturbation conditions.

Figure 202110078115

Description

Satellite cluster control method based on artificial potential field method including dynamic evasion and damping characteristics
Technical Field
The invention relates to the technical field of satellite control, in particular to a satellite cluster control method based on an artificial potential field method including dynamic evasion and damping characteristics.
Background
With the continuous development of aerospace technology, a group consisting of a plurality of intelligent small satellites can completely realize complex functions of some traditional large satellites through networking flight by sharing information and tasks, although the small satellites are relatively simple in function, the cost and risk born by the large satellites can be greatly reduced, and the flexibility and robustness of the system are remarkably enhanced. The main challenges of satellite constellation arise from the dynamic coupling between the satellites and the environment, and the satellite constellation, when moving in space, will face environmental disturbances, such as J2 perturbation, air resistance, and solar pressure, which, if no active control is used, will cause the satellites to drift rapidly away from each other, eventually making it difficult to maintain the integrity of the constellation.
The artificial potential field method is a virtual force method proposed by Khatib, and is initially used for controlling a mobile robot, and the basic idea is that the motion of the robot in the surrounding environment is designed into an abstract motion in an artificial gravitational field, a target point generates attraction to the mobile robot, an obstacle generates repulsion to the mobile robot, and finally the motion of the mobile robot is controlled by solving the resultant force. The artificial potential field method can artificially set a motion forbidden zone, is simple in mathematical description and is very suitable for satellite cluster control with relatively low control requirements.
In the control process of the satellite cluster, not only is the integrity of the cluster maintained, but also collision avoidance among cluster members needs to be considered, and a collision avoidance strategy based on an artificial potential field method of relative positions simply cannot meet task requirements under certain special conditions. Meanwhile, when the task demand is increased, the number of the existing satellites is not enough to complete the task, a certain number of satellites are usually required to be supplemented to join the cluster, and in order to solve the problem, a satellite cluster control method based on an artificial potential field method including dynamic evasion and damping characteristics is necessary to be provided.
Disclosure of Invention
The present invention is directed to solving, at least to some extent, one of the technical problems in the related art.
Therefore, the invention aims to provide a satellite cluster control method based on an artificial potential field method containing dynamic avoidance and damping characteristics, and the method is used for collision avoidance cluster recombination.
In order to achieve the above purpose, an embodiment of the invention provides a satellite cluster control method based on an artificial potential field method including dynamic avoidance and damping characteristics, which includes the following steps: step S1, establishing an LVLH coordinate system by taking the main satellite as a center, and dividing the space around the main satellite into six areas by the communication distance of the main satellite; step S2, determining the positions and speeds of all the slave stars in the current master star communication area relative to the master star under the LVLH coordinate system; step S3, determining the overall communication topology of the satellite cluster including the master star and all the slave stars; step S4, determining the specific area of the slave star near the main star according to the position and the speed of the slave star relative to the main star, and executing a cluster maintenance control strategy based on an improved artificial potential field method with the main star as the center; step S5, obtaining the connection relation between the satellites according to the overall communication topology of the satellite cluster, and executing a satellite cluster anti-collision control strategy based on an artificial potential field method including dynamic avoidance in step S4; and step S6, determining the newly added satellite according to the step S5, and adopting a control strategy based on an artificial potential field method containing damping characteristics.
According to the satellite cluster control method based on the artificial potential field method including the dynamic evasion and damping characteristics, the communication area of the main satellite is divided by taking the main satellite as the center, and different artificial potential fields are adopted in different areas, so that the configuration stability of the satellite cluster is maintained; designing an artificial potential field method controller which takes each member satellite as a center and contains dynamic avoidance according to the relative position and relative speed of the members in the satellite cluster, and ensuring that the member satellites in the cluster do not collide during a task; aiming at the situation that the space task demand is increased and the number of the existing satellites is not enough to finish the task, the artificial potential field method controller with the damping characteristic is designed, so that the situation that the newly added satellites can be safely and reliably added into the current cluster to form a new cluster can be effectively guaranteed.
In addition, the satellite cluster control method based on the artificial potential field method including the dynamic avoidance and damping characteristics according to the above embodiment of the present invention may further have the following additional technical features:
further, in an embodiment of the present invention, the six regions are a no-fly region, a strong-repulsion region, a repulsion transition region, a free-flight region, an attraction transition region and a strong-attraction region, respectively, wherein a damping region is disposed in a region other than the no-fly region and the free-flight region, and the damping region covers the strong-repulsion region, the repulsion transition region, the attraction transition region and the strong-attraction region.
Further, in an embodiment of the present invention, the cluster maintenance control strategy in step S4 adopts a modified artificial potential field method with a repulsive force transition region and a gravitational force transition region, and the expression is:
Figure BDA0002908262460000021
Figure BDA0002908262460000022
Figure BDA0002908262460000023
Figure BDA0002908262460000024
where ρ isi=[xi,yi,zi]Is the position of the ith slave star relative to the master star under the LVLH coordinate system taking the master star as the center, ui1As a function of repulsive potential, ηi1For repulsion gain, d is the radius of the safe distance of the main satellite from the outer edge, r1Is the inner edge radius of the repulsive transition region, r2Is the outer edge radius of the repulsive transition region, ui2Is a gravitational potential function, etai2For gravitational gain, h is the radius of the outer edge of the free flight zone, a1Is the radius of the inner edge of the gravitational transition zone, a2Is the outer edge radius of the gravitational transition zone, Ki1、Ki2To control the gain.
Further, in an embodiment of the present invention, in step S5, an expression of the satellite cluster collision avoidance control policy based on the artificial potential field method including dynamic avoidance is as follows:
Figure BDA0002908262460000031
Figure BDA0002908262460000032
Figure BDA0002908262460000033
Figure BDA0002908262460000034
wherein u isi3For using manpowerRepulsion function, a, commonly used in potential field methodsijFor the element, eta, of the ith row and jth column of the topological adjacency matrix of the trunking communicationi3For gain of repulsion, ρi=[xi,yi,zi]Is the position of the ith slave star relative to the master star under the LVLH coordinate system taking the master star as the center, rhoj=[xj,yj,zj]Is the position vector of the jth slave star relative to the master star under the LVLH coordinate system taking the master star as the center, diIs the safe distance outer edge radius of the ith satellite, DiIs the acting radius of the artificial potential field of the ith satellitei4For using dynamic artificial potential field controllers based on relative velocity between satellites, Ki3、Ki4To control the gain, ηi4In order to gain the repulsive force,
Figure BDA0002908262460000035
is the velocity vector of the ith slave star relative to the master star under the LVLH coordinate system,
Figure BDA0002908262460000036
the velocity vector of the jth slave star relative to the master star in the LVLH coordinate system.
Further, in an embodiment of the present invention, the expression of step S6 is:
Figure BDA0002908262460000037
Figure BDA0002908262460000038
wherein u isi5As a damping controller, Ki5To control the gain, ηi5In order to be a damping coefficient of the damping,
Figure BDA0002908262460000039
is the velocity vector of the i-th slave star relative to the master star under the LVLH coordinate system, d is the safe distance outer edge radius of the master star, rhoi=[xi,yi,zi]Is centered on the main starThe position of the ith slave star relative to the master star in the LVLH coordinate system of (r)2Is the outer edge radius of the repulsive force transition region, h is the outer edge radius of the free flight region, a2The radius of the outer edge of the gravity transition area.
Additional aspects and advantages of the invention will be set forth in part in the description which follows and, in part, will be obvious from the description, or may be learned by practice of the invention.
Drawings
The foregoing and/or additional aspects and advantages of the present invention will become apparent and readily appreciated from the following description of the embodiments, taken in conjunction with the accompanying drawings of which:
FIG. 1 is a flow chart of a satellite cluster control method based on an artificial potential field method including dynamic avoidance and damping characteristics according to an embodiment of the invention;
FIG. 2 is a schematic diagram of division of a communication area of a main satellite;
FIG. 3 is a three-dimensional motion map of a satellite constellation;
FIG. 4 is a graph of the range of a slave satellite relative to a master satellite in a satellite constellation;
fig. 5 is a diagram of relative distances between satellites of a satellite cluster.
Detailed Description
Reference will now be made in detail to embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar function throughout. The embodiments described below with reference to the drawings are illustrative and intended to be illustrative of the invention and are not to be construed as limiting the invention.
The satellite cluster control method based on the artificial potential field method including dynamic avoidance and damping characteristics proposed according to the embodiment of the invention is described below with reference to the accompanying drawings.
Fig. 1 is a flowchart of a satellite cluster control method based on an artificial potential field method including dynamic avoidance and damping characteristics according to an embodiment of the present invention.
As shown in fig. 1, the method comprises the steps of:
in step S1, an LVLH coordinate system is established centering around the master satellite, and the space around the master satellite is divided into six regions with the communication distance of the master satellite.
Further, as shown in fig. 2, the six regions in step S1 are a no-fly region, a strong repulsion region, a repulsion transition region, a free flight region, an attraction transition region, and a strong attraction region, respectively, and a damping region is provided in a region other than the no-fly region and the free flight region, and covers the strong repulsion region, the repulsion transition region, the attraction transition region, and the strong attraction region.
In step S2, the position and velocity of all the slave stars in the communication area of the current master star relative to the master star in the LVLH coordinate system are determined.
For example, the positions and velocities of the master satellite and the slave satellites in the constellation under the inertial system can be obtained in real time through a GPS, and the positions and velocities of the slave satellites under the LVLH coordinate system centered on the master satellite are calculated in real time through coordinate transformation.
In step S3, the overall communication topology of the satellite cluster including the master star and all the slave stars is determined.
Specifically, in the cluster, the distance between any two satellites is regarded as the inter-satellite communication as long as the distance is within the communication range, and further, the overall communication topology of all satellites in the cluster can be obtained.
In step S4, a specific area of the slave star near the master star is determined according to the position and speed of the slave star relative to the master star, and a cluster maintenance control strategy based on the improved artificial potential field method centered on the master star is executed.
Specifically, the outer edge radius of the no-fly zone is determined by taking the actual safe distance of the main satellite as a basis, the radius of the strong-attraction zone is determined by taking the limit communication distance of the main satellite as a basis, and the rest zones can be flexibly divided according to the specific task requirements. In step S4, the satellite cluster maintenance control strategy adopts an improved artificial potential field method with a transition region to ensure that the slave star can operate within the safe distance and the communication distance of the master star, and the expression is as follows:
Figure BDA0002908262460000051
Figure BDA0002908262460000052
Figure BDA0002908262460000053
Figure BDA0002908262460000054
where ρ isi=[xi,yi,zi]Is the position of the ith slave star relative to the master star under the LVLH coordinate system taking the master star as the center, ui1As a function of repulsive potential, ηi1For repulsion gain, d is the radius of the safe distance of the main satellite from the outer edge, r1Is the inner edge radius of the repulsive transition region, r2Is the outer edge radius of the repulsive transition region, ui2Is a gravitational potential function, etai2For gravitational gain, h is the radius of the outer edge of the free flight zone, a1Is the radius of the inner edge of the gravitational transition zone, a2Is the outer edge radius of the gravitational transition zone, Ki1、Ki2To control the gain.
In step S5, a connection relationship between satellites is obtained according to the overall communication topology of the satellite cluster, and a satellite cluster collision avoidance control strategy based on an artificial potential field method including dynamic avoidance is executed based on step S4.
Specifically, in step S5, in order to avoid collision of satellites in the constellation, collision avoidance control of the satellite constellation based on an artificial potential field method including dynamic avoidance is adopted, and an expression is as follows:
Figure BDA0002908262460000055
Figure BDA0002908262460000056
Figure BDA0002908262460000057
Figure BDA0002908262460000058
wherein u isi3To use the repulsion function commonly used in the artificial potential field method, aijFor the element, eta, of the ith row and jth column of the topological adjacency matrix of the trunking communicationi3For gain of repulsion, ρi=[xi,yi,zi]Is the position of the ith slave star relative to the master star under the LVLH coordinate system taking the master star as the center, rhoj=[xj,yj,zj]Is the position vector of the jth slave star relative to the master star under the LVLH coordinate system taking the master star as the center, diIs the safe distance outer edge radius of the ith satellite, DiIs the acting radius of the artificial potential field of the ith satellitei4For using dynamic artificial potential field controllers based on relative velocity between satellites, Ki3、Ki4To control the gain, ηi4In order to gain the repulsive force,
Figure BDA0002908262460000061
is the velocity vector of the ith slave star relative to the master star under the LVLH coordinate system,
Figure BDA0002908262460000062
the velocity vector of the jth slave star relative to the master star in the LVLH coordinate system.
In step S6, the newly joined satellite is determined according to step S5, and a control strategy based on an artificial potential field method including damping characteristics is employed.
Specifically, in step S6, when the number of existing satellites is not enough to complete the task and multiple satellites need to fly into the cluster from the star level, a control strategy based on an artificial potential field method including damping characteristics is adopted, and the expression is as follows:
Figure BDA0002908262460000063
Figure BDA0002908262460000064
wherein u isi5As a damping controller, Ki5To control the gain, ηi5In order to be a damping coefficient of the damping,
Figure BDA0002908262460000065
is the velocity vector of the i-th slave star relative to the master star under the LVLH coordinate system, d is the safe distance outer edge radius of the master star, rhoi=[xi,yi,zi]Is the position of the ith slave star relative to the master star under the LVLH coordinate system taking the master star as the center, r2Is the outer edge radius of the repulsive force transition region, h is the outer edge radius of the free flight region, a2The radius of the outer edge of the gravity transition area.
The satellite cluster control method based on the artificial potential field method including dynamic avoidance and damping characteristics, which is provided by the invention, is further explained through numerical simulation.
In the simulation, a satellite cluster is assumed to contain 1 master star and 5 slave stars. Where 2 slave stars have an initial position within the communication range of the master star and 3 other slave stars fly outside to the master star plan join the cluster. By adopting a control strategy based on an artificial potential field method with damping characteristics, 3 slave satellites flying to the master satellite from the outside can not depart from the communication range of the master satellite after joining the cluster, and simultaneously, all satellites in the cluster can be ensured to fly in a collision-free manner within the communication range of the master satellite. As shown in fig. 3, in the LVLH coordinate system, for the three-dimensional motion diagram of the satellite cluster in space, as shown in fig. 4, the position and velocity of the slave satellite relative to the master satellite are determined, as shown in fig. 5, and the simulation parameters for the communication area division of the master satellite in S1 are set as follows: the safe distance between the main star and the outer edge radius D is 200m, and the action radius D of the artificial potential field of the ith satellitei500m, inner edge radius r of repulsive force transition region1500m, outer edge radius r of repulsive force transition region21000m, 1500m outside radius h of free flight area, and 1500m inside radius a of gravitational transition area12000m, outer edge radius of gravitational transition region a22300m, to obtainRelative distance between stars.
According to the satellite cluster control method based on the artificial potential field method including the dynamic evasion and damping characteristics, provided by the embodiment of the invention, the communication area of the satellite cluster is divided by taking a main satellite as a center, and different artificial potential fields are adopted in different areas, so that the configuration stability of the satellite cluster is maintained; designing an artificial potential field method controller which takes each member satellite as a center and contains dynamic avoidance according to the relative position and relative speed of the members in the satellite cluster, and ensuring that the member satellites in the cluster do not collide during a task; aiming at the situation that the space task demand is increased and the number of the existing satellites is not enough to finish the task, the artificial potential field method controller with the damping characteristic is designed, so that the situation that the newly added satellites can be safely and reliably added into the current cluster to form a new cluster can be effectively guaranteed. The method is suitable for configuration maintenance, collision avoidance and cluster recombination of the satellite cluster under the space perturbation condition.
Furthermore, the terms "first", "second" and "first" are used for descriptive purposes only and are not to be construed as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Thus, a feature defined as "first" or "second" may explicitly or implicitly include at least one such feature. In the description of the present invention, "a plurality" means at least two, e.g., two, three, etc., unless specifically limited otherwise.
In the description herein, references to the description of the term "one embodiment," "some embodiments," "an example," "a specific example," or "some examples," etc., mean that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the invention. In this specification, the schematic representations of the terms used above are not necessarily intended to refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples. Furthermore, various embodiments or examples and features of different embodiments or examples described in this specification can be combined and combined by one skilled in the art without contradiction.
Although embodiments of the present invention have been shown and described above, it is understood that the above embodiments are exemplary and should not be construed as limiting the present invention, and that variations, modifications, substitutions and alterations can be made to the above embodiments by those of ordinary skill in the art within the scope of the present invention.

Claims (1)

1.一种基于包含动态规避和阻尼特性人工势场法的卫星集群控制方法,其特征在于,包括以下步骤:1. a satellite cluster control method based on artificial potential field method comprising dynamic avoidance and damping characteristics, is characterized in that, comprises the following steps: 步骤S1,以主星为中心建立LVLH坐标系,以主星通信距离将主星周围空间划分成六个区域,其中,所述六个区域分别为禁飞区,强斥力区,斥力过渡区,自由飞行区,引力过渡区和强引力区,其中,在除所述禁飞区和所述自由飞行区以外的区域设置阻尼区,所述阻尼区覆盖于所述强斥力区、所述斥力过渡区、所述引力过渡区和所述强引力区;In step S1, the LVLH coordinate system is established with the main star as the center, and the space around the main star is divided into six regions based on the communication distance of the main star, wherein the six regions are respectively a no-fly zone, a strong repulsion zone, a repulsion transition zone, and a free flight zone. , the gravitational transition zone and the strong gravitational zone, wherein a damping zone is set in the area other than the no-fly zone and the free flight zone, and the damping zone covers the strong repulsion zone, the repulsion transition zone, all the the gravitational transition zone and the strong gravitational zone; 步骤S2,确定当前主星通信区域内所有从星在所述LVLH坐标系下,从星相对主星的位置和速度;Step S2, determine the position and speed of all the slave stars relative to the master star in the current master star communication area under the LVLH coordinate system; 步骤S3,确定包含主星和所有从星在内的卫星集群整体通信拓扑;Step S3, determining the overall communication topology of the satellite cluster including the master star and all slave stars; 步骤S4,根据所述从星相对主星的位置和速度,确定从星在主星附近的具体区域,并执行以主星为中心的基于改进人工势场法的集群保持控制策略,其中,所述集群保持控制策略采用具有斥力过渡区和引力过渡区的改进的人工势场法,表达式为:Step S4, according to the relative position and velocity of the slave star relative to the master star, determine the specific area of the slave star near the master star, and execute the cluster retention control strategy based on the improved artificial potential field method centered on the master star, wherein the cluster retention The control strategy adopts an improved artificial potential field method with a repulsive transition zone and a gravitational transition zone, and the expression is:
Figure FDA0003162597690000011
Figure FDA0003162597690000011
Figure FDA0003162597690000012
Figure FDA0003162597690000012
Figure FDA0003162597690000013
Figure FDA0003162597690000013
Figure FDA0003162597690000014
Figure FDA0003162597690000014
其中,ρi=[xi,yi,zi]为以主星为中心的LVLH坐标系下第i颗从星相对主星的位置,ui1为斥力势函数,ηi1为斥力增益,d为主星安全距离外缘半径,r1为斥力过渡区内缘半径,r2为斥力过渡区外缘半径,ui2为引力势函数,ηi2为引力增益,h为自由飞行区外缘半径,a1为引力过渡区内缘半径,a2为引力过渡区外缘半径,Ki1、Ki2为控制增益;Among them, ρ i =[x i , y i , z i ] is the position of the i-th secondary star relative to the primary star in the LVLH coordinate system centered on the primary star, u i1 is the repulsive potential function, η i1 is the repulsive force gain, and d is The outer edge radius of the main star safe distance, r 1 is the outer edge radius of the repulsion transition zone, r 2 is the outer edge radius of the repulsion transition zone, u i2 is the gravitational potential function, η i2 is the gravitational gain, h is the outer edge radius of the free flight zone, a 1 is the edge radius of the gravitational transition zone, a 2 is the outer edge radius of the gravitational transition zone, and K i1 and K i2 are the control gains; 步骤S5,根据所述卫星集群整体通信拓扑得到卫星间的连接关系,并基于所述步骤S4执行基于包含动态规避的人工势场法的卫星集群防碰撞控制策略,具体表达式为:Step S5, obtain the connection relationship between satellites according to the overall communication topology of the satellite cluster, and execute the satellite cluster anti-collision control strategy based on the artificial potential field method including dynamic avoidance based on the step S4, and the specific expression is:
Figure FDA0003162597690000021
Figure FDA0003162597690000021
Figure FDA0003162597690000022
Figure FDA0003162597690000022
Figure FDA0003162597690000023
Figure FDA0003162597690000023
Figure FDA0003162597690000024
Figure FDA0003162597690000024
其中,ui3为采用人工势场法中常用的斥力函数,aij为集群通信拓扑邻接矩阵第i行,第j列的元素,ηi3为斥力增益,ρi=[xi,yi,zi]为以主星为中心的LVLH坐标系下第i颗从星相对主星的位置,ρj=[xj,yj,zj]为以主星为中心的LVLH坐标系下第j颗从星相对主星的位置矢量,di为第i颗卫星安全距离外缘半径,Di为第i颗从星人工势场的作用半径,ui4为采用基于从星间相对速度的动态人工势场控制器,Ki3、Ki4为控制增益,ηi4为斥力增益,
Figure FDA0003162597690000025
为LVLH坐标系下第i颗从星相对主星的速度矢量,
Figure FDA0003162597690000026
为LVLH坐标系下第j颗从星相对主星的速度矢量;
Among them, u i3 is the repulsion function commonly used in the artificial potential field method, a ij is the element of the i-th row and the j-th column of the cluster communication topology adjacency matrix, η i3 is the repulsion gain, ρ i =[x i ,y i , z i ] is the position of the i-th slave star relative to the master star in the LVLH coordinate system centered on the master star, ρ j =[x j , y j , z j ] is the j-th slave star in the LVLH coordinate system centered on the master star The position vector of the star relative to the main star, d i is the radius of the outer edge of the safety distance of the i-th satellite, D i is the action radius of the artificial potential field of the i-th slave star, u i4 is the dynamic artificial potential field based on the relative velocity between the slave stars controller, K i3 and K i4 are control gains, η i4 is repulsion gain,
Figure FDA0003162597690000025
is the velocity vector of the i-th slave star relative to the master star in the LVLH coordinate system,
Figure FDA0003162597690000026
is the velocity vector of the jth slave star relative to the master star in the LVLH coordinate system;
步骤S6,根据所述步骤S5确定新加入集群的卫星,并采用基于包含阻尼特性的人工势场法的控制策略,具体表达式为:Step S6, according to the step S5, determine the satellite newly added to the cluster, and adopt the control strategy based on the artificial potential field method including damping characteristics, and the specific expression is:
Figure FDA0003162597690000027
Figure FDA0003162597690000027
Figure FDA0003162597690000028
Figure FDA0003162597690000028
其中,ui5为阻尼控制器,Ki5为控制增益,ηi5为阻尼系数,
Figure FDA0003162597690000029
为LVLH坐标系下第i颗从星相对主星的速度矢量,d为主星安全距离外缘半径,ρi=[xi,yi,zi]为以主星为中心的LVLH坐标系下第i颗从星相对主星的位置,r2为斥力过渡区外缘半径,h为自由飞行区外缘半径,a2为引力过渡区外缘半径。
Among them, u i5 is the damping controller, K i5 is the control gain, η i5 is the damping coefficient,
Figure FDA0003162597690000029
is the velocity vector of the i-th slave star relative to the master star in the LVLH coordinate system, d is the radius of the outer edge of the safety distance from the master star, ρ i =[x i , y i , z i ] is the i-th slave star in the LVLH coordinate system centered on the master star The position of the secondary star relative to the primary star, r 2 is the outer edge radius of the repulsion transition zone, h is the outer edge radius of the free flight zone, and a 2 is the outer edge radius of the gravitational transition zone.
CN202110078115.2A 2021-01-20 2021-01-20 Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics Active CN112678208B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110078115.2A CN112678208B (en) 2021-01-20 2021-01-20 Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110078115.2A CN112678208B (en) 2021-01-20 2021-01-20 Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics

Publications (2)

Publication Number Publication Date
CN112678208A CN112678208A (en) 2021-04-20
CN112678208B true CN112678208B (en) 2021-09-07

Family

ID=75458739

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110078115.2A Active CN112678208B (en) 2021-01-20 2021-01-20 Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics

Country Status (1)

Country Link
CN (1) CN112678208B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114779803B (en) * 2022-03-21 2025-06-20 南京航空航天大学 NSGA-III Intelligent Optimization Algorithm for InSAR Satellite Cluster Configuration
CN114933026B (en) * 2022-05-17 2025-05-30 西北工业大学 An autonomous obstacle avoidance control and topology optimization method for large-scale constellation transition

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009288930A (en) * 2008-05-28 2009-12-10 Murata Mach Ltd Autonomous traveling object and its traveling control method
CN104898691B (en) * 2015-04-29 2017-07-28 哈尔滨工业大学 Satellite Formation Flying finite time configuration includes control method
CN108459612B (en) * 2017-02-21 2021-03-23 北京航空航天大学 UAV formation control method and device based on artificial potential field method
CN108469828A (en) * 2018-03-23 2018-08-31 哈尔滨工程大学 A kind of AUV Route planners improving artificial potential field optimization algorithm
CN109121178A (en) * 2018-07-24 2019-01-01 西北工业大学 One kind carrying out energy heterogeneous star networking route designing method based on Artificial Potential Field
CN110531762A (en) * 2019-08-21 2019-12-03 东南大学 A kind of robot path planning method based on modified embedded-atom method

Also Published As

Publication number Publication date
CN112678208A (en) 2021-04-20

Similar Documents

Publication Publication Date Title
Hu et al. Convergent multiagent formation control with collision avoidance
CN108549407B (en) A Control Algorithm for Multi-UAV Cooperative Formation to Avoid Obstacles
CN109508035B (en) Multi-region hierarchical unmanned aerial vehicle formation path planning method based on distributed control
CN109460064B (en) UAV swarm area coverage method and device based on virtual potential field function
CN115033016B (en) Heterogeneous unmanned cluster formation obstacle avoidance method and system
CN110162086A (en) A kind of cluster unmanned plane formation method based on Model Predictive Control frame
CN110609552A (en) An underwater unmanned vehicle formation plane track planning method
CN110825113A (en) Formation keeping method suitable for quad-rotor unmanned aerial vehicle cluster flight
CN108681787A (en) Based on the unmanned plane method for optimizing route for improving the two-way random tree algorithm of Quick Extended
Frew et al. Cooperative stand-off tracking of moving targets by a team of autonomous aircraft
CN110703803A (en) Unmanned aerial vehicle group flight control method, unmanned aerial vehicle, system and medium
CN114138002A (en) Distributed multi-unmanned aerial vehicle formation cluster behavior dynamic obstacle avoidance control method
CN112678208B (en) Satellite swarm control method based on artificial potential field method with dynamic avoidance and damping characteristics
CN115047910A (en) Unmanned aerial vehicle formation cruise control method based on wild goose-shaped array
Lin et al. Cooperative formation and obstacle avoidance algorithm for multi-UAV system in 3D environment
CN113342030A (en) Multi-unmanned aerial vehicle cooperative self-organizing control method and system based on reinforcement learning
CN117170410B (en) Control methods and related products for UAV formation flight
CN114661066A (en) An Intelligent Obstacle Avoidance Method for UAV Swarms Based on Reinforcement Learning
CN114967732A (en) Method and device for formation and aggregation of unmanned aerial vehicles, computer equipment and storage medium
Kwon et al. Mathematical modeling for flocking flight of autonomous multi-UAV system, including environmental factors
CN115657725A (en) Primary-secondary unmanned aerial vehicle release decision and path planning integrated method and system
CN118672304B (en) Anti-collision method and system for fixed-wing cluster UAVs based on multi-element game
CN119088075B (en) Air-sea heterogeneous unmanned swarm collaborative formation control method based on sliding mode consistency
Jiang et al. Formation flight control and cooperative obstacle avoidance of multiple UAVs
Danielmeier et al. Modified constrained wavefront expansion path planning algorithm for tilt-wing uav

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