CN1851598A - Deep space detector big-angle flexible path autonomic generating method - Google Patents
Deep space detector big-angle flexible path autonomic generating method Download PDFInfo
- 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
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
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):
(7) find the solution the Y-axis pointing vector Rry (x of Rr by following formula
Ry, y
Ry, z
Ry):
(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:
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
iq
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:
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):
(7) find the solution the Y-axis pointing vector Rry (x of Rr by following formula
Ry, y
Ry, z
Ry):
(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:
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):
(7) find the solution the Y-axis pointing vector Rry (x of Rr by following formula
Ry, y
Ry, z
Ry):
(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.
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)
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)
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 |
-
2006
- 2006-06-02 CN CNB2006100101120A patent/CN100428100C/en not_active Expired - Fee Related
Cited By (11)
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 |