定位方法、装置、电子设备及存储介质与流程

1.本发明涉及无线通信领域与多源传感器融合定位领域的交叉技术领域，尤其涉及一种定位方法、装置、电子设备及存储介质。


背景技术：

2.当前，常用的高速列车定位方法基于轨道电路、计轴器和应答器等，如欧洲列车控制系统(european train control system，etcs)。中国的ctcs-2、3级列控系统采用“轮轴速度传感器+应答器”及轨道电路等方式对高速列车定位。这种定位方式一方面需要沿铁轨铺设大量传感器、电缆等轨旁设施，且需要人员定期维护，成本高昂；另一方面，传感器等轨旁设施在恶劣环境下容易因雷击、腐蚀等受损，导致设施损坏或传输数据错误引起故障。
3.随着全球导航卫星系统(global navigation satellite system，gnss)能够在全球范围内提供可靠的实时定位，包括经度、纬度和高度信息，且无需在环境中布置其它的传感器，可以很好的弥补现有cscs系统定位方面的不足。青藏线采用基于全球定位系统的增强型列控系统，基于gnss的列车定位成为下一代列控系统重要技术支撑。因此，gnss系统将极大满足未来高速列车定位需求。但是，当前单点gnss系统还面临定位精度不高、且定位精度容易受雨、雾、雪等天气因素的影响，从而难以满足当前高速列车定位精度需求，差分定位依赖地面差分站设置密度不足和反馈信道时延抖动等问题可能导致定位精度不高。而且，由于列车运行需要经过山区、隧道等环境，gnss信号容易受到遮挡，导致列车无法接收到卫星信号，从而无法实现实时可靠的gnss定位。


技术实现要素：

