CN105487546A - 一种深空探测器自主任务规划时间约束几何处理方法 - Google Patents
一种深空探测器自主任务规划时间约束几何处理方法 Download PDFInfo
- Publication number
- CN105487546A CN105487546A CN201510883280.XA CN201510883280A CN105487546A CN 105487546 A CN105487546 A CN 105487546A CN 201510883280 A CN201510883280 A CN 201510883280A CN 105487546 A CN105487546 A CN 105487546A
- Authority
- CN
- China
- Prior art keywords
- codomain
- time
- activity
- detector
- constraint
- 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
- 239000000523 sample Substances 0.000 title claims abstract description 32
- 238000003672 processing method Methods 0.000 title abstract description 4
- 238000000034 method Methods 0.000 claims abstract description 66
- 238000012545 processing Methods 0.000 claims abstract description 20
- 230000000694 effects Effects 0.000 claims description 107
- 239000011800 void material Substances 0.000 claims description 9
- 238000009795 derivation Methods 0.000 claims description 3
- 230000007547 defect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明涉及一种深空探测器自主任务规划时间约束几何处理方法,属于深空探测技术领域。本发明设计了一种验证时间约束一致性(活动变量值域能够满足所有约束)和约束几何处理方法,能够快速验证深空探测器规划过程中时间约束的一致性并处理时间约束,得到活动变量最终值域,弥补采用时间约束网处理大量活动变量时计算时间长的缺点。与基于时间约束网的时间处理方法相比较,解决同样的时间约束问题,计算时间短、效率高,更加适合实时性要求高的深空探测器。
Description
技术领域
本发明涉及一种深空探测器自主任务规划时间约束几何处理方法,属于深空探测技术领域。
背景技术
在深空环境下,深空探测器与目标距离远、飞行时间长、所处环境动态多变,传统地面站-航天器这样的控制方法已经无法满足操作费用、实时性、通讯网络等各项要求。为达到较高的实时性要求,在探测器中应用自主技术成为重要途径。而自主任务规划技术是自主技术的关键技术之一。
在深空探测领域中,采用自主任务规划,需要对时间进行表示、并对时间约束进行处理。目前,时间约束网方法是探测器自主任务规划中采用的时间表示和处理方法,并已经应用到了探索太空的项目中,如深空一号中自治远程代理系统、美国规划、调度和约束推理平台EUROPA等。时间约束网方法的一个缺点是如果改变其中一个点的约束或者新加入变量点,就要对所有点的值进行计算,若在规划过程中引入一个活动,就会引入2个变量点,2*(n+1)个约束弧(n为原来的变量点),导致计算量急剧增加,不适合快速处理时间约束。
由于时间在二维情况下能够明确表示出时间的开始点、结束点和持续时间,因此提出利用二维坐标系对时间进行表示并用几何方法处理时间约束。该方法首先由Rit提出,后来Pujari、Kumari和Sattar进一步讨论了一下,其他只是简单进行了介绍,而最近Ullberg使用了该方法表示少量的定量约束解决环境识别问题中的区间推理问题。上述研究中虽然做了一定研究,但是没有详细给出利用二维坐标系表示时间和处理时间约束的方法。
发明内容
本发明的目的是针对目前深空探测器自主任务规划中时间约束处理问题,为了克服时间约束网计算量大且计算时间长的缺点,提出一种深空探测器自主任务规划时间约束几何处理方法,是一种验证时间约束一致性(活动变量值域能够满足所有约束)和约束几何处理方法,在任务规划活动变量众多的情况下,快速实现时间约束处理,从而满足探测器实时性要求。
本发明通过设计时间约束几何处理方法实现,具体实现步骤如下:
步骤1,建立深空探测器时间规划问题模型。
深空探测器时间规划问题由探测器系统状态集合、探测器可执行活动变量集合、活动间的约束集合、探测器初始状态以及目标状态组成,即V={v1,v2,...,vm}。
其中,V={v1,v2,...,vm}为状态变量集合,且v∈Dv,Dv为探测器能达到的状态值域,m为状态变量的数量;O={o1,o2,...,on}为探测器可执行的活动变量集合,n为活动变量的数量,任意一个探测器活动ox具有开始点sx、结束点ex、持续时间dx,即ox={sx,ex,dx};C为探测器活动间的约束集合,此处约束为两个活动间的时间约束,即C(ox,oy)="oxConsoy",ox与oy为活动间约束对,Cons为活动间约束关系;so为探测器初始状态,即当时间为0(相对零点)时,探测器状态变量都对应相应的值;g为目标状态,即探测器各个变量需要达到的值。
步骤2,对步骤1中探测器活动变量及活动间的时间约束进行表示。
在处理时间约束之前,需要对探测器活动变量及时间约束进行表示。
1.对探测器活动变量及活动自身约束进行表示。
设探测器活动变量集合O={o1,o2,...,on}中任意一个探测器活动ox,且ox={sx,ex,dx}。将活动变量ox在二维坐标系下进行表示:横坐标x为开始点,纵坐标y为结束点,y=x+dx与纵坐标交点的值为持续时间。
对于探测器活动变量ox={sx,ex,dx},自身约束为sx∈[s1x,s2x]、ex∈[e1x,e2x]和dx∈[d1x,d2x]。其中,s1x,s2x为活动ox开始点值域的下界和上界;e1x,e2x为活动ox结束点值域的下界和上界;d1x,d2x为活动ox持续时间值域的下界和上界。如果有相对零点,则s1x≥s2x≥0;s1x=s2x时,表示开始点的值域只有一个时刻;同理e1x≥e2x≥0,d1x≥d2x≥0。
2.对深空探测器活动间约束进行表示。
设探测器两个活动变量ox={sx,ex,dx}和oy={sy,ey,dy}。活动间约束包括ox开始点对oy开始点的约束[ss1,ss2],ss1,ss2为约束值域的下界和上界;ox开始点对oy结束点的约束[se1,se2],se1,se2为约束值域的下界和上界;ox结束点对oy开始点的约束[es1,es2],es1,es2为约束值域的下界和上界;ox结束点点对oy结束点的约束[ee1,ee2],ee1,ee2为约束值域的下界和上界。(ss1,ss2,se1,se2,es1,es2,ee1,ee2为任意实数)。
步骤3,根据探测器活动变量自身约束,对所有探测器活动变量值域进行自我削减。
自我削减方法为:活动变量ox={sx,ex,dx}初始值域为sx∈[s1x,s2x]、ex∈[e1x,e2x]和dx∈[d1x,d2x]。利用几何表示方法,二维坐标系下开始点值域范围界限为x=s1x与x=s2x,结束点值域范围界限为y=e1x与y=e2x,持续时间值域范围界限为y=x+d1x与y=x+d2x。六条直线相交于12个交点。从12个交点中挑选满足条件的交点:x∈[e1x,e2x],y∈[e1x,e2x],y∈[x+d1x,x+d2x]。剩余n个点(n≤12),其中任意一点表示为(xn,yn)。
经自我削减后,探测器活动变量ox值域为sx∈[s1'x,s2'x]、ex∈[e1'x,e2'x]和dx∈[d1'x,d2'x],其中,s1'x=min(xn),s2'x=max(xn),e1'x=min(yn),e2'x=max(yn),d1'x=min(yn-xn),d2'x=max(yn-xn)。其中min表示最小值,max表示最大值。
步骤4,从深空探测器活动间约束对中任意选择一对C(ox,oy)="oxConsoy"根据ox值域和约束关系Cons推导oy的值域。分别推导oy的开始点值域、结束点值域和持续时间值域。
步骤4.1,对于oy的开始点值域[s1y,s2y],ox和约束[ss1,ss2]、[es1,es2]对[s1y,s2y]有影响。在坐标系中,为了两个约束同时满足,oy的开始点可行区域
Availablex=[s1x+ss1,s2x+ss2]∩[e1x+es1,e2x+es2](1)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行步骤4.2。
步骤4.2,对于oy的结束点值域[e1y,e2y],ox和约束[se1,se2]和[ee1,ee2]对其有影响。在坐标系中,为了两个约束同时满足,oy的结束点可行区域为
Availabley=[s1x+se1,s2x+se2]∩[e1x+ee1,e2x+ee2](2)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行步骤4.3。
步骤4.3,对oy的持续时间值域,由式(3)获得。
Availabled=d1∩d2∩d3∩d4(3)
其中,d1=[se1-ss2,se2-ss1],d2=[ee1-es2,ee2-es1],d3=[d31,d32],d4=[d41,d42];且
d31=min(d1x-ss1+ee1,d1x-ss1+ee2,d1x-ss2+ee1,d1x-ss2+ee2),
d32=max(d2x-ss1+ee1,d2x-ss1+ee2,d2x-ss2+ee1,d2x-ss2+ee2),
d41=min(-d1x-es1+se1,-d1x-es1+se2,-d1x-es2+se1,-d1x-es2+se2),
d42=max(-d2x-es1+se1,-d2x-es1+se2,-d2x-es2+se1,-d2x-es2+se2)。
min表示几个值中的最小值,max表示几个值中的最大值。
根据式(1)-(3),得oy最后可行值域
Available=Availablex∩Availabley∩Availabled(4)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行步骤5。
步骤5,步骤4中求出的oy可行值域Available与oy原值域sy∈[s1y,s2y],ey∈[e1y,e2y]和dy∈[d1y,d2y]进行几何相交。探测器活动oy开始点新值域为Intersectionx=Availablex∩[s1y,s2y],探测器活动oy结束点新值域为Intersectiony=Availabley∩[e1y,e2y],探测器活动oy持续时间新值域为Intersectiond=Availabled∩[d1y,d2y]。最终求得oy新值域Intersection=Intersectionx∩Intersectiony∩Intersectiond。如果交集为空,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行步骤6。
步骤6,比较oy新值域Intersection与原值域是否相同,若不同,则将与oy相关的约束对再次加入到约束对集合C中。同时,将约束对C(ox,oy)="oxConsoy"从约束对集合C中删除。如果相同,则将约束对C(ox,oy)="oxConsoy"从约束对集合C中删除即可。
步骤7,重复步骤4,、步骤5和步骤6,直到约束对集合C为空。如果步骤中4与步骤5中没有返回“时间约束不一致”结论,则表示深空探测器所有活动变量满足约束关系,时间约束一致,所有活动变量得到新值域;如果步骤4与步骤5中返回“时间约束不一致”结论,则表示深空探测器活动变量无法满足所有约束关系,所有活动变量无法得到新值域,时间规划结束。
有益效果
本发明设计了一种验证时间约束一致性(活动变量值域能够满足所有约束)和约束几何处理方法,能够快速验证深空探测器规划过程中时间约束的一致性并处理时间约束,得到活动变量最终值域,弥补采用时间约束网处理大量活动变量时计算时间长的缺点。与基于时间约束网的时间处理方法相比较,解决同样的时间约束问题,计算时间短、效率高,更加适合实时性要求高的深空探测器。
附图说明
图1为本发明方法中活动变量在二维坐标系下的表示方法;
图2为具体实施方式中四种活动间约束在二维坐标系下的表示方法,其中(a)为步骤4.1中根据ox和约束[ss1,ss2]求oy开始点值域的方法图示,(b)为步骤4.1中根据ox和约束[es1,es2]求oy开始点值域的方法图示,(c)为步骤4.2中根据ox和约束[se1,se2]求oy结束点值域的方法图示,(d)为步骤4.2中根据ox和约束[ee1,ee2]求oy结束点值域的方法图示;
图3为具体实施方式中活动oy新值域求解方法;
图4为具体实施方式中时间约束几何处理方法与时间约束网方法解决相同时间约束问题的时间比较图。
具体实施方式
本发明的目的是针对目前深空探测器自主任务规划中时间约束处理问题,提出一种验证时间约束一致性(活动变量值域能够满足所有约束)和约束几何处理方法,是一种在任务规划活动变量众多的情况下,快速实现时间约束处理,从而满足探测器实时性要求的方法。
本发明通过设计时间约束几何处理方法实现,具体实现步骤如下:
步骤1,建立深空探测器时间规划问题模型。
针对深空探测中的火星探测器建立模型,由探测器系统状态集合、探测器可执行活动变量集合、活动之间约束集合、初始状态以及目标状态组成,即V={v1,v2,...,vm}。
其中,V={v1,v2,...,vm}为状态变量集合,且v∈Dv,Dv为火星探测器可达到的状态值域,m=28为状态变量的数量,该模型中具有28个状态变量,如探测器姿态系统可处于的状态有定向、转动等;O={o1,o2,...,on}为探测器可执行活动变量集合,n=288为活动变量的数量,即在规划过程中需要处理288个探测器的活动,任意一个探测器活动ox具有开始点sx、结束点ex、持续时间dx,即ox={sx,ex,dx};C为探测器活动间的约束集合,此处约束为两个活动间的时间约束,即C(ox,oy)="oxConsoy",ox与oy为活动间约束对,Cons为活动间约束关系,该模型中处理13种约束关系,如表1所示;so为探测器初始状态,即当时间为0(相对零点)时,探测器状态变量都对应相应的值;g为目标状态,即探测器各个变量需要达到的值。
表1火星探测器活动间约束关系
步骤2,对步骤1中探测器活动变量及活动间的时间约束进行表示。
在处理时间约束之前,需要对探测器活动变量及时间约束进行表示。
1.对探测器活动变量及活动自身约束进行表示。
假设探测器活动变量集合O={o1,o2,...,on}中任意一个探测器活动ox,且ox={sx,ex,dx}。sx为活动ox的开始点,ex为活动ox的结束点,dx为活动ox的持续时间。将活动变量ox在二维坐标系下进行表示:横坐标为开始点,纵坐标为结束点,y=x+d与纵坐标交点的值为持续时间。
对于探测器活动变量ox={sx,ex,dx},自身约束为sx∈[s1x,s2x]、ex∈[e1x,e2x]和dx∈[d1x,d2x]。其中,s1x,s2x为活动ox开始点值域的下界和上界;e1x,e2x为活动ox结束点值域的下界和上界;d1x,d2x为活动ox持续时间值域的下界和上界。如果有相对零点,则s1x≥s2x≥0,s1x=s2x时,表示开始点的值域只有一个时刻;同理e1x≥e2x≥0,d1x≥d2x≥0。
2.对深空探测器活动间约束进行表示。
假设探测器两个活动变量ox={sx,ex,dx}和oy={sy,ey,dy}。活动间约束包括ox开始点对oy开始点的约束[ss1,ss2],ss1,ss2为约束值域的下界和上界;ox开始点对oy结束点的约束[se1,se2],se1,se2为约束值域的下界和上界;ox结束点对oy开始点的约束[es1,es2],es1,es2为约束值域的下界和上界;ox结束点点对oy结束点的约束[ee1,ee2],ee1,ee2为约束值域的下界和上界。(ss1,ss2,se1,se2,es1,es2,ee1,ee2为任意一实数)。
步骤3,根据探测器活动变量自身约束,对所有探测器活动变量值域进行自我削减。
活动变量ox={sx,ex,dx}初始值域为sx∈[s1x,s2x]、ex∈[e1x,e2x]和dx∈[d1x,d2x]。利用几何表示方法,二维坐标系下开始点值域范围界限为x=s1x与x=s2x,结束点值域范围界限为y=e1x与y=e2x,持续时间值域范围界限为y=x+d1x与y=x+d2x。六条直线相交于12个交点。从12个交点中挑选满足条件的交点:x∈[e1x,e2x],y∈[e1x,e2x],y∈[x+d1x,x+d2x]。剩余n个点(n≤12),其中任意一点表示为(xn,yn)。
经自我削减后,探测器活动变量ox值域为sx∈[s1'x,s2'x]、ex∈[e1'x,e2'x]和dx∈[d1'x,d2'x],其中,s1'x=min(xn),s2'x=max(xn),e1'x=min(yn),e2'x=max(yn),d1'x=min(yn-xn),d2'x=max(yn-xn)。其中min表示最小值,max表示最大值。
步骤4,从深空探测器活动间约束对中任意选择一对C(ox,oy)="oxConsoy",其中Cons指步骤2中活动间的约束关系。根据ox值域和约束关系Cons推导oy的值域。推导时分三种情况进行,即推导oy的开始点值域、结束点值域和持续时间值域。
步骤4.1,对于oy的开始点值域[s1y,s2y],ox和约束[ss1,ss2]和[es1,es2]对[s1y,s2y]有影响。在坐标系中,为了两个约束同时满足,oy的开始点可行区域
Availablex=[s1x+ss1,s2x+ss2]∩[e1x+es1,e2x+es2](1)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行后续步骤。
步骤4.2,同理,对于oy的结束点值域[e1y,e2y],ox和约束[se1,se2]和[ee1,ee2]对[e1y,e2y]有影响。在坐标系中,为了两个约束同时满足,oy的结束点可行区域为
Availabley=[s1x+se1,s2x+se2]∩[e1x+ee1,e2x+ee2](2)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行后续步骤。
步骤4.3,对oy的持续时间值域,由式(3)获得。
Availabled=d1∩d2∩d3∩d4(3)
其中,d1=[se1-ss2,se2-ss1],d2=[ee1-es2,ee2-es1],d3=[d31,d32],d4=[d41,d42];且
d31=min(d1x-ss1+ee1,d1x-ss1+ee2,d1x-ss2+ee1,d1x-ss2+ee2),
d32=max(d2x-ss1+ee1,d2x-ss1+ee2,d2x-ss2+ee1,d2x-ss2+ee2),
d41=min(-d1x-es1+se1,-d1x-es1+se2,-d1x-es2+se1,-d1x-es2+se2),
d42=max(-d2x-es1+se1,-d2x-es1+se2,-d2x-es2+se1,-d2x-es2+se2)。
min表示几个值中的最小值,max表示几个值中的最大值。
根据式(1)-(3),得oy最后可行值域
Available=Availablex∩Availabley∩Availabled(4)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行后续步骤。
步骤5,步骤4中求出的oy可行值域Available与oy原值域sy∈[s1y,s2y],ey∈[e1y,e2y]和dy∈[d1y,d2y]进行几何相交。探测器活动oy开始点新值域为Intersectionx=Availablex∩[s1y,s2y],探测器活动oy结束点新值域为Intersectiony=Availabley∩[e1y,e2y],探测器活动oy持续时间新值域为Intersectiond=Availabled∩[d1y,d2y]。最终求得oy新值域Intersection=Intersectionx∩Intersectiony∩Intersectiond。如果交集为空,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域。如果交集不为空,则进行后续步骤。
步骤6,比较oy新值域Intersection与原值域是否相同,若不同,则将与oy相关的约束对再次加入到约束对集合C中。同时,将约束对C(ox,oy)="oxConsoy"从约束对集合C中删除。如果相同,则将约束对C(ox,oy)="oxConsoy"从约束对集合C中删除即可。
步骤7,重复步骤4,步骤5和步骤6,直到约束对集合C为空,步骤中4与步骤5中没有返回“时间约束不一致”结论,深空探测器所有活动变量满足约束关系,时间约束一致,所有活动变量得到新值域。
在该例子中,活动变量数为288,计算时间为16.732383s,利用时间约束网时间为950.28626s,效率提高了一个数量级,更加适合火星探测实时性要求。
图4是时间约束几何处理方法与时间约束网方法解决相同时间约束问题的时间比较图。图中:虚线部分表示时间约束几何处理方法;实线部分表示时间约束网方法。横坐标是问题中的活动变量数,纵坐标是计算时间(取e为底对数)。由图中可看出,时间约束几何处理方法比时间约束网方法计算时间低三个数量级,随着活动数量增加,几何处理方法时间保持平稳,而时间约束网方法不断增加。
Claims (1)
1.一种深空探测器自主任务规划时间约束几何处理方法,其特征在于:具体实现步骤如下:
步骤1,建立深空探测器时间规划问题模型;
深空探测器时间规划问题由探测器系统状态集合、探测器可执行活动变量集合、活动间的约束集合、探测器初始状态以及目标状态组成,即V={v1,v2,...,vm};
其中,V={v1,v2,...,vm}为状态变量集合,且v∈Dv,Dv为探测器能达到的状态值域,m为状态变量的数量;O={o1,o2,...,on}为探测器可执行的活动变量集合,n为活动变量的数量,任意一个探测器活动ox具有开始点sx、结束点ex、持续时间dx,即ox={sx,ex,dx};C为探测器活动间的约束集合,此处约束为两个活动间的时间约束,即C(ox,oy)="oxConsoy",ox与oy为活动间约束对,Cons为活动间约束关系;so为探测器初始状态,即当相对零点时,探测器状态变量都对应相应的值;g为目标状态,即探测器各个变量需要达到的值;
步骤2,对步骤1中探测器活动变量及活动间的时间约束进行表示;
在处理时间约束之前,需要对探测器活动变量及时间约束进行表示;
1.对探测器活动变量及活动自身约束进行表示;
设探测器活动变量集合O={o1,o2,...,on}中任意一个探测器活动ox,且ox={sx,ex,dx};将活动变量ox在二维坐标系下进行表示:横坐标x为开始点,纵坐标y为结束点,y=x+dx与纵坐标交点的值为持续时间;
对于探测器活动变量ox={sx,ex,dx},自身约束为sx∈[s1x,s2x]、ex∈[e1x,e2x]和dx∈[d1x,d2x];其中,s1x,s2x为活动ox开始点值域的下界和上界;e1x,e2x为活动ox结束点值域的下界和上界;d1x,d2x为活动ox持续时间值域的下界和上界;如果有相对零点,则s1x≥s2x≥0;s1x=s2x时,表示开始点的值域只有一个时刻;同理e1x≥e2x≥0,d1x≥d2x≥0;
2.对深空探测器活动间约束进行表示;
设探测器两个活动变量ox={sx,ex,dx}和oy={sy,ey,dy};活动间约束包括ox开始点对oy开始点的约束[ss1,ss2],ss1,ss2为约束值域的下界和上界;ox开始点对oy结束点的约束[se1,se2],se1,se2为约束值域的下界和上界;ox结束点对oy开始点的约束[es1,es2],es1,es2为约束值域的下界和上界;ox结束点点对oy结束点的约束[ee1,ee2],ee1,ee2为约束值域的下界和上界;ss1,ss2,se1,se2,es1,es2,ee1,ee2为任意实数;
步骤3,根据探测器活动变量自身约束,对所有探测器活动变量值域进行自我削减;
自我削减方法为:活动变量ox={sx,ex,dx}初始值域为sx∈[s1x,s2x]、ex∈[e1x,e2x]和dx∈[d1x,d2x];利用几何表示方法,二维坐标系下开始点值域范围界限为x=s1x与x=s2x,结束点值域范围界限为y=e1x与y=e2x,持续时间值域范围界限为y=x+d1x与y=x+d2x;六条直线相交于12个交点;从12个交点中挑选满足条件的交点:x∈[e1x,e2x],y∈[e1x,e2x],y∈[x+d1x,x+d2x];剩余n个点,n≤12,其中任意一点表示为(xn,yn);
经自我削减后,探测器活动变量ox值域为sx∈[s1'x,s2'x]、ex∈[e1'x,e2'x]和dx∈[d1'x,d2'x],其中,s1'x=min(xn),s2'x=max(xn),e1'x=min(yn),e2'x=max(yn),d1'x=min(yn-xn),d2'x=max(yn-xn);其中min表示最小值,max表示最大值;
步骤4,从深空探测器活动间约束对中任意选择一对C(ox,oy)="oxConsoy"根据ox值域和约束关系Cons推导oy的值域;分别推导oy的开始点值域、结束点值域和持续时间值域;
步骤4.1,对于oy的开始点值域[s1y,s2y],ox和约束[ss1,ss2]、[es1,es2]对[s1y,s2y]有影响;在坐标系中,为了两个约束同时满足,oy的开始点可行区域
Availablex=[s1x+ss1,s2x+ss2]∩[e1x+es1,e2x+es2](1)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域;如果交集不为空,则进行步骤4.2;
步骤4.2,对于oy的结束点值域[e1y,e2y],ox和约束[se1,se2]和[ee1,ee2]对其有影响;在坐标系中,为了两个约束同时满足,oy的结束点可行区域为
Availabley=[s1x+se1,s2x+se2]∩[e1x+ee1,e2x+ee2](2)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域;如果交集不为空,则进行步骤4.3;
步骤4.3,对oy的持续时间值域,由式(3)获得;
Availabled=d1∩d2∩d3∩d4(3)
其中,d1=[se1-ss2,se2-ss1],d2=[ee1-es2,ee2-es1],d3=[d31,d32],d4=[d41,d42];且d31=min(d1x-ss1+ee1,d1x-ss1+ee2,d1x-ss2+ee1,d1x-ss2+ee2),d32=max(d2x-ss1+ee1,d2x-ss1+ee2,d2x-ss2+ee1,d2x-ss2+ee2),d41=min(-d1x-es1+se1,-d1x-es1+se2,-d1x-es2+se1,-d1x-es2+se2),d42=max(-d2x-es1+se1,-d2x-es1+se2,-d2x-es2+se1,-d2x-es2+se2);min表示几个值中的最小值,max表示几个值中的最大值;
根据式(1)-(3),得oy最后可行值域
Available=Availablex∩Availabley∩Availabled(4)
如果交集为空,则表示没有值同时满足两个约束,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域;如果交集不为空,则进行步骤5;
步骤5,步骤4中求出的oy可行值域Available与oy原值域sy∈[s1y,s2y],ey∈[e1y,e2y]和dy∈[d1y,d2y]进行几何相交;探测器活动oy开始点新值域为Intersectionx=Availablex∩[s1y,s2y],探测器活动oy结束点新值域为Intersectiony=Availabley∩[e1y,e2y],探测器活动oy持续时间新值域为Intersectiond=Availabled∩[d1y,d2y];最终求得oy新值域Intersection=Intersectionx∩Intersectiony∩Intersectiond;如果交集为空,整个时间约束处理过程结束,结论为时间约束不一致,即无法得到满足所有时间约束的活动值域;如果交集不为空,则进行步骤6;
步骤6,比较oy新值域Intersection与原值域是否相同,若不同,则将与oy相关的约束对再次加入到约束对集合C中;同时,将约束对C(ox,oy)="oxConsoy"从约束对集合C中删除;如果相同,则将约束对C(ox,oy)="oxConsoy"从约束对集合C中删除即可;
步骤7,重复步骤4,、步骤5和步骤6,直到约束对集合C为空;如果步骤中4与步骤5中没有返回“时间约束不一致”结论,则表示深空探测器所有活动变量满足约束关系,时间约束一致,所有活动变量得到新值域;如果步骤4与步骤5中返回“时间约束不一致”结论,则表示深空探测器活动变量无法满足所有约束关系,所有活动变量无法得到新值域,时间规划结束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510883280.XA CN105487546B (zh) | 2015-12-04 | 2015-12-04 | 一种深空探测器自主任务规划时间约束几何处理方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510883280.XA CN105487546B (zh) | 2015-12-04 | 2015-12-04 | 一种深空探测器自主任务规划时间约束几何处理方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105487546A true CN105487546A (zh) | 2016-04-13 |
CN105487546B CN105487546B (zh) | 2018-01-16 |
Family
ID=55674583
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510883280.XA Active CN105487546B (zh) | 2015-12-04 | 2015-12-04 | 一种深空探测器自主任务规划时间约束几何处理方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105487546B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106773671A (zh) * | 2016-11-21 | 2017-05-31 | 上海卫星工程研究所 | 深空探测器分阶段mdo方法 |
CN107480375A (zh) * | 2017-08-15 | 2017-12-15 | 北京理工大学 | 一种基于空动作的深空探测约束可满足任务规划方法 |
CN109343554A (zh) * | 2018-11-02 | 2019-02-15 | 北京理工大学 | 一种基于状态转换代价值的启发式航天器任务规划方法 |
CN111914483A (zh) * | 2020-08-03 | 2020-11-10 | 北京理工大学 | 多航天器自主任务规划时间约束分布式处理方法 |
CN116011792A (zh) * | 2023-02-21 | 2023-04-25 | 中国人民解放军国防科技大学 | 基于约束层次网络的任务时间逻辑约束推理方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101794154A (zh) * | 2009-11-25 | 2010-08-04 | 哈尔滨工业大学 | 一种编队卫星相对轨道与姿态解耦控制方法 |
CN102424119A (zh) * | 2011-10-14 | 2012-04-25 | 北京理工大学 | 基于多项式逼近的行星际小推力转移轨道设计方法 |
CN104361234A (zh) * | 2014-11-15 | 2015-02-18 | 北京理工大学 | 一种复杂约束条件下多星多任务观测调度优化方法 |
CN104573856A (zh) * | 2014-12-25 | 2015-04-29 | 北京理工大学 | 一种基于时间拓扑排序的航天器资源约束处理方法 |
CN104635740A (zh) * | 2014-12-23 | 2015-05-20 | 北京理工大学 | 一种深空探测器自主姿态机动控制方法 |
-
2015
- 2015-12-04 CN CN201510883280.XA patent/CN105487546B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101794154A (zh) * | 2009-11-25 | 2010-08-04 | 哈尔滨工业大学 | 一种编队卫星相对轨道与姿态解耦控制方法 |
CN102424119A (zh) * | 2011-10-14 | 2012-04-25 | 北京理工大学 | 基于多项式逼近的行星际小推力转移轨道设计方法 |
CN104361234A (zh) * | 2014-11-15 | 2015-02-18 | 北京理工大学 | 一种复杂约束条件下多星多任务观测调度优化方法 |
CN104635740A (zh) * | 2014-12-23 | 2015-05-20 | 北京理工大学 | 一种深空探测器自主姿态机动控制方法 |
CN104573856A (zh) * | 2014-12-25 | 2015-04-29 | 北京理工大学 | 一种基于时间拓扑排序的航天器资源约束处理方法 |
Non-Patent Citations (1)
Title |
---|
ZHAOYU LI ET AL.: "Geometry-based propagation of temporal constraints", 《INFORMATION SYSTEMS FRONTIERS》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106773671A (zh) * | 2016-11-21 | 2017-05-31 | 上海卫星工程研究所 | 深空探测器分阶段mdo方法 |
CN106773671B (zh) * | 2016-11-21 | 2019-08-23 | 上海卫星工程研究所 | 深空探测器分阶段mdo方法 |
CN107480375A (zh) * | 2017-08-15 | 2017-12-15 | 北京理工大学 | 一种基于空动作的深空探测约束可满足任务规划方法 |
CN107480375B (zh) * | 2017-08-15 | 2020-04-17 | 北京理工大学 | 一种基于空动作的深空探测约束可满足任务规划方法 |
CN109343554A (zh) * | 2018-11-02 | 2019-02-15 | 北京理工大学 | 一种基于状态转换代价值的启发式航天器任务规划方法 |
CN111914483A (zh) * | 2020-08-03 | 2020-11-10 | 北京理工大学 | 多航天器自主任务规划时间约束分布式处理方法 |
CN111914483B (zh) * | 2020-08-03 | 2023-01-24 | 北京理工大学 | 多航天器自主任务规划时间约束分布式处理方法 |
CN116011792A (zh) * | 2023-02-21 | 2023-04-25 | 中国人民解放军国防科技大学 | 基于约束层次网络的任务时间逻辑约束推理方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN105487546B (zh) | 2018-01-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105487546A (zh) | 一种深空探测器自主任务规划时间约束几何处理方法 | |
CN103472850B (zh) | 一种基于高斯分布预测的多无人机协同搜索方法 | |
CN103557867B (zh) | 一种基于稀疏a*搜索的三维多uav协同航迹规划方法 | |
Meier et al. | Incremental local gaussian regression | |
Balampanis et al. | Area partition for coastal regions with multiple UAS | |
CN107504972A (zh) | 一种基于鸽群算法的飞行器航迹规划方法及装置 | |
CN103471591B (zh) | 基于逻辑法、全局最近邻和目标航向信息的机动多目标数据互联方法 | |
CN104504520B (zh) | 一种基于神经网络的深空探测器自主任务规划方法 | |
Du et al. | Applying particle swarm optimization algorithm to roundness error evaluation based on minimum zone circle | |
CN103697895A (zh) | 基于自适应a星算法的飞行器最优路径确定方法 | |
Hu et al. | A dynamic adjusting reward function method for deep reinforcement learning with adjustable parameters | |
Pei et al. | Multi-target consensus circle pursuit for multi-agent systems via a distributed multi-flocking method | |
Lee et al. | UAS mission path planning system (MPPS) using hybrid-game coupled to multi-objective optimizer | |
CN104077280A (zh) | 社区发现并行化方法和系统、主节点和运算节点设备 | |
Sherstjuk | Scenario-case coordinated control of heterogeneous ensembles of unmanned aerial vehicles | |
Konakoglu et al. | 2D coordinate transformation using artificial neural networks | |
Xie et al. | Application of improved Cuckoo search algorithm to path planning unmanned aerial vehicle | |
CN110933682B (zh) | 一种无人机基站自动选址方法 | |
CN114003059A (zh) | 运动学约束条件下基于深度强化学习的uav路径规划方法 | |
Zong et al. | Trajectory planning in 3D dynamic environment with non-cooperative agents via fast marching and Bézier curve | |
CN107194155A (zh) | 一种基于小数据集和贝叶斯网络的威胁评估建模方法 | |
Kalmuk et al. | Online parameter estimation for mpc model uncertainties based on lscr approach | |
Han et al. | Research on UAV indoor path planning algorithm based on global subdivision grids | |
CN111928853A (zh) | 复杂环境下空基平台快速航路规划方法 | |
Johansson et al. | On simulation-based adaptive UAS behavior during jamming |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |