CN1851598A - Deep space detector big-angle flexible path autonomic generating method - Google Patents

Deep space detector big-angle flexible path autonomic generating method Download PDF

Info

Publication number
CN1851598A
CN1851598A CN 200610010112 CN200610010112A CN1851598A CN 1851598 A CN1851598 A CN 1851598A CN 200610010112 CN200610010112 CN 200610010112 CN 200610010112 A CN200610010112 A CN 200610010112A CN 1851598 A CN1851598 A CN 1851598A
Authority
CN
China
Prior art keywords
attitude
planning
random
angle
detector
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.)
Granted
Application number
CN 200610010112
Other languages
Chinese (zh)
Other versions
CN100428100C (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
Original Assignee
Harbin Institute of Technology
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 filed Critical Harbin Institute of Technology
Priority to CNB2006100101120A priority Critical patent/CN100428100C/en
Publication of CN1851598A publication Critical patent/CN1851598A/en
Application granted granted Critical
Publication of CN100428100C publication Critical patent/CN100428100C/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

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

Abstract

The present invented method contains through given decetor trajectory information to proceed environment judgement and automatically generating barrier, based these barrier through planning algorithm to generate stance mobile route, wherein said planning algorithm adopting submissive improved RRT algorithm, in stochastic tree expansion through single axle stochastic algorithm, simplifying three-dimension programming wide angle mobile planning problem into two-dimension planning problem, and leading-in illumine factor speeding-up convergence of algorithm, and utilizing forward search to proceed optimizing to programmed route. The present invention has strong interactivity, visual, and immediacy etc properties.

Description

Deep space detector big-angle flexible path autonomic generating method
Technical field
The present invention relates to a kind of realization deep space probe and independently generate the large angle maneuver route method.
Background technology
Survey of deep space is one of focus of 21 century world's aerospace big country concern, and China also proposes in " China Aerospace " white paper, will " carry out the research in advance based on the survey of deep space of moon exploration ".Because detection of a target distance, factor such as flight environment of vehicle is uncertain, there are the problem of aspects such as real-time and reliability in the control of deep space probe and operation.Application autonomous technology is an effective way that addresses these problems, it is by constructing software systems on detector, finish detector mission planning, the movable functions such as execution, fault diagnosis, fault recovery of decomposing, make the operation of detector, control form closed loop on the real star.Planning technology is to realize from one of gordian technique of main detector.
Detector is the main body in the survey of deep space task, and it enters space by earth transmission, implements moon exploration, planet and satellite sounding thereof and asteroid and comet and surveys.According to the difference of detection mission, detector portability lander or probe vehicles, and it is discharged into the celestial body surface carries out proximity detection.The detection of a target in the survey of deep space and the distance of the earth are very remote (now to have reached 7.2 * 10 9Km), and we are to the also very understanding of deep space environment, and the direct control in ground before only relying on or the mode of remote control are difficult to finish the detected event to solar system celestial body.This has been just for the survey of deep space task has proposed very harsh requirement, as the requirement of reliability, communication network and the real-time of operation cost, task etc.The way that solves is exactly to adopt programming dispatching technology in the artificial intelligence, mode identification technology, fault diagnosis technology etc., sets up the self-control system on the detector.The core that realizes the detector independence is the autonomous mission planning technology of detector, the activity that it will be carried out according to the mission requirements selection on ground, and give their Resources allocation and time, these movable in a single day execution just can reach the set goal.
Detector is the individuality of a complexity, autonomous mission planning be finished and the comings and goings of detector, constraint need be considered, and the complex properties of detector self, need very strong heuristic information.Just be based on this thought, proposing a kind of autonomous planner of simplifying based on the space of deep space large angle maneuver, under the prerequisite of the constraint of considering detector, carrying out the path planning and the optimization of detector attitude large angle maneuver.
In existing large angle slew planning technical scheme, formerly technology [1] is (referring to G.Singh, G.Macala, E.Wong, and R.Rasmussen.A Constraint Monitor Algorithm for the Cassini Spacecraft.InProceedings of the AIAA Guidance, Navigation, and Control Conference, 272-282, what the Cassini detector 1997) adopted is a kind of Passive Mode, promptly utilize the Constraints Management device, guarantee the feasibility of attitude maneuver instruction by real-time inspection.But this is a kind of passive judgement of part, can not consider planning from whole mobile process.
Formerly technology [2] is (referring to C.McInnes.Large Angle Slew Maneuver with AutonomousSun Vector Avoidance.AIAAJ.on Guidance, Control and Dynamics, 17 (4): 875-877,1994) pass through the method for definition potential-energy function in, the major defect of this method is to be absorbed in local minimum easily, and is difficult to the definition potential-energy function for challenge.
Formerly technology [3] is (referring to E.Frazzoli, M.A.Dahleh and E.Feron.A RandomizedAttitude Slew Planning Algorithm for Autonomous spacecraft.AIAA Guidance, Navigation and Control Conf., AIAA, join probability path profile method (PRM 2001-4155), Probabilistic RoadMap) and fast expand tree method (RRT, Rapidly-Exploring Random Trees), be used as a three-dimensional planning problem from the main detector large angle maneuver.In the expansion of RRT tree, stochastic variable is three angles of pitching, driftage, lift-over of detector attitude, and this method can be finished large angle slew planning, but because it still is a three-dimensional planning problem, the search volume of solution procedure is very big.
And formerly technology [2] and formerly in the technology [3] all is to finish path planning at obstacle, finish the autonomous large angle slew planning on the star, also needs to solve autonomous generation planning problem.
Summary of the invention
The technical problem to be solved in the present invention is the difficulty that overcomes above-mentioned prior art, a kind of method that can independently finish the detector large angle maneuver is provided, this implementation method is mainly: by given detector orbit information, environment is judged and automatic dyspoiesis, generate the path of attitude maneuver by planning algorithm based on these obstacles, here, the improved RRT algorithm that planning algorithm adopts us to propose, in the expansion of setting at random, pass through the single shaft random algorithm, make the large angle slew planning problem reduction that belongs to three-dimensional planning become a two-dimentional planning problem, and introduce and inspire the factor, accelerate convergence of algorithm.And the path that utilizes sweep forward that planning is come out is optimized.
Deep space detector big-angle flexible path autonomic generating method of the present invention carries out according to following steps:
One, obstacle independently generates: the initial parameter that needs: the detector load that (1) user provides is installed; (2) in the given moment and the current position of detector.(3) initial, the termination attitude of large angle maneuver.
1), according to the installation of detector load, determine dependent vector, restriction dependent vector R iAxis direction R with cone cAngle satisfy following condition: R iR c<cos α MinOr R iR c>cos α Max
2), according to given time, detector independently generates the earth-antenna barrier;
3), according to the detector current location, determine the sun-navigation camera barrier, the sun-star sensor barrier;
4), according to given time and detector current location, autonomous need to determine the large planetary considered, and determine corresponding star sensor-planet barrier, the imaging size of wherein current planet in star sensor satisfies following condition: L=R/D Sp-planet, R is the radius of planet, D Sp-planetDistance for detector and planet;
Two, large angle slew planning:
(1), utilize the RRT planning algorithm planning attitude path planning that single shaft expands at random, concrete grammar is as follows:
1), planning space:
Adopt Euler shaft angle or hypercomplex number to represent the attitude of detector;
2), Attitude Guidance rule:
For satisfying constraint condition, once complete large angle maneuver will be divided into repeatedly little large angle maneuver, defining motor-driven little state is node, the attitude angle speed of supposing node place detector is zero, and internodal attitude motion is fixedly Euler axle rotation, and then the rule of the Attitude Guidance between adjacent node is: q I+1=q i q Ei, wherein: q iBe the attitude quaternion of i node correspondence, q EiBe i node and i+1 internodal deviation hypercomplex number, corresponding two internodal fixedly Euler shaft angle rotations;
3), the probability of two dimension inspires the factor:
In the process that generates node at random, introduce and inspire the factor can accelerate convergence of algorithm, suppose that S, T are respectively the point of two on the plane, both mid points are C, then generate the desirable probability of some R at random to be:
Wherein: A is a constant, Dis (R, C) distance between expression R, the C;
4), single axis randomized expanding algorithm:
(1) generates two angle α, β at random, obtain its 1 corresponding on unit sphere Rrz (x Rz, y Rz, z Rz), make that Rrz is the Z axle pointing vector of detector body coordinate system during Euler shaft angle Rr at random;
(2) inspire the factor to determine whether this point is desirable according to the probability of two dimension, if desirable then continue next step, otherwise would return step (1);
(3) in existing Euler shaft angle, find out the Euler shaft angle Rn of Z axle pointing vector and Rrz angle minimum, angle is θ;
(4) if θ>0.2 radian returns step (1); If θ≤0.2 radian continues next step;
(5) the X-axis pointing vector of Rn is Rnx (x Nx, y Nx, z Nx), the Y-axis pointing vector of Rn is Rny (x Ny, y Ny, z Ny), if z Nx〉=z Ny, execution in step (6) then, otherwise execution in step (7);
(6) find the solution the X-axis pointing vector Rrx (x of Rr by following formula Rx, y Rx, z Rx):
z rx = z nx x rx · x rz + y rx · y rz + z rx · z rz = 0 x rx · x rx + y rx · y rx + z rx · z rx = 1 ;
(7) find the solution the Y-axis pointing vector Rry (x of Rr by following formula Ry, y Ry, z Ry):
z ry = z ny x ry · x rz + y ry · y rz + z ry · z rz = 0 x ry · x ry + y ry · y ry + z ry · z ry = 1 ;
(8) by Rrz (x Rz, y Rz, z Rz), Rrx (x Rx, y Rx, z Rx) or Rry (x Ry, y Ry, z Ry) can determine the Euler shaft angle that this generates at random;
(9) judge that whether the Euler shaft angle that generates satisfies constraint condition, if do not satisfy constraint condition, returns step (1);
5), utilize above-mentioned single axis randomized expanding algorithm, the RRT planning algorithm that is improved is as follows:
(1) reference attitude is added path list;
(2) judge whether last point in the path list can directly arrive the termination attitude, if can, finish, otherwise continue;
(3) utilize single axis randomized expanding algorithm to generate an attitude at random;
(4) in current path, find from the nearest attitude of attitude at random;
(5) judge attitude at random and recently the path between the attitude whether by the barrier, if, then return step (3), otherwise, set up both contact;
(6) random point is added the path list end, jump to step (2);
(2), utilize sweep forward to path optimization;
(3), finally generate feasible large angle slew planning path.
The ultimate principle of the method for the invention:
In detector large angle maneuver process, the detector attitude must satisfy the constraint of responsive instrument, maintenance communication link etc.And these constraints change, as concerning star sensor, if the imaging thereon of certain major planet is very little, then can not consider its influence, like this, we just need determine current obstacle according to current time and the residing position of detector, planet is all in motion in addition, so its obstacle also is different in the different moment, we judge according to its imaging size whether needs are considered for it, thus dyspoiesis that can be autonomous.
In mobile process, detector is regarded as a rigid body, then its attitude is in three-dimensional rotation.Its planning problem structure space is three-dimensional.The attitude of representing detector with Euler shaft angle or hypercomplex number.The attitude of detector has three stray parameters, and promptly this is a three-dimensional space motion planning problem, and the dimension exponentially of the search volume of planning problem and planning space increases.Then can reduce the dimension of planning problem for the search volume of reducing solution procedure.Based on this purpose, we adopt a kind of single shaft algorithm at random in each step search, this planning problem is simplified to the planning problem of a two-dimensional space, concrete way is to generate earlier two variablees at random, the pointing vector of an axle of its corresponding detector attitude, and the information that makes full use of point of proximity again obtains another information, thereby determines current attitude at random.Only need two stochastic variables in the algorithm, promptly planning space is a two dimension, has reduced the dimension in planning problem structure space, thus the search volume of reducing problem solving, and in the single shaft stochastic process, introduce and inspire the factor, accelerate convergence of algorithm.Use above-mentioned single shaft random algorithm and expand at random, up to finding feasible path, and utilize the mode of sweep forward that the path is optimized.
Like this, under the situation of given time and given position of detector, the current obstacle of generation that we just can be autonomous, and under the situation of these obstacles, carry out the large angle slew planning of detector, finally form a feasible path planning.
The present invention can be autonomous generation attitude maneuver obstacle, and independently carry out attitude maneuver planning and generate the large angle maneuver path, and have characteristics such as interactivity is strong, directly perceived, quick.Technology [1] formerly, first technology [2], the difference of first technology [3] be, novel part of the present invention be can be autonomous the current attitude obstacle of generation, and can be autonomous avoid the obstacle generation pass.Thereby realized on the star autonomous large angle maneuver, avoided traditional ground of passing through to plan, uploaded maneuvering command to detector then, or detector carries out on the passive detection ground whether feasible pattern of teletype command.Planner can be used as the part of the autonomous mission planning of deep space probe system, also can be used as the instrument of ground finder attitude large angle maneuver path planning, forms the maneuvering command that upload on ground.
Embodiment
Embodiment one: present embodiment realizes that according to following steps deep space probe independently generates the large angle maneuver path:
One, obstacle independently generates
To consider in the large angle maneuver that device, load etc. are to outside environmental limit, main external environment condition constraint can be divided into two classes---point to constraint and integral constraint, the a certain direction vector that points to the constraint requirements detector can not enter or leave a certain zone, if ignore the variation that retrains in the mobile process, the barrier zone of this class constraint is a cone, and we only need the relevant vector R of restriction iAxis direction R with cone cAngle just, can be expressed as:
R iR c<cos α MinOr R iR c>cos α Max
The constraint that becomes when integral constraint is a kind of, as the time that radiating surface is exposed under the sunshine can not be oversize,
Specifically determine by following formula:
&Integral; 0 t g ( &theta; , d ) d&tau; < H
Wherein: H is a normal value, i.e. the radiant quantity that can bear of detector maximum; (θ d) is the radiation intensity function to g, and is relevant with distance of angle, detector and the sun of exposure face and sunlight vector etc.
Intrafascicular approximately at these, pointing to constraint is a parameter of being correlated with the detector track, its object that may consider has Mercury, Venus, the earth, Mars, Jupiter, Saturn, but detector is understood some difference in different positions, promptly only need consider wherein a few sometimes, we decide by the imaging size of current planet in star sensor, for easy, we define simple imaging size and are L, formula specific as follows:
L=R/D sp-planet
Wherein: R is the radius (kilometer) of planet, D Sp-planetBe detector and its distance (astronomical unit).
When the L of certain planet greater than 1000 the time, just think that it is to need the obstacle considered.
Two, large angle slew planning
Above-mentioned autonomous dyspoiesis, next step work are exactly under the situation that these obstacles exist, and autonomous cook up a feasible motor-driven path.Based on to the planning space of planning problem, the description of constraint and the Guidance Law of motor-driven attitude, present embodiment is introduced improved RRT algorithm and is carried out large angle slew planning, to the improved concrete steps of RRT algorithm be: use the axle that the single shaft random algorithm generates the detector attitude, utilize the information of point of proximity to determine current attitude at random then.Wherein also introduced the inspiration factor in the single shaft random algorithm.
(1) planning space
From main detector large angle maneuver problem is a dynamics planning problem that contains dynamic constrained, and by simplifying, we can become a kinematics planning problem to problem, and it also is a PSPACE difficult problem.The dimension exponentially of the complexity of algorithm and problem increases.In mobile process, detector is regarded as a rigid body, then its attitude is in three-dimensional rotation, promptly the dimension in the structure space of this planning problem is 3.Here, we represent the attitude of detector with Euler shaft angle or hypercomplex number.
(2) Attitude Guidance rule
For satisfying constraint condition, once complete large angle maneuver is divided into repeatedly little large angle maneuver possibly, we claim that motor-driven little state is a node, simplification for problem, we suppose that the attitude angle speed of node place detector is zero, and internodal attitude motion is fixedly Euler axle rotation, and the rule of the Attitude Guidance between adjacent node is as can be known:
q i+1=q iq ei
Wherein: q iIt is the attitude quaternion of i node correspondence
q EiBe i node and i+1 internodal deviation hypercomplex number, corresponding two internodal fixedly Euler shaft angle rotations.
(3) the RRT planning algorithm expanded at random of single shaft
For attitude large angle slew planning problem, adopt three RRT methods, the expansion of tree each time needs three random quantitys, and we use single axis randomized expanding algorithm, and promptly each expansion only needs two stochastic variables.And single shaft adopts at random the time probability of two dimension to inspire the factor.
1, the probability of two dimension inspires the factor
In the process that generates node at random, introduce and inspire the factor can accelerate convergence of algorithm, here we with simple potential-energy function as inspiring the factor, be used to represent to accept this time the probability of the node of generation at random, suppose that S, T are respectively the point of two on the plane, both mid points are C, then generate the desirable probability of some R at random to be:
Figure A20061001011200101
Wherein: A is a constant, chooses according to obstacle, and the obstacle in the path is many more, and the A value is big more, generally gets 0.4; Dis (R, C) distance between expression R, the C;
2, single axis randomized expanding algorithm
In large angle slew planning, the structure space dimensionality of this moment is 3, and we use single shaft method at random and generate node, and then problem reduction is that a structure space dimensionality is 2, and concrete grammar is as follows:
(1) generates two angle α, β at random, obtain its 1 corresponding on unit sphere Rrz (x Rz, y Rz, z Rz), make that Rrz is the Z axle pointing vector of detector body coordinate system during Euler shaft angle Rr at random;
(2) inspire the factor to determine whether this point is desirable according to the probability of two dimension, if desirable then continue next step, otherwise would return step (1);
(3) in existing Euler shaft angle, find out the Euler shaft angle Rn of Z axle pointing vector and Rrz angle minimum, angle is θ;
(4) if θ>0.2 radian returns step (1); If θ≤0.2 radian continues next step;
(5) obtain the X-axis pointing vector Rnx (x of Rn Nx, y Nx, z Nx), the Y-axis pointing vector Rny (x of Rn Ny, y Ny, z Ny), if z Nx〉=z Ny, execution in step (6) then, otherwise execution in step (7);
(6) find the solution the X-axis pointing vector Rrx (x of Rr by following formula Rx, y Rx, z Rx):
z rx = z nx x rx &CenterDot; x rz + y rx &CenterDot; y rz + z rx &CenterDot; z rz = 0 x rx &CenterDot; x rx + y rx &CenterDot; y rx + z rx &CenterDot; z rx = 1 ;
(7) find the solution the Y-axis pointing vector Rry (x of Rr by following formula Ry, y Ry, z Ry):
z ry = z ny x ry &CenterDot; x rz + y ry &CenterDot; y rz + z ry &CenterDot; z rz = 0 x ry &CenterDot; x ry + y ry &CenterDot; y ry + z ry &CenterDot; z ry = 1 ;
(8) by Rrz (x Rz, y Rz, z Rz), Rrx (x Rx, y Rx, z Rx) or Rry (x Ry, y Ry, zry) can determine this time the Euler shaft angle of generation at random.
(9) judge that whether the Euler shaft angle that generates satisfies constraint condition, if not, returns step (1).
As can be seen, in algorithm at random the Euler shaft angle only an axle generate at random, utilize this information of closing on the Euler shaft angle again, can determine the current Euler shaft angle that generates at random, thereby reduce another search of Euler shaft angle at random.
Generate the node algorithm at random and guaranteed that the starting point in path and terminal point be not in the barrier, but it can not guarantee to have a few on the path all not in the barrier, therefore whether passed through barrier if also needing to detect the path, the method that we can adopt sampling to detect, only need to detect the sampling spot in the path, and the geometrical constraint of point detects the constraint expression formula that can utilize the front.
3, the RRT planning algorithm expanded at random of single shaft
Random algorithm above utilizing, the RRT planning algorithm that can be improved is as follows:
(1) reference attitude is added path list;
(2) judge whether last point in the path list can directly arrive the termination attitude, if can, finish, otherwise continue;
(3) utilize single axis randomized expanding algorithm to generate an attitude at random;
(4) in current path, find from the nearest attitude of attitude at random,
(5) judge attitude at random and recently the path between the attitude whether by the barrier, if, then return 3, otherwise, set up both contact;
(6) random point is added the path list end; Jump to 2;
H-RRT(N s,N t)
{
N Ini=N sR.add (N s); The ∥ initialization, starting point adds path sequence
while!Arrive(N ini,N t);
{
do{
N rand=RandNode();
N near=LeastD(N rand,R);
}while!AvoidRouter(N rand,N near);
R.add(N rand);
N Ini=N Rand∥ is last point of new route more
}
R.add(N t);
} 。
Wherein: Arrive (N Ini, N t) be used for judging from N IniWhether can directly arrive N tRandNode () generates a node according to single axis randomized expanding algorithm.LeastD (N Rand, R), find in the existing node set from N RandNearest node, AvoidRouter (N Rand, N Near) detection N Rand, N NearBetween the path whether in the barrier.
Need to use two range informations between state in the algorithm, and in the on-plane surface planning process, there is not distance intuitively, therefore need represent distance by defining a variable, be referred to as pseudo-distance, people such as Frazzoli are by finding the solution optimal control problem, thereby utilize cost function as pseudo-distance.Here be used as pseudo-distance by the time kept in reserve between two Euler shaft angles, and the time kept in reserve method of estimation can go up the method that adopts with reference to Clementine.
(4) path optimization and integral constraint
Often need to optimize by generating the path that tree constitutes at random, could form the path of optimum or suboptimum, the criterion of optimization is that the whole time kept in reserve is the shortest.
Path optimization adopts the method for sweep forward, and as follows: with the starting point is initial point, and its node farthest that can directly arrive is found in search successively, and condition is that path detection can be satisfied in the path that directly arrives between them.Deletion intermediate node, connection source and solstics.Be starting point with the solstics then, carry out same operation.So repeated searching is the previous point of path termination up to starting point.Like this, connect all selected starting points successively, add that path termination constitutes final optimization path, specific as follows:
Optimal(R)
{
The node number of for i=0 → size (R)-2 ∥ size (R) initial path R;
{ tag=i+1; The numbering tag of the next tie point of // initialization;
for?j=size(R)-1→i+1
{ ∥ searches for successively
If?AvoidRouter(R[i],R[j]);{tag=j;L_Node=R[j];}
}
Result_R.add (L_Node); The node that // adding connects;
i=tag;
}
}
Integral constraint is to detect after the path generates, if do not satisfy then needs are planned again, the path is divided into discrete section by node here, and then integral constraint becomes following formula:
&Sigma; i = 0 n - 2 ( g ( i ) + g ( i + 1 ) ) &Delta;t / 2 &le; H
Wherein: Δ t is from the motor-driven time of ordering to i+1 of i point; N is counting of being separated into of path, comprises starting point and terminal point.