4.基于此，本发明实施例提供一种定位方法、装置、电子设备及存储介质。本发明实施例的技术方案是这样实现的：
5.本发明实施例提供一种定位方法，包括：
6.在能接收到卫星导航信号时，根据卫星导航信号确定目标对象的第一测量信息；
7.在不能接收到所述卫星导航信号时，根据预设线性调频css信号发射节点发送的css信号确定所述目标对象的第二测量信息；
8.根据惯性导航系统信号，确定所述目标对象的第三测量信息；
9.根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息。
10.上述方案中，所述方法还包括：基于先验残差、惯性测量残差和卫星定位残差构建所述非线性优化函数；其中，所述先验残差表征所述滑动窗口历史测量信息与所述预估定位信息的残差，所述惯性测量残差表征所述第三测量信息与所述预估定位信息的残差，所述卫星定位残差表征所述第二测量信息与所述预估定位信息的残差。
11.上述方案中，所述根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息，包
括：
12.将当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息以及所述滑动窗口历史数据的测量信息输入所述非线性优化函数；
13.根据牛顿-高斯法以及所述非线性优化函数，确定所述目标对象的预估定位信息。
14.上述方案中，在确定所述预估定位信息后，所述方法还包括：
15.采用舒尔补算法，将所述滑动窗口中的第一帧数据移出所述滑动窗口，并基于移出的所述第一帧数据和所述滑动窗口内剩余的数据，确定所述先验先验数据，其中，所述先验数据为所述滑动窗口历史测量信息；
16.将当前所述预估定位信息、当前所述第一测量信息、当前所述第二测量信息、以及当前所述第三测量信息加入所述滑动窗口。
17.上述方案中，所述方法还包括：
18.构建所述滑动窗口；
19.在能接收到所述卫星导航信号时，将每个时刻确定的所述第一测量信息和所述第三测量信息依次加入所述滑动窗口，直至所述滑动窗口中的每个窗口均包含所述第一测量信息和第三测量信息；
20.在不能接收到所述卫星导航信号时，将每个时刻确定的所述第二测量信息和所述第三测量信息依次加入所述滑动窗口，直至所述滑动窗口中的每个窗口均包含所述第二测量信息和第三测量信息；
21.基于所述惯性测量残差和所述卫星定位残差，对所述滑动窗口优化，得到当前时刻的所述预估定位置。
22.上述方案中，所述css信号发射节点分别在多个不同的预设信道发送所述css信号。
23.本发明实施例还提供一种定位装置，包括：
24.第一定位单元，用于在能接收到卫星导航信号时，根据卫星导航信号确定目标对象的第一测量信息；
25.第二定位单元，用于在不能接收到所述卫星导航信号时，根据预设线性调频css信号发射节点发送的css信号确定所述目标对象的第二测量信息；
26.第三定位单元，用于根据惯性导航系统信号，确定所述目标对象的第三测量信息；
27.融合计算单元，用于根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息。
28.本发明实施例还提供一种电子设备，所述设备至少包括：处理器和配置为存储可执行指令的存储介质，其中：处理器配置为执行存储的可执行指令，所述可执行指令配置为执行上述实施例提供的定位方法。
29.本发明实施例还提供一种计算机可读存储介质，存储有可执行指令，所述可执行指令被处理器执行时，实现本发明实施例提供的定位方法。
30.本发明实施例通过在能接收到卫星导航信号时，根据卫星导航信号定位得到第一测量信息，在无法接收到卫星导航信号的环境下，通过设计和部署低成本的css信号收发设备，基于css信号进行无卫星导航信号下的目标对象的定位得到第二测量信息，并在上述两种定位方式的基础上融合惯性导航系统传感信息，通过采用惯性导航系统传感器测量数据
对上述的定位数据进行融合和修正；一方面、基于css信号的定位，部署维护成本低，定位精度高；另一方面、由于惯性导航系统传感信息的融合，有效消除了电磁信号传输、气候变化、大气电离层以及环境噪声对卫星导航系统的定位误差干扰；再者，通过利用滑动窗口和非线性优化函数，融合基于卫星导航信号的第一测量信息、基于css信号的第二测量信息和基于惯性导航系统信号的第三测量信息，确定目标对象的预估定位信息，进一步提升了定位的精度。
附图说明
31.图1是本发明实施例提供的定位方法的流程示意图；
32.图2是本发明实施例提供的融合定位系统原理示意图；
33.图3是本发明实施例提供的融合定位系统的部署和设计示意图；
34.图4是本发明实施例提供的隧道中css信号节点部署示意图；
35.图5是本发明实施例提供的基于双模卫星定位的高速列车多源融合定位方法的仿真结果图；
36.图6是本发明实施例提供的基于双模卫星定位的高速列车多源融合定位方法的定位与实际测试的对比结果示意图；
37.图7是本发明实施例提供的定位装置的结构示意图；
38.图8是本发明实施例提供的电子设备的结构示意图。
具体实施方式
39.为了使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明作进一步地详细描述，所描述的实施例不应视为对本发明的限制，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
40.在以下的描述中，涉及到“一些实施例”，其描述了所有可能实施例的子集，但是可以理解,“一些实施例”可以是所有可能实施例的相同子集或不同子集，并且可以在不冲突的情况下相互结合。
41.在以下的描述中，所涉及的术语“第一\第二\第三”仅仅是是区别类似的对象，不代表针对对象的特定排序，可以理解地，“第一\第二\第三”在允许的情况下可以互换特定的顺序或先后次序，以使这里描述的本发明实施例能够以除了在这里图示或描述的以外的顺序实施。
42.除非另有定义，本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中所使用的术语只是为了描述本发明实施例的目的，不是旨在限制本发明。
43.下面说明本发明实施例提供的定位方法。参见图1，图1是本发明实施例提供的定位方法的流程示意图；在一些实施例中，该定位方法可应用于列车的定位系统中，本发明实施例提供的定位方法包括：
44.步骤s110：在能接收到卫星导航信号时，根据卫星导航信号确定目标对象的第一测量信息；
45.步骤s120：在不能接收到所述卫星导航信号时，根据预设线性调频css信号发射节
点发送的css信号确定所述目标对象的第二测量信息；
46.步骤s130：根据惯性导航系统信号，确定所述目标对象的第三测量信息；
47.步骤s140：根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息。
48.在一实施例中，卫星导航信号包括但不限于：gnss信号。
49.北斗卫星导航系统(beidou navigation satellite system,bds)和全球定位系统(global positioning system，gps)都属于gnss系统，gnss系统通过多个卫星来确定地面的gnss接收机的位置(包扩经度、纬度和高度)，gn ss系统由卫星和地面接收机组成，卫星主要由原子钟、无线收发机、主控计算机和其他辅助模块组成，根据三球交汇定点的原理，地面接收机接收到卫星信号后，可以从中获得每条数据的传输时间，从而计算出到每个卫星的近似距离，根据三维的距离公式，通过三个以上的卫星的近似距离，即可获得接收机的三维坐标，即第一测量信息。
50.在一实施例中，当无法接收到卫星导航信号时，则会基于线性调频(chirp spread spectrum，css)信号进行定位得到第二测量信息。
51.在一实施例中，预设css信号发射节点可采用连续扫频不同宽带，并在固定频段分配多个信道，在多个信道上进行通信，从而实现减少噪声、多径干扰、以及多普勒频移的无线定位对定位的影响。
52.在一实施例中，预设css信号发射节点在多个不同的预设信道发送所述css信号。获取三个预设css信号发射节点之间的部署距离和三个节点的地址和位置信息。采用一个接收节点布置于列车上作为接收和测量距离节点，列车通过监听css信号发射端信号和切换不同的css信号发射节点，以及信号的到达时间和处理时延，可以计算距离进行定位，得到第二测量信息。
53.在一实施例中，css信号发射节点的布置需要满足每个位置能接收到三个不同节点的信号，css信号发射节点分别在不同的三个信道发送css信号；并记录三个节点的地址和位置信息；之后为满足整条铁路不能接收到卫星导航信号区域的覆盖，重复布置相同的三个的css信号发射节点，直至覆盖整条列车沿线要求；且重复布置的节点距离满足信号传输不会相互干扰；最后列车通过监听css信号发射节点的发送信号和切换不同的css信号发射节点计算距离，进行单节点定位。根据列车在不同位置切换不同的css信号发射节点，切换的方式为，预先设定能量门限；当原先css信号发射节点信号强度小于预先设定的信号门限，而后css信号发射节点信号强度强于门限时，切换到后css信号发射节点。
54.在一实施例中，惯性导航系统(inertial navigation systems,ins)常使用惯性测量单元(inertial measurement unit,imu)来做为数据传感器，imu由三个正交陀螺仪和三个正交加速度计组成，分别用于测量系统的加速度和角速度。通过积分可以从加速度和角速度中得到位置(pose)、速度(velocity)和旋转(quaternion)三个量，即第三测量信息。
55.在一实施例中，在能接收到卫星导航信号的情况下，可能存在卫星导航信号短暂遮挡的场景，此时只依靠卫星导航信号难以定位，此时可以集合惯性导航系统信号提供的第三测量信息进行定位。
56.在一实施例中，在不能接收卫星导航信号的情况下，基于css信号的定位，若无法获知列车速度时，可结合第三测量信息中的速度信息确定列车速度进行定位。
57.在一实施例中，所述滑动窗口为滑动窗口算法。
58.在一实施例中，根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息，包括：
59.将当前第一测量信息或当前第二测量信息，以及当前第三测量信息加入滑动窗口中，基于非线性优化函数对滑动窗口进行优化，得到目标对象的预估定位信息。
60.本实施例通过在能接收到卫星导航信号时，根据卫星导航信号定位得到第一测量信息，在无法接收到卫星导航信号的环境下，通过设计和部署低成本的css信号收发设备，进行无卫星导航信号下的目标对象的定位得到第二测量信息，并在上述两种定位方式的基础上融合ins传感信息，通过采用ins传感器测量数据对上述的定位数据进行融合和修正，一方面、基于css信号的定位，部署维护成本低，定位精度高；另一方面、由于ins传感信息的融合，有效消除了电磁信号传输、气候变化、大气电离层以及环境噪声对卫星导航系统的定位误差干扰，再者通过利用滑动窗口和非线性优化函数，融合基于卫星导航信号的第一测量信息、基于css信号的第二测量信息和基于ins的第三测量信息，确定目标对象的预估定位信息，进一步提升了定位的精度。
61.在一些实施例中，所述方法还包括：基于先验残差、惯性测量残差和卫星定位残差构建所述非线性优化函数；其中，所述先验残差表征所述滑动窗口历史测量信息与所述预估定位信息的残差，所述惯性测量残差表征所述第三测量信息与所述预估定位信息的残差，所述卫星定位残差表征所述第二测量信息与所述预估定位信息的残差。
62.在一实施例中，所述非线性优化函数为构造的非线性最小二乘问题。
63.在一实施例中，通过求解非线性优化函数的最值，确定预估定位信息的最优定位信息。在一实施例中，求解所述非线性优化函数即为求解先验残差和惯性测量残差以及卫星定位残差之和的最小值。
64.本实施例，通过将基于卫星导航信号的定位误差加入总体的因子图中进行优化，相比于仅利用卫星导航信号的定位结果进行融合，有效利用了当前与历史定位结果之间的联系，进一步降低了定位的误差。
65.在一些实施例中，所述根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息，包括：
66.将当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息以及所述滑动窗口历史数据的测量信息输入所述非线性优化函数；
67.根据牛顿-高斯法以及所述非线性优化函数，确定所述目标对象的预估定位信息。
68.在一实施例中，通过牛顿-高斯newton-gauss法求解非线性优化函数，相比于最速梯度下降法和牛顿法，使用newton-gauss可以分别避免最速梯度下降法中由于步长估计不准而导致的收敛过慢以及使用牛顿法需要对误差表达式求二阶导，而导致的运算过于复杂的缺点。
69.在一些实施例中，在确定所述预估定位信息后，所述方法还包括：
70.采用舒尔补算法，将所述滑动窗口中的第一帧数据移出所述滑动窗口，并基于移出的所述第一帧数据和所述滑动窗口内剩余的数据，确定先验数据，其中，所述先验数据为
所述滑动窗口历史测量信息；
71.将当前所述预估定位信息、当前所述第一测量信息、当前所述第二测量信息、以及当前所述第三测量信息加入所述滑动窗口。
72.在一实施例中，在确定了最优预估定位信息后，通过舒尔补算法将当前滑动窗口中最早的一帧数据边缘化，将滑动窗口中最早的状态和其相应的测量数据从当前滑动窗口中移出，基于最早的一个帧数据和滑动窗口中剩余的帧数据建立用于下一次滑动窗口优化的先验数据，保证了被移出的帧数据能有效的对当前滑动窗口内的数据产生一定的约束。将得到的最优预估定位信息以及当前的第一测量数据或当前的第二测量数据，以及当前的第三测量数据加入滑动窗口中，更新滑动窗口。
73.在一些实施例中，所述方法还包括：
74.构建所述滑动窗口；
75.在能接收到所述卫星导航信号时，将每个时刻确定的所述第一测量信息和所述第三测量信息依次加入所述滑动窗口，直至所述滑动窗口中的每个窗口均包含所述第一测量信息和第三测量信息；
76.在不能接收到所述卫星导航信号时，将每个时刻确定的所述第二测量信息和所述第三测量信息依次加入所述滑动窗口，直至所述滑动窗口中的每个窗口均包含所述第二测量信息和第三测量信息；
77.基于所述惯性测量残差和所述卫星定位残差，对所述滑动窗口优化，得到当前时刻的所述预估定位置。
78.在一实施例中，构建所述滑动窗口包括：确定滑动窗口的大小，使滑动窗口的尺寸可以在保证实时计算的同时满足位姿估算精度。滑动窗口的尺寸一般设置为10帧数据的大小。
79.在一实施例中，所述方法还包括：将第一测量信息或第二测量信息，以及第三测量信息根据信息获取时间依次加入所述滑动窗口中，直至滑动窗口中的每个窗口都存在对应的同一时刻获取的第一测量数据或第二测量数据以及第三测量数据。在初始阶段，滑动窗口中还没有历史测量数据，先验残差为零。基于所述非线性优化函数对所述滑动窗口优化，得到当前时刻的所述预估定位置，完成对滑动窗口的初始化。
80.以下结合上述实施例提供一个具体示例：
81.本示例提出一种基于双模卫星定位的高速列车多源融合定位方法，应用于融合定位系统。其中，所述融合定位系统原理示意图，如图2所示，所述融合定位系统包括：gnss接收模块、ins测量模块、css信号收发模块、gnss信号预处理模块、imu预积分模块、css信号预处理模块、初始化模块、窗口优化模块和多源信息融合模块。图3为融合定位系统的部署和设计示意图。
82.本示例提出的基于双模卫星定位的高速列车多源融合定位方法，包括：
83.1、在有gnss信号时，由北斗、gps双模gnss接收模块接收的gnss信号，经过gnss信号预处理模块计算获得伪距等初步的定位坐标。
84.具体的，gnss系统由卫星和地面接收机组成，卫星主要由原子钟、无线收发机、主控计算机和其他辅助模块组成，地面接收机接收到卫星信号后，可以从中获得每条数据的传输时间，从而计算出到每个卫星的近似距离，这个距离被称之为伪距(pseudo range)。用
d来表示伪距，c表示光速，信号的发送时间为ts，接收时间为tr，则伪距可以表示为：
85.d＝c(t
r-ts)+cδt
86.其中δt为时间同步误差，由于卫星上一般使用昂贵的原子钟，而接收机出于成本考虑无法使用如此精确的时钟源，因此会存在时间误差δt。
87.将伪距表示为坐标形式为：
[0088][0089]
其中下标i表示第i颗卫星，x、y、z表示接收机或卫星的三维坐标，方程存在4个未知数，因此只要联立4个卫星数据的方程组即可解出接收机的三维坐标，虽然严格来说3颗卫星就足够定位出经纬度和高度，但是由于时间误差δt的存在，1us的时间同步误差就会导致300米以上的定位误差，所以为了保证定位的精度，至少需要同时能够收到4颗卫星的数据。
[0090]
2、在无法接收到gnss信号的区域，沿铁路线预先设计并布置css信号发射节点，并发送线性调频(css)无线信号，在列车上安装接收节点，列车接收的css信号经过css信号预处理模块，消除模块处理时间后，计算列车与节点间的距离，实现列车定位。
[0091]
具体的，设计的css节点采用连续扫频不同带宽、如400khz、800khz和1.6mhz等，并可以在2.4ghz的工业、科学和医疗用频段(ism band)分配多个信道上进行通信。其中，ism频段可以使用带宽83.5mhz，而css信号带宽不超过1.6mhz，因此可以根据需求，将ism频段分配成多个信道，防止信号相互干扰问题。通过采用连续扫频信号，可以实现抗噪声、多径干扰、以及多普勒频移的无线定位。
[0092]
第一，进行css信号节点的部署。如图4所示，图4为隧道中css信号节点部署示意图。采用三个css信号节点为一组进行定位举例。预先布置的一组三个节点s1、s2和s3分别在不同的三个信道(如ch1，ch2和ch3)发送和接收css信号；通过布置节点在不同信道传输，可以防止三个节点间相互干扰问题。三个节点之间的布置距离为d1，并记录三个节点的地址和位置信息存储于数据库中；在节点部署中，三个节点部署距离可以是非等间距，只需要预先记录节点的地址和位置信息，并在通信范围内；
[0093]
其后，为满足整条线路覆盖，重复布置多组三个的css信号节点m1、m2、m3，和n1、n2、n3，以及k1、k2、k3
……
直至覆盖完整条线路；
[0094]
为防止相互干扰的问题，m1、m2、m3节点采用ch4、ch5、ch6信道，三个节点间的距离为d1；s1与n1距离为d2，通过采用不同的信道，相邻的两组节点可以防止相互干扰。
[0095]
进一步，为重复使用信道，s1、s2、s3与n1、n2、n3可以重复使用相同的ch1、ch2、ch3信道，即s1和n1使用ch1信道，s2和n2使用ch2信道，s3和n3使用ch3信道；为防止使用相同信道的干扰问题，即s1和n1，s2和n2，s3和n3都为d2，这样由于距离足够远，采用相同的信道也不会相互干扰，以及防止通信区域重叠冲突问题，并且提升了频带利用率。
[0096]
第二、基于部署的css信号节点进行融合定位。
[0097]
具体的，在列车上的融合定位系统可以同时和三个在不同css信号节点进行通信和测距。定位的基本原理是，通过三个测距值，可以定位出列车的唯一位置；
[0098]
测距基本原理：列车搭载的融合定位系统首先发送信号至预先布置的css节点(例如，s1、s2、s3节点)，并记录下发送信号的时间。s1、s2、s3节点收到信号以后，返回信号给列
车搭载的融合定位系统，并同时给出信号处理的时延信息实现通信节点间的时间同步。列车通过监听返回的信号以及记录到达时间，通过去除处理时延可以得到信号传播时间，从而可以得到列车与三个节点的测距信息，最终实现列车定位。在同步过程中，节点的处理时延会导致一定的测距误差，其中css信号节点的处理时延为几毫米至几百毫秒左右。因此为补偿处理时延导致的误差提供两种解决方案：第一，在有列车准确速度的信息情况下，根据列车提供速度以及实际处理时延，可以计算得到位置误差偏移量，从而对测距信息进行补偿校准；第二，在无法获知列车速度信息情况下，利用imu数据中的加速计信息进行积分计算获取速度，实现误差校准。
[0099]
进一步地，节点的切换问题，可以使用如下两种切换方式：
[0100]
方式一：列车首先利用第一组的三个css节点(如s1、s2、s3)进行通信测距。随着列车向前移动，预先设定能量门限；当原先发送节点信号强度小于预先设定的信号门限，切换到下一组的三个节点(如m1、m2、m3)进行测距定位；
[0101]
方式二：列车进入隧道，同时扫描ch1、ch2、ch3、ch4、ch5、ch6信道，选择能量最强信号最好的三个节点作为一组进行通信测距；并随着列车移动定时扫描信道，切换最好的三个节点进行测距。
[0102]
在本系统中，举例采用的是每组三个节点进行定位，实际部署中，可以根据成本以及定位精度要求做出权衡。理论上，每组节点数量越多，定位精度越高，成本也会增加。
[0103]
3、将ins测量模块获取的信号发送至imu预积分模块，得到列车位置、速度、角度等测量数据。ins测量模块接收并测量高速列车加速度、陀螺仪信息等传感信息，并通过imu预积分模块处理计算列车三维坐标，对列车进行定位。
[0104]
惯性导航系统(inertial navigation systems,ins)常使用惯性测量单元(inertial measurement unit,imu)来做为数据传感器，imu由三个正交陀螺仪和三个正交加速度计组成，分别用于测量系统的加速度和角速度。通过积分可以从加速度和角速度中得到位置(pose)、速度(velocity)和旋转(quaternion)三个量，分别用p、v、q表示。其中q表示四元数旋转矩阵。四元数的基本思想是采用一个单位长度四维向量来表示三维空间中的旋转，一个四元数拥有一个实部和三个虚部，表示为：q＝q0+q1i+q2j+q3k，i,j,k分别表示四元数的三个虚部。
[0105]
此外，设b和w分别表示系统自身坐标系(body frame，bf)和世界坐标系(world frame，wf),wf又根据坐标轴旋转的不同分为北东地(ned)和东北天(enu)两种，本文采用东北天坐标系，即原点为系统中心，x轴平行于地球椭球的场半轴，y轴平行于椭球短半轴，z轴为椭球法线方向指向天向；表示从b系相对于w系的旋转，用四元数形式表示。表示由四元数转化得到的旋转矩阵，为了简便起见，下文在没有特殊说明的情况下将简写为
[0106]
通过对上述测量数据进行积分，可以从第i时刻的获得第j时刻(j≥i)的
[0107]
[0108][0109][0110]
其中，ba,bg分别表示加速度计和陀螺仪的偏置，na,ng分别表示加速度计和陀螺仪的噪声，gw表示初始时刻的重力加速度，表示积分过程中瞬间时刻相对于i帧坐标系的相对旋转，ω(
·
)表示四元数的右乘矩阵。
[0111]
4、多源信息融合模块融合gnss信号预处理模块、imu预积分模块以及css信号预处理模块的测量数据，根据其可信度，使用可靠数据进行对应的数据融合算法估计出列车的三维位置信息以及其所处的铁路路段位置。
[0112]
具体的根据滑动窗口和联合优化算法对数据进行融合，滑动窗口和联合优化算法包括：
[0113]
1)选定滑动窗口大小，使得滑动窗口的尺寸可以在保证实时计算的同时满足位姿估算精度。
[0114]
2)初始化阶段，当接收到卫星信号的定位信息时，将卫星的定位结果和通过imu预积分估算的位姿加入滑动窗口，直至滑动窗口内的每个窗口都有对应的传感器数据，此过程不会进行后端非线性优化。当滑动窗口内添加完数据之后，进行一次优化，以得到传感器在设备启动阶段的位姿估计信息。
[0115]
3)实时定位阶段，当检测到新的卫星定位结果时，将其和imu的预积分数据以及上一时刻滑动窗口内的所有数据进行一次联合的非线性优化，优化完成后移动滑窗，将滑窗内最早的一帧传感器数据及其定位结果移除，并将新的传感器数据和优化完的结果加入到滑动窗口的末尾。如此过程反复进行，直至结束。
[0116]
具体的，首先定义要优化的变量：
[0117]
x＝[x0,x1,...,xn]
[0118][0119]
其中，总体的误差表达式写为：
[0120][0121]
其中，||r
p-h
p
x||表示先验信息的残差，其中r
p
表示由滑动窗口历史数据组成的观测值，h
p
表示状态变量向r
p
的转化矩阵。该信息保留了之前被滑窗移除数据所提供的信息，保证了数据在位姿估计过程中的一致性。
[0122]
[0123][0124]
表示imu的测量值和待估计变量的残差。其中为待估计变量，δtk表示两帧之间的时间差，gw为重力加速度。分别表示由imu测量数据得到的位置，速度以及旋转的增量，表示增量的协方差矩阵，用来表示上述残差的置信程度，协方差矩阵越大，表明当前的测量数据的可信度越低，其在优化过程中对结果的影响程度越小。可以在imu预积分阶段通过对误差项求积分得到。
[0125]
其中，表示gnss卫星测量值和待估计变量的残差。其中表示北斗卫星的测量坐标。表示卫星信号接受机以及imu之间的外参数，为待估计变量，表示k时刻卫星测量数据的协方差矩阵，其数值可以通过查询北斗卫星标称数据并且结合当前测量环境联合估计的方法获得。值得说明的一点是，本示例创新性地提出将卫星定位误差加入总体的因子图中进行优化。之前普遍使用的扩展卡尔曼滤波算法仅仅利用当前卫星信号的定位结果进行融合，而将卫星定位结果加入总体的因子图中，可以有效利用当前与历史定位结果之间的联系，进一步降低定位误差。
[0126]
其中表示css测量值和待估计变量的残差。其中分别表示卫星接收机以及css接收机相对于imu传感器的旋转矩阵和平移，在这里作为固定值代入计算；为css测量数据；为待估计变量；表示k时刻无线信号测量数据的协方差矩阵，其数值可以通过记录一段时间的定位误差，并结合统计学公式获得。
[0127]
构建完上述的目标函数后，采用newton-gauss方法求解该优化问题，相比于最速梯度下降法和牛顿法，使用newton-gauss可以分别避免最速梯度下降法中由于步长估计不准而导致的收敛过慢以及使用牛顿法需要对误差表达式求二阶导，而导致的运算过于复杂的缺点。
[0128]
[0129][0130]
通过不断迭代逐步找到使得总体误差最小的δx，令：
[0131]
x
opt
＝x+δx
[0132]
从而得到最优解。在计算得到最优解后，使用舒尔补公式将滑动窗口中最早的状态以及其相应的测量数据移出滑动窗口，并将当前的x
opt
及其卫星测量数据与imu的预积分结果加入滑动窗口中。在移出最早帧的过程中，使用了舒尔补的方法，以保证被移出帧的数据能够有效对当前滑窗内的数据产生一定的约束。通过以上方式，在有无gnss信号环境下，都可以实现高速列车精确定位。
[0133]
gnss能够为系统提供经纬度和高度信息，但是在卫星信号受到遮挡的场景下，gnss系统将难以定位，而ins在短时间内能够提供精准的位置、速度和姿态信息，且它的抗干扰能力强，它的缺点在于随着时间的推移会导致加速度计和陀螺仪的误差堆积，从而使得精度急剧下降。css信号的定位可以克服遮挡问题，但存在部署成本问题和在无法知晓列车准确车速无法定位的问题，本示例通过将三者整合起来，可以使得优劣互补，获得更好的定位表现；通过设计滑动窗口和联合优化算法，融合gnss定位坐标、css定位坐标以及ins传感定位信息，同时优化和修正定位坐标，实现高精度定位。图5为本示例提供的基于双模卫星定位的高速列车多源融合定位方法的仿真结果图。图6为基于双模卫星定位的高速列车多源融合定位方法的定位与实际测试的对比结果示意图。
[0134]
下面继续说明本发明实施例提供的定位装置，参见图7，图7是本发明实施例提供的定位装置的结构示意图，本发明实施例提供的定位装置700包括：
[0135]
第一定位单元710，用于在能接收到卫星导航信号时，根据卫星导航信号确定目标对象的第一测量信息；
[0136]
第二定位单元720，用于在不能接收到所述卫星导航信号时，根据预设线性调频css信号发射节点发送的css信号确定所述目标对象的第二测量信息；
[0137]
第三定位单元730，用于根据惯性导航系统信号，确定所述目标对象的第三测量信息；
[0138]
融合计算单元740，用于根据当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息，利用滑动窗口和非线性优化函数，确定所述目标对象的预估定位信息。
[0139]
在一些实施例中，所述装置还包括：构建单元，用于基于先验残差、惯性测量残差和卫星定位残差构建所述非线性优化函数；其中，所述先验残差表征所述滑动窗口历史测量信息与所述预估定位信息的残差，所述惯性测量残差表征所述第三测量信息与所述预估定位信息的残差，所述卫星定位残差表征所述第二测量信息与所述预估定位信息的残差。
[0140]
在一些实施例中，所述融合计算单元，还用于将当前所述第一测量信息、当前所述第二测量信息和当前所述第三测量信息以及所述滑动窗口历史数据的测量信息输入所述非线性优化函数；以及根据牛顿-高斯法以及所述非线性优化函数，确定所述目标对象的预估定位信息。
[0141]
在一些实施例中，所述装置还包括：更新单元，用于在确定所述预估定位信息后，采用舒尔补算法，将所述滑动窗口中的第一帧数据移出所述滑动窗口，并基于移出的所述第一帧数据和所述滑动窗口内剩余的数据，确定所述先验先验数据，其中，所述先验数据为所述滑动窗口历史测量信息；以及将当前所述预估定位信息、当前所述第一测量信息、当前所述第二测量信息、以及当前所述第三测量信息加入所述滑动窗口。
[0142]
在一些实施例中，所述装置还包括：初始化单元，用于：
[0143]
构建所述滑动窗口；
[0144]
在能接收到所述卫星导航信号时，将每个时刻确定的所述第一测量信息和所述第三测量信息依次加入所述滑动窗口，直至所述滑动窗口中的每个窗口均包含所述第一测量信息和第三测量信息；
[0145]
在不能接收到所述卫星导航信号时，将每个时刻确定的所述第二测量信息和所述第三测量信息依次加入所述滑动窗口，直至所述滑动窗口中的每个窗口均包含所述第二测量信息和第三测量信息；
[0146]
基于所述惯性测量残差和所述卫星定位残差，对所述滑动窗口优化，得到当前时刻的所述预估定位置。
[0147]
在一些实施例中，所述第二定位单元，包括：发送单元，用于利用所述css信号发射节点分别在多个不同的预设信道发送所述css信号。
[0148]
本发明实施例还提供一种电子设备，所述设备至少包括：处理器和配置为存储可执行指令的存储介质，其中：
[0149]
处理器配置为执行存储的可执行指令，所述可执行指令配置为执行本发明实施例提供的定位方法。
[0150]
需要说明的是，图8为本技术实施例提供的一种电子设备结构示意图，如图8所示，该设备800至少包括：处理器810、通信接口820和存储器830，其中：
[0151]
处理器810通常控制设备800的总体操作。
[0152]
通信接口820可以使设备通过网络与其他设备通信。
[0153]
存储器830配置为存储由处理器810可执行的指令和应用，还可以缓存待处理器810以及设备800中各模块待处理或已经处理的数据(例如，图像数据、音频数据、语音通信数据和视频通信数据)，可以通过闪存(flash)或随机访问存储器(random access memory，ram)实现。
[0154]
需要说明的是，本技术实施例中，如果以软件功能模块的形式实现上述定位方法，并作为独立的产品销售或使用时，也可以存储在一个计算机可读取存储介质中。基于这样的理解，本技术实施例的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台服务器执行本技术各个实施例所述方法的全部或部分。而前述的存储介质包括：u盘、移动硬盘、只读存储器(read only memory，rom)、磁碟或者光盘等各种可以存储程序代码的介质。这样，本技术实施例不限制于任何特定的硬件和软件结合。
[0155]
对应地，本技术实施例提供一种计算机可读存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现上述实施例提供的定位方法中的步骤。
[0156]
这里需要指出的是：以上存储介质和设备实施例的描述，与上述方法实施例的描
述是类似的，具有同方法实施例相似的有益效果。对于本技术存储介质和设备实施例中未披露的技术细节，请参照本技术方法实施例的描述而理解。
[0157]
当然，本技术实施例中的装置还可有其他类似的协议交互实现案例，在不背离本技术精神及其实质的情况下，本领域的技术人员当可根据本技术实施例做出各种相应的改变和变形，但这些相应的改变和变形都应属于本技术方法所附的权利要求的保护范围。
[0158]
本领域内的技术人员应明白，本技术的实施例可提供为方法、系统、或计算机程序产品。因此，本技术可采用硬件实施例、软件实施例、或结合软件和硬件方面的实施例的形式。而且，本技术可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器和光学存储器等)上实施的计算机程序产品的形式。
[0159]
本技术是参照根据本技术实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的设备。
[0160]
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令设备的制造品，该指令设备实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
[0161]
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
[0162]
应理解，说明书通篇中提到的“一个实施例”或“一实施例”意味着与实施例有关的特定特征、结构或特性包括在本技术的至少一个实施例中。因此，在整个说明书各处出现的“在一个实施例中”或“在一实施例中”未必一定指相同的实施例。此外，这些特定的特征、结构或特性可以任意适合的方式结合在一个或多个实施例中。应理解，在本技术的各种实施例中，上述各过程的序号的大小并不意味着执行顺序的先后，各过程的执行顺序应以其功能和内在逻辑确定，而不应对本技术实施例的实施过程构成任何限定。上述本技术实施例序号仅仅为了描述，不代表实施例的优劣。
[0163]
需要说明的是，在本文中，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者装置不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者装置所固有的要素。在没有更多限制的情况下，由语句“包括一个
……”
限定的要素，并不排除在包括该要素的过程、方法、物品或者装置中还存在另外的相同要素。
[0164]
在本技术所提供的几个实施例中，应该理解到，所揭露的设备和方法，可以通过其它的方式实现。以上所描述的设备实施例仅仅是示意性的，例如，所述模块的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，如：多个模块或组件可以结合，或可以集成到另一个系统，或一些特征可以忽略，或不执行。另外，所显示或讨论的各组成部
分相互之间的耦合、或直接耦合、或通信连接可以是通过一些接口，设备或模块的间接耦合或通信连接，可以是电性的、机械的或其它形式的。
[0165]
上述作为分离部件说明的模块可以是、或也可以不是物理上分开的，作为模块显示的部件可以是、或也可以不是物理模块；既可以位于一个地方，也可以分布到多个网络模块上；可以根据实际的需要选择其中的部分或全部模块来实现本实施例方案的目的。
[0166]
以上所述，仅为本技术的实施方式，但本技术的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本技术揭露的技术范围内，可轻易想到变化或替换，都应涵盖在本技术的保护范围之内。因此，本技术的保护范围应以所述权利要求的保护范围为准。