发明名称 基于卫星定位的列车轨道占用检测方法和装置
摘要 本发明实施例提供了一种基于卫星定位的列车轨道占用检测方法和装置。该方法主要包括:列车头部和尾部的卫星定位接收机接收卫星星历数据和伪距数据,根据所述卫星星历数据和伪距数据计算出所述列车的车头和车尾的定位位置;根据设定的定位漏检率和误检率计算出所述列车的定位水平保护距离;根据所述列车的定位水平保护距离,结合电子地图将所述列车的车头和车尾的定位位置映射在轨道线路上,得到所述列车在所述轨道线路上的占用区间。本发明实施例通过在列车头部尾部设置卫星定位接收机,可以仅利用车载设备来完成列车的区间轨道占用计算,不需要利用轨道电路或计轴器等地面设备,可以大大节约地面设备的建设和维护成本,大大减少了成本。
申请公布号 CN104760607B 申请公布日期 2017.04.19
申请号 CN201510088751.8 申请日期 2015.02.26
申请人 北京交通大学 发明人 王剑;蔡伯根;刘江;上官伟;王忠立;郑波;靳成铭
分类号 B61L21/06(2006.01)I 主分类号 B61L21/06(2006.01)I
代理机构 北京市商泰律师事务所 11255 代理人 毛燕生
主权项 一种基于卫星定位的列车轨道占用检测方法,其特征在于,包括:列车头部和尾部的卫星定位接收机接收卫星星历数据和伪距数据,根据所述卫星星历数据和伪距数据计算出所述列车的车头和车尾的定位位置;根据设定的定位漏检率和误检率计算出所述列车的定位水平保护距离;根据所述列车的定位水平保护距离,结合电子地图将所述列车的车头和车尾的定位位置映射在轨道线路上,得到所述列车在所述轨道线路上的占用区间;所述的列车头部和尾部的卫星定位接收机接收卫星星历数据和伪距数据,根据所述卫星星历数据和伪距数据计算出所述列车的车头和车尾的定位位置,包括:为了计算出列车的车头位置或者车尾位置的定位点的三维位置(X<sub>u</sub>,Y<sub>u</sub>,Z<sub>u</sub>),在可见卫星中选择至少四颗卫星进行伪距测量,产生伪距方程组:ρ<sub>i</sub>=||s<sub>j</sub>‑u||+ct<sub>u</sub>,其中s<sub>j</sub>表示卫星位置信息,u表示接收机位置信息,c为光速常量,t<sub>u</sub>为信号从卫星与接收机时钟钟差;所述伪距方程组展开得到:<maths num="0001"><math><![CDATA[<mrow><msub><mi>&rho;</mi><mn>1</mn></msub><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>y</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>z</mi><mn>1</mn></msub><mo>-</mo><msub><mi>z</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><msub><mi>ct</mi><mi>u</mi></msub></mrow>]]></math><img file="FDA0001194158910000011.GIF" wi="883" he="92" /></maths><maths num="0002"><math><![CDATA[<mrow><msub><mi>&rho;</mi><mn>2</mn></msub><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>2</mn></msub><mo>-</mo><msub><mi>x</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>y</mi><mn>2</mn></msub><mo>-</mo><msub><mi>y</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>z</mi><mn>2</mn></msub><mo>-</mo><msub><mi>z</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><msub><mi>ct</mi><mi>u</mi></msub></mrow>]]></math><img file="FDA0001194158910000012.GIF" wi="901" he="93" /></maths><maths num="0003"><math><![CDATA[<mrow><msub><mi>&rho;</mi><mn>3</mn></msub><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>3</mn></msub><mo>-</mo><msub><mi>x</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>y</mi><mn>3</mn></msub><mo>-</mo><msub><mi>y</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>z</mi><mn>3</mn></msub><mo>-</mo><msub><mi>z</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><msub><mi>ct</mi><mi>u</mi></msub></mrow>]]></math><img file="FDA0001194158910000013.GIF" wi="900" he="95" /></maths><maths num="0004"><math><![CDATA[<mrow><msub><mi>&rho;</mi><mn>4</mn></msub><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>4</mn></msub><mo>-</mo><msub><mi>x</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>y</mi><mn>4</mn></msub><mo>-</mo><msub><mi>y</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>z</mi><mn>4</mn></msub><mo>-</mo><msub><mi>z</mi><mi>u</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><msub><mi>ct</mi><mi>u</mi></msub></mrow>]]></math><img file="FDA0001194158910000014.GIF" wi="910" he="91" /></maths>ρ<sub>j</sub>指第j颗卫星的伪距,x<sub>j</sub>、y<sub>j</sub>、z<sub>j</sub>指第j颗卫星的三维位置,t<sub>u</sub>列车车头位置或者车尾位置安装的卫星定位接收机的钟差;通过线性迭代方法来求解所述伪距方程组,得到所述列车的车头位置或者车尾位置的定位点的三维位置(X<sub>u</sub>,Y<sub>u</sub>,Z<sub>u</sub>);所述的通过线性迭代方法来求解所述伪距方程组,得到所述列车的车头位置或者车尾位置的定位点的三维位置(X<sub>u</sub>,Y<sub>u</sub>,Z<sub>u</sub>),包括:设偏移量(Δx<sub>u</sub>,Δy<sub>u</sub>,Δz<sub>u</sub>)表示所述列车的车头位置或者车尾位置的定位点的真实位置(x<sub>u</sub>,y<sub>u</sub>,z<sub>u</sub>)与定位点近似位置<img file="FDA0001194158910000021.GIF" wi="275" he="79" />之间的偏差;所述近似位置<img file="FDA0001194158910000022.GIF" wi="275" he="71" />的初始值设置为(0.0.0),通过迭代运算求出近似位置<img file="FDA0001194158910000023.GIF" wi="279" he="79" />的最终值,将所述伪距方程组在近似位置<img file="FDA0001194158910000024.GIF" wi="276" he="78" />处按泰勒级数展开,得到用已知坐标和伪距测量的线性函数表示的位置偏移量(Δx<sub>u</sub>,Δy<sub>u</sub>,Δz<sub>u</sub>),求得结果如下:Δρ=HΔx即Δx=H<sup>‑1</sup>Δρ其中<maths num="0005"><math><![CDATA[<mrow><mi>&Delta;</mi><mi>&rho;</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>&Delta;</mi><msub><mi>&rho;</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mrow><msub><mi>&Delta;&rho;</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&Delta;&rho;</mi><mn>3</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&Delta;&rho;</mi><mn>4</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>,</mo><mi>H</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>x</mi><mn>1</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>y</mi><mn>1</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>z</mi><mn>1</mn></mrow></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>a</mi><mrow><mi>x</mi><mn>2</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>y</mi><mn>2</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>z</mi><mn>2</mn></mrow></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>a</mi><mrow><mi>x</mi><mn>3</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>y</mi><mn>3</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>z</mi><mn>3</mn></mrow></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>a</mi><mrow><mi>x</mi><mn>4</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>y</mi><mn>4</mn></mrow></msub></mtd><mtd><msub><mi>a</mi><mrow><mi>z</mi><mn>4</mn></mrow></msub></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>,</mo><mi>&Delta;</mi><mi>x</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>&Delta;</mi><msub><mi>x</mi><mi>u</mi></msub></mtd></mtr><mtr><mtd><mrow><msub><mi>&Delta;y</mi><mi>u</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&Delta;z</mi><mi>u</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>c&Delta;t</mi><mi>u</mi></msub></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001194158910000025.GIF" wi="1110" he="303" /></maths>Δρ表示伪距残差,Δρ<sub>i</sub>(i=1,2,3,4)表示与卫星i有关的伪距残差,Δt<sub>u</sub>为卫星与接收机钟差偏差,所述a<sub>xj</sub>,a<sub>yj</sub>,a<sub>zj</sub>表示由所述列车的车头位置或者车尾位置的定位点的近似位置指向第j颗卫星的单位矢量的方向余弦,通过获取不少于4颗卫星的伪距信息和星历信息,利用上述方程通过迭代运算求解出4个未知量Δx<sub>u</sub>,Δy<sub>u</sub>,Δz<sub>u</sub>,Δt<sub>u</sub>来,并求解出近似位置<img file="FDA0001194158910000031.GIF" wi="278" he="79" />的最终值;根据所述偏移量(Δx<sub>u</sub>,Δy<sub>u</sub>,Δz<sub>u</sub>)和近似位置<img file="FDA0001194158910000032.GIF" wi="275" he="71" />的最终值,计算出所述列车的车头位置或者车尾位置的定位点的真实位置(x<sub>u</sub>,y<sub>u</sub>,z<sub>u</sub>);所述的根据设定的定位漏检率和误检率计算出所述列车的定位水平保护距离,包括:考虑测量噪声的线性化测量方程如下所示:y=Hx+ε其中,y表示伪距测量值,H表示雅克比矩阵,ε是n×1测量误差矢量,n表示伪距测量个数;对所述线性关联矩阵H进行QR分解得到奇偶变换矩P;计算出与所选取的每颗卫星线性关联的斜率SLOPE(i):<maths num="0006"><math><![CDATA[<mrow><mi>S</mi><mi>L</mi><mi>O</mi><mi>P</mi><mi>E</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>=</mo><msqrt><mrow><msubsup><mi>A</mi><mrow><mn>1</mn><mi>i</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>A</mi><mrow><mn>2</mn><mi>i</mi></mrow><mn>2</mn></msubsup></mrow></msqrt><mo>/</mo><msqrt><mrow><msub><mi>S</mi><mrow><mi>i</mi><mi>i</mi></mrow></msub><mo>,</mo></mrow></msqrt><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mo>...</mo><mo>,</mo><mi>n</mi></mrow>]]></math><img file="FDA0001194158910000033.GIF" wi="870" he="93" /></maths>式中,A<sub>mi</sub>为矩阵A中第m行第i列元素,且A≡(H<sup>T</sup>H)<sup>‑1</sup>H<sup>T</sup>,S<sub>ii</sub>为矩阵S中第i行第i列元素,且S=P<sup>T</sup>P,n表示伪距测量个数;SLOPE<sub>max</sub>为所选取的卫星线性关联的最大斜率;计算<maths num="0007"><math><![CDATA[<mrow><msub><mi>f</mi><mrow><mi>c</mi><mi>e</mi><mi>n</mi><mi>t</mi></mrow></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mo>&lsqb;</mo><msup><mi>x</mi><mrow><mo>(</mo><mo>(</mo><mrow><mi>k</mi><mo>/</mo><mn>2</mn></mrow><mo>)</mo><mo>-</mo><mn>1</mn><mo>)</mo></mrow></msup><msup><mi>e</mi><mrow><mo>-</mo><mi>x</mi><mo>/</mo><mn>2</mn></mrow></msup><mo>&rsqb;</mo><mo>/</mo><mo>&lsqb;</mo><msup><mn>2</mn><mrow><mi>k</mi><mo>/</mo><mn>2</mn></mrow></msup><mi>&Gamma;</mi><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mn>2</mn><mo>)</mo></mrow><mo>&rsqb;</mo><mo>,</mo></mrow></mtd><mtd><mrow><mi>x</mi><mo>&gt;</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mn>0</mn><mo>,</mo></mrow></mtd><mtd><mrow><mi>x</mi><mo>&le;</mo><mn>0</mn></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001194158910000034.GIF" wi="1119" he="176" /></maths><maths num="0008"><math><![CDATA[<mrow><msubsup><mo>&Integral;</mo><mi>x</mi><mi>&infin;</mi></msubsup><msub><mi>f</mi><mrow><mi>c</mi><mi>e</mi><mi>n</mi><mi>t</mi></mrow></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>p</mi><mrow><mi>F</mi><mi>A</mi></mrow></msub></mrow>]]></math><img file="FDA0001194158910000035.GIF" wi="398" he="151" /></maths>上述公式中的x为检测门限,Γ是伽马函数,自由度k=可见卫星数‑4,f<sub>cent</sub>(x)为中心χ<sup>2</sup>密度函数,p<sub>FA</sub>为设定的误检概率;计算<maths num="0009"><math><![CDATA[<mrow><msub><mi>f</mi><mrow><mi>N</mi><mo>.</mo><mi>C</mi><mo>.</mo></mrow></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mo>&lsqb;</mo><msup><mi>e</mi><mrow><mo>-</mo><mrow><mo>(</mo><mi>x</mi><mo>+</mo><mi>&lambda;</mi><mo>)</mo></mrow><mo>/</mo><mn>2</mn></mrow></msup><mo>/</mo><msup><mn>2</mn><mrow><mi>k</mi><mo>/</mo><mn>2</mn></mrow></msup><mo>&rsqb;</mo><munderover><mo>&Sigma;</mo><mrow><mi>j</mi><mo>=</mo><mn>0</mn></mrow><mi>&infin;</mi></munderover><mo>{</mo><msup><mi>&lambda;</mi><mi>j</mi></msup><msup><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mn>2</mn><mo>)</mo><mo>+</mo><mi>j</mi><mo>-</mo><mn>1</mn></mrow></msup><mo>/</mo><mo>&lsqb;</mo><mi>&Gamma;</mi><mrow><mo>(</mo><mo>(</mo><mrow><mi>k</mi><mo>/</mo><mn>2</mn></mrow><mo>)</mo><mo>+</mo><mi>j</mi><mo>)</mo></mrow><mo>&CenterDot;</mo><msup><mn>2</mn><mrow><mn>2</mn><mi>j</mi></mrow></msup><mo>&CenterDot;</mo><mi>j</mi><mo>!</mo><mo>&rsqb;</mo><mo>}</mo><mo>,</mo></mrow></mtd><mtd><mrow><mi>x</mi><mo>&gt;</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mn>0</mn><mo>,</mo></mrow></mtd><mtd><mrow><mi>x</mi><mo>&le;</mo><mn>0</mn></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001194158910000041.GIF" wi="1686" he="254" /></maths><maths num="0010"><math><![CDATA[<mrow><msubsup><mo>&Integral;</mo><mn>0</mn><mi>X</mi></msubsup><msub><mi>f</mi><mrow><mi>N</mi><mo>.</mo><mi>C</mi><mo>.</mo></mrow></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>P</mi><mrow><mi>m</mi><mi>d</mi></mrow></msub></mrow>]]></math><img file="FDA0001194158910000042.GIF" wi="390" he="159" /></maths>上述公式中的f<sub>N.C.</sub>(x)为非中心χ<sup>2</sup>密度函数,x为检测门限,j为整数,P<sub>md</sub>为设定的定位漏检率,λ为非中心χ<sup>2</sup>密度函数的非中心参量,计算出临界偏差记pbias:<maths num="0011"><math><![CDATA[<mrow><mi>p</mi><mi>b</mi><mi>i</mi><mi>a</mi><mi>s</mi><mo>=</mo><msub><mi>&sigma;</mi><mrow><mi>U</mi><mi>E</mi><mi>R</mi><mi>E</mi></mrow></msub><msqrt><mi>&lambda;</mi></msqrt></mrow>]]></math><img file="FDA0001194158910000043.GIF" wi="358" he="71" /></maths>所述λ是非中心χ<sup>2</sup>密度函数的非中心参量,所述σ<sub>UERE</sub>是设定的卫星伪距测量误差的标准差;所述列车的定位水平保护距离HPL的计算公式如下:HPL=SLOPE<sub>max</sub>×pbias。
地址 100044 北京市海淀区西直门外上园村3号