Claims (1)

1, deep space detector big-angle flexible path autonomic generating method is characterized in that described method carries out according to following steps:
One, obstacle independently generates:
1), according to the installation of detector load, determine dependent vector, restriction dependent vector R iSatisfy following condition: R with the angle of the axis direction Rc of cone iR c<cos α MinOr R iR c>cos α Max
2), according to given time, detector independently generates the earth-antenna barrier;
3), according to the detector current location, determine the sun-navigation camera barrier, the sun-star sensor barrier;
4), according to given time and detector current location, autonomous need to determine the large planetary considered, and determine corresponding star sensor-planet barrier, the imaging size of wherein current planet in star sensor satisfies following condition: L=R/D Sp-planet, R is the radius of planet, D Sp-planetDistance for detector and planet;
Two, large angle slew planning:
(1), utilize the RRT planning algorithm planning attitude path planning that single shaft expands at random, concrete grammar is as follows:
1), planning space:
Adopt Euler shaft angle or hypercomplex number to represent the attitude of detector;
2), Attitude Guidance rule:
For satisfying constraint condition, once complete large angle maneuver will be divided into repeatedly little large angle maneuver, defining motor-driven little state is node, the attitude angle speed of supposing node place detector is zero, and internodal attitude motion is fixedly Euler axle rotation, and then the rule of the Attitude Guidance between adjacent node is: q I+1=q i q Ei, wherein: q iBe the attitude quaternion of i node correspondence, q EiBe i node and i+1 internodal deviation hypercomplex number, corresponding two internodal fixedly Euler shaft angle rotations;
3), the probability of two dimension inspires the factor:
In the process that generates node at random, introduce and inspire the factor can accelerate convergence of algorithm, suppose that S, T are respectively the point of two on the plane, both mid points are C, then generate the desirable probability of some R at random to be:
Wherein: A is a constant, Dis (R, C) distance between expression R, the C;
4), single axis randomized expanding algorithm:
(1) generates two angle α, β at random, obtain its 1 corresponding on unit sphere Rrz (x Rz, y Rz, z Rz), make that Rrz is the Z axle pointing vector of detector body coordinate system during Euler shaft angle Rr at random;
(2) inspire the factor to determine whether this point is desirable according to the probability of two dimension, if desirable then continue next step, otherwise would return step (1);
(3) in existing Euler shaft angle, find out the Euler shaft angle Rn of Z axle pointing vector and Rrz angle minimum, angle is θ;
(4) if θ>0.2 radian returns step (1); If θ≤0.2 radian continues next step;
(5) the X-axis pointing vector of Rn is Rnx (x Nx, y Nx, z Nx), the Y-axis pointing vector of Rn is Rny (x Ny, y Ny, z Ny), if z Nx〉=z Ny, execution in step (6) then, otherwise execution in step (7);
(6) find the solution the X-axis pointing vector Rrx (x of Rr by following formula Rx, y Rx, z Rx):
z rx = z nx x rx &CenterDot; x rz + y rx &CenterDot; y rz + z rx &CenterDot; z rz = 0 x rx &CenterDot; x rx + y rx &CenterDot; y rx + z rx &CenterDot; z rx = 1 ;
(7) find the solution the Y-axis pointing vector Rry (x of Rr by following formula Ry, y Ry, z Ry):
z ry = z ny x ry &CenterDot; x rz + y ry &CenterDot; y rz + z ry &CenterDot; z rz = 0 x ry &CenterDot; x ry + y ry &CenterDot; y ry + z ry &CenterDot; z ry = 1 ;
(8) by Rrz (x Rz, y Rz, z Rz), Rrx (x Rx, y Rx, z Rx) or Rry (x Ry, y Ry, z Ry) can determine the Euler shaft angle that this generates at random;
(9) judge that whether the Euler shaft angle that generates satisfies constraint condition, if do not satisfy constraint condition, returns step (1);
5), utilize above-mentioned single axis randomized expanding algorithm, the RRT planning algorithm that is improved is as follows:
(1) reference attitude is added path list;
(2) judge whether last point in the path list can directly arrive the termination attitude, if can, finish, otherwise continue;
(3) utilize single axis randomized expanding algorithm to generate an attitude at random;
(4) in current path, find from the nearest attitude of attitude at random;
(5) judge attitude at random and recently the path between the attitude whether by the barrier, if, then return step (3), otherwise, set up both contact;
(6) random point is added the path list end, jump to step (2);
(2), utilize sweep forward to path optimization;
(3), finally generate feasible large angle slew planning path.
CNB2006100101120A 2006-06-02 2006-06-02 Deep space detector big-angle flexible path autonomic generating method Expired - Fee Related CN100428100C (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2006100101120A CN100428100C (en) 2006-06-02 2006-06-02 Deep space detector big-angle flexible path autonomic generating method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2006100101120A CN100428100C (en) 2006-06-02 2006-06-02 Deep space detector big-angle flexible path autonomic generating method

Publications (2)

Publication Number Publication Date
CN1851598A true CN1851598A (en) 2006-10-25
CN100428100C CN100428100C (en) 2008-10-22

Family

ID=37133078

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2006100101120A Expired - Fee Related CN100428100C (en) 2006-06-02 2006-06-02 Deep space detector big-angle flexible path autonomic generating method

Country Status (1)

Country Link
CN (1) CN100428100C (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101173858B (en) * 2007-07-03 2010-06-02 北京控制工程研究所 Three-dimensional posture fixing and local locating method for lunar surface inspection prober
CN102929286A (en) * 2012-11-26 2013-02-13 北京理工大学 Rapid planning method for surface global path of planet
CN103678828A (en) * 2013-12-31 2014-03-26 北京理工大学 Automatic layout method and device of flexible cables
CN104590589A (en) * 2014-12-22 2015-05-06 哈尔滨工业大学 Mars probe landing guidance method based on fuel minimization
CN105717940A (en) * 2016-01-26 2016-06-29 中国空间技术研究院 Autonomous task planning method of relay satellite
CN105867395A (en) * 2015-12-28 2016-08-17 北京理工大学 Method for planning attitude maneuvering in presence of constraints of deep space probe based on sliding film control
CN106950975A (en) * 2017-01-24 2017-07-14 上海卫星工程研究所 Large angle maneuver high-resolution microwave remote sensing satellite overall control method

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4962453A (en) * 1989-02-07 1990-10-09 Transitions Research Corporation Autonomous vehicle for working on a surface and method of controlling same
GB0125728D0 (en) * 2001-10-26 2001-12-19 Astrium Ltd Autonomous active manoeuvring method and system for spinning spacecraft

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101173858B (en) * 2007-07-03 2010-06-02 北京控制工程研究所 Three-dimensional posture fixing and local locating method for lunar surface inspection prober
CN102929286A (en) * 2012-11-26 2013-02-13 北京理工大学 Rapid planning method for surface global path of planet
CN102929286B (en) * 2012-11-26 2015-05-27 北京理工大学 Rapid planning method for surface global path of planet
CN103678828A (en) * 2013-12-31 2014-03-26 北京理工大学 Automatic layout method and device of flexible cables
CN104590589A (en) * 2014-12-22 2015-05-06 哈尔滨工业大学 Mars probe landing guidance method based on fuel minimization
CN105867395A (en) * 2015-12-28 2016-08-17 北京理工大学 Method for planning attitude maneuvering in presence of constraints of deep space probe based on sliding film control
CN105867395B (en) * 2015-12-28 2018-08-28 北京理工大学 A kind of deep space probe constraint attitude maneuver planing method based on sliding formwork control
CN105717940A (en) * 2016-01-26 2016-06-29 中国空间技术研究院 Autonomous task planning method of relay satellite
CN105717940B (en) * 2016-01-26 2019-02-15 中国空间技术研究院 The autonomous mission planning method of repeater satellite
CN106950975A (en) * 2017-01-24 2017-07-14 上海卫星工程研究所 Large angle maneuver high-resolution microwave remote sensing satellite overall control method
CN106950975B (en) * 2017-01-24 2019-05-31 上海卫星工程研究所 Large angle maneuver high-resolution microwave remote sensing satellite overall control method

Also Published As

Publication number Publication date
CN100428100C (en) 2008-10-22

Similar Documents

Publication Publication Date Title
CN1851598A (en) Deep space detector big-angle flexible path autonomic generating method
US9823655B2 (en) Unmanned vehicles, systems, apparatus and methods for controlling unmanned vehicles
WO2022261676A1 (en) Systems and methods for drone swarm wireless communication
Vempati et al. Paintcopter: An autonomous uav for spray painting on three-dimensional surfaces
WO2022001120A1 (en) Multi-agent system and control method therefor
Alvissalim et al. Swarm quadrotor robots for telecommunication network coverage area expansion in disaster area
Scherer et al. Resilient and modular subterranean exploration with a team of roving and flying robots
WO2019041874A1 (en) Aerial vehicle control method and device
CN1851408A (en) Interstellar cruising self-nevigation method based on multi-star road sign
CN105301203B (en) A kind of odor source localization method based on fireworks algorithm
CN106338289A (en) Robot-based indoor positioning and navigation system and method
CN1876501A (en) Three axis directional controlling method for stabilizing posture in deep space based on behavior mode
CN110450991B (en) Method for capturing spatial non-cooperative target by micro-nano satellite cluster
US20220212789A1 (en) Method Of Flight Plan Optimization Of A High Altitude Long Endurance Aircraft
Wolf et al. Toward improved landing precision on Mars
Falco Autonomy's Hierarchy of Needs: Smart City Ecosystems for Autonomous Space Habitats
Straub Integrating model-based transmission reduction into a multi-tier architecture
CN1923622A (en) Real-time prediction method for satellite flight parameter
CN1939807A (en) Star sensor online aligning method based on weng model
Everett et al. Toward a warfighter’s associate: Eliminating the operator control unit
CN110216688A (en) Part service robot and its control method are sent in a kind of Office Area
CN114543814A (en) Robot autonomous positioning and navigation method applied to three-dimensional environment
Strahan et al. Terrain hazard detection and avoidance during the descent and landing phase of the altair mission
Cho et al. Development of JAUS-compliant controller using Python
CN112960145A (en) Trajectory planning method and system for remote sensing satellite ground attitude maneuver scanning

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C17 Cessation of patent right
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20081022

Termination date: 20110602