1. 西安电子科技大学 通信工程学院, 陕西 西安 710071
2. 中兵智能创新研究院有限公司, 北京 100072
3. 群体协同与自主实验室, 北京 100072
* 邮箱: pren@xidian.edu.cn
收稿:2023-08-31,
网络出版:2024-01-15,
纸质出版:2023-12-30
移动端阅览
邓廷祥, 任鹏, 程甲, 等. 面向集群协同的两点相对定位技术[J]. 兵工学报, 2023,44(S2):22-34.
Tingxiang DENG, Peng REN, Jia CHENG, et al. Relative Positioning Technology for Two Points Based on Cluster Cooperative Orientation[J]. Acta Armamentarii, 2023, 44(S2): 22-34.
邓廷祥, 任鹏, 程甲, 等. 面向集群协同的两点相对定位技术[J]. 兵工学报, 2023,44(S2):22-34. DOI: 10.12382/bgxb.2023.0829.
Tingxiang DENG, Peng REN, Jia CHENG, et al. Relative Positioning Technology for Two Points Based on Cluster Cooperative Orientation[J]. Acta Armamentarii, 2023, 44(S2): 22-34. DOI: 10.12382/bgxb.2023.0829.
无人集群节点间精确位置获取是集群协同的基础
但在复杂多变的应用环境中
全球导航卫星系统(GNSS)难以提供稳定准确的位置信息;难以部署辅助锚点;传统相对定位方法大多存在节点数量限制。针对上述3个问题
提出了一种GNSS拒止条件下的集群节点相对定位的新方法。以搭载惯性测量单元(IMU)和超宽带传感器的两个节点为例建立了相对定位模型
采用扩展卡尔曼滤波算法
融合机载IMU和机间距离信息
实现了相对位置的最优估计。仿真实验结果表明:在无人机相距200m的范围内
所提方法可达到约1.3m的相对定位精度
与现有多节点相对定位算法相比
提高了约4倍;在无需GNSS和辅助锚点的支持下
即可实现两个节点之间的高精度相对定位
能够为无人集群在复杂应用环境下的协同定位提供有效可行的解决方案。
Precise inter-node position acquisition is the basis for coordination in unmanned vehicle clusters
but the global navigation satellite system (GNSS) struggles to provide the stable and accurate position information in complex and dynamic application environments. It is difficult to deploy the auxiliary anchor points
and most traditional relative positioning methods have limitations on the number of nodes. A new relative localization method for cluster nodes under GNSS-denied conditions is proposed to address the above three problems. Taking two nodes equipped with inertial measurement units (IMUs) and ultra-wideband sensors as an example
a relative positioning model is established
and an extended Kalman filter algorithm is used to fuse IMU and inter-node distance information for the optimal estimation of relative position. Simulation experiments show that the proposed method is used to achieve a relative positioning accuracy of about 1.3m within 200m range between unmanned aerial vehicles
improving nearly 4 times over existing multi-node relative positioning algorithms. The high-precision relative positioning between two nodes can be achieved without relying on GNSS or auxiliary anchor points
providing an effective and feasible solution for collaborative positioning of unmanned vehicle clusters in complex application environment.
陈炜军 , 邹庆 , 涂卫军 . 空面武器智能化发展趋势与应用 [J ] . 直升机技术 , 2021 ( e2 ): 69 - 72 .
CHEN W J , ZOU Q , TU W J . Research on intelligent development trend and application of air-to-surface weapons [J ] . Helicopter Technique , 2021 ( e2 ): 69 - 72 . (in Chinese)
郝菁 . 基于惯导/数据链协同的无人机集群导航定位算法研究 [D ] . 北京 : 中国电子科技集团公司电子科学研究院 , 2019 .
HAO J . INS/Intra flight datalink cooperative positioning algorithm for UAVs [D ] . Beijing : China Academic of Electronics and Information Technology , 2019 . (in Chinese)
裴凌 , 李涛 , 花彤 , 等 . 多源融合定位算法综述 [J ] . 南京信息工程大学学报(自然科学版) , 2022 , 14 ( 6 ): 635 - 648 .
PEI L , LI T , HUA T , et al. A survey of multi-source fusion positioning algorithms [J ] . Journal of Nanjing University of Information Science & Technology(Natural Science Edition) , 2022 , 14 ( 6 ): 635 - 648 . (in Chinese)
ZHUANG Y , SUN X , LI Y , et al. Multi-sensor integrated navigation/positioning systems using data fusion: from analytics-based to learning-based approaches [J ] . Information Fusion , 2023 , 95 : 62 - 90 . DOI: 10.1016/j.inffus.2023.01.025 http://doi.org/10.1016/j.inffus.2023.01.025 https://linkinghub.elsevier.com/retrieve/pii/S1566253523000398 https://linkinghub.elsevier.com/retrieve/pii/S1566253523000398
韩煜 , 宋韬 , 郑多 , 等 . 基于冲突触发避碰机制的无人飞行器集群协同制导技术 [J ] . 兵工学报 , 2023 , 44 ( 7 ): 1881 - 1895 . DOI : 10.12382/bgxb.2022.0152 http://doi.org/10.12382/bgxb.2022.0152 协同打击是提升飞行器集群整体作战效能的重要模式。针对密集飞行器集群协同打击目标过程中存在的相互碰撞或彼此干扰问题,建立典型的多目标协同打击的任务场景模型,揭示飞行器集群协同运动过程中的机动规律;基于效用函数最优理论研究避免碰撞的飞行器集群协调最优机动策略,保证飞行器之间避免碰撞。考虑飞行器集群协同制导中的时间/空间同步到达约束,采用基于时间管控的多约束协同制导策略,同时满足到达时间和脱靶量要求;引入基于冲突触发的协同避碰机制,提出兼顾避碰和协同打击的协同调整策略,求得满足避免碰撞与时空同步的协同制导方法。仿真结果表明,新提出的考虑避碰约束的飞行器集群协同制导方法能够保证飞行器间的安全距离约束,具有较强的协同时间管控能力和较高的制导精度,且仅需较少迭代计算,降低了对机载处理器的要求,为飞行器集群协同打击中的避碰问题提供了一种解决方法,具有较强的工程应用价值。
HAN Y , SONG T , ZHENG D , et al. Unmanned aerial vehicle cluster cooperative guidance technology based on conflict trigger mechanism [J ] . Acta Armamentarii , 2023 , 44 ( 7 ): 1881 - 1895 . (in Chinese) DOI: 10.12382/bgxb.2022.0152 http://doi.org/10.12382/bgxb.2022.0152 Cooperative strike is an important mode to improve the overall combat effectiveness of aircraft clusters. To address the problem of mutual collision or interference in the process of cooperative attack on targets by dense aircraft clusters, a typical mission scenario model of multi-target cooperative attack is established, and the maneuver law in the process of cooperative movement of aircraft cluster is revealed. Then, based on the optimal theory of utility function, the coordinated optimal maneuver strategy of aircraft cluster to avoid collision is studied, ensuring collision avoidance between aircrafts. Considering the time/space synchronous arrival constraint in aircraft cluster cooperative guidance, a multi-constraint cooperative guidance strategy based on time control is adopted, which meets the requirements of arrival time and miss distance at the same time. On this basis, a cooperative collision avoidance mechanism based on conflict triggering is introduced, and a cooperative adjustment strategy that considers collision avoidance and cooperative attack is proposed. And a cooperative guidance method satisfying collision avoidance and spatio-temporal synchronization is obtained. The simulation results show that the proposed aircraft cluster cooperative guidance method considering collision avoidance constraints ensures safe distance constraints between aircrafts and has strong aircraft cluster cooperative time control ability and high guidance accuracy. It requires less iterative calculation, reduces the requirements for airborne processors, and provides a solution to the collision avoidance problem in aircraft cluster cooperative attack. This method has strong engineering application value.
PENG J , ZHANG P , ZHENG L X , et al. UAV positioning based on multi-sensor fusion [J ] . IEEE Access , 2020 , 8 : 34455 - 34467 . DOI: 10.1109/Access.6287639 http://doi.org/10.1109/Access.6287639 https://ieeexplore.ieee.org/xpl/RecentIssue.jsp?punumber=6287639 https://ieeexplore.ieee.org/xpl/RecentIssue.jsp?punumber=6287639
LU S Y , ZHI Y S , ZHANG S M , et al. Semi-direct monocular SLAM with three levels of parallel optimizations [J ] . IEEE Access , 2021 , 9 : 86801 - 86810 . DOI: 10.1109/ACCESS.2021.3071921 http://doi.org/10.1109/ACCESS.2021.3071921 https://ieeexplore.ieee.org/document/9398863/ https://ieeexplore.ieee.org/document/9398863/
MUNGUIA R , TRUJILLO J C , GUERRA E , et al. A hybrid visual-based SLAM architecture: local filter-based SLAM with keyframe-based global mapping [J ] . Sensors , 2021 , 22 ( 1 ): 210 . DOI: 10.3390/s22010210 http://doi.org/10.3390/s22010210 https://www.mdpi.com/1424-8220/22/1/210 https://www.mdpi.com/1424-8220/22/1/210 This work presents a hybrid visual-based SLAM architecture that aims to take advantage of the strengths of each of the two main methodologies currently available for implementing visual-based SLAM systems, while at the same time minimizing some of their drawbacks. The main idea is to implement a local SLAM process using a filter-based technique, and enable the tasks of building and maintaining a consistent global map of the environment, including the loop closure problem, to use the processes implemented using optimization-based techniques. Different variants of visual-based SLAM systems can be implemented using the proposed architecture. This work also presents the implementation case of a full monocular-based SLAM system for unmanned aerial vehicles that integrates additional sensory inputs. Experiments using real data obtained from the sensors of a quadrotor are presented to validate the feasibility of the proposed approach.
WANG H C , WANG Z , ZHANG L , et al. A highly stable fusion positioning system of smartphone under NLOS acoustic indoor environment [J ] . ACM Transactions on Internet Technology , 2023 , 23 ( 2 ): 1 - 19 .
XU C , HE J , LI Y Y , et al. Optimal estimation and fundamental limits for target localization using IMU/TOA fusion method [J ] . IEEE Access , 2019 , 7 : 28124 - 28136 . DOI: 10.1109/ACCESS.2019.2902127 http://doi.org/10.1109/ACCESS.2019.2902127 https://ieeexplore.ieee.org/document/8654628/ https://ieeexplore.ieee.org/document/8654628/
ZOU A R , HU W W , LUO Y H , et al. An improved UWB/IMU tightly coupled positioning algorithm study [J ] . Sensors , 2023 , 23 ( 13 ): 5918 . DOI: 10.3390/s23135918 http://doi.org/10.3390/s23135918 https://www.mdpi.com/1424-8220/23/13/5918 https://www.mdpi.com/1424-8220/23/13/5918 The combination of ultra-wide band (UWB) and inertial measurement unit (IMU) positioning is subject to random errors and non-line-of-sight errors, and in this paper, an improved positioning strategy is proposed to address this problem. The Kalman filter (KF) is used to pre-process the original UWB measurements, suppressing the effect of range mutation values of UWB on combined positioning, and the extended Kalman filter (EKF) is used to fuse the UWB measurements with the IMU measurements, with the difference between the two measurements used as the measurement information. The non-line-of-sight (NLOS) measurement information is also used. The optimal estimate is obtained by adjusting the system measurement noise covariance matrix in real time, according to the judgment result, and suppressing the interference of non-line-of-sight factors. The optimal estimate of the current state is fed back to the UWB range value in the next state, and the range value is dynamically adjusted after one-dimensional filtering pre-processing. Compared with conventional tightly coupled positioning, the positioning accuracy of the method in this paper is improved by 46.15% in the field experimental positioning results.
LI B B , HAO Z J , DANG X C . An indoor location algorithm based on kalman filter fusion of ultra-wide band and inertial measurement unit [J ] . AIP Advances , 2019 , 9 ( 8 ): 085210 . DOI: 10.1063/1.5117341 http://doi.org/10.1063/1.5117341 https://pubs.aip.org/adv/article/9/8/085210/128346/An-indoor-location-algorithm-based-on-Kalman https://pubs.aip.org/adv/article/9/8/085210/128346/An-indoor-location-algorithm-based-on-Kalman Indoor positioning technology has been widely used in today’s life, but due to the influence of multipath effect, the positioning signal is attenuated or even interrupted seriously, resulting in obvious reduction or even failure of positioning accuracy. Therefore, the emerging multi-sensor joint positioning has become the general trend of the development of positioning technology, in which Ultra-Wide Band (UWB) and Inertial Measurement Unit (IMU) have their own features in positioning and navigation. So this paper combines the advantages of UWB and IMU to achieve accurate positioning in complex environment. Firstly, the signal transmission law in complex environment is obtained by distinguishing Line of Sight (LOS) from NLOS (Non Line of Sight) environment. Secondly, the maximum likelihood estimation algorithm is used to eliminate the influence of NLOS on the transmitted signal, and then the extended Kalman filter information fusion strategy is used. The ranging information of UWB and the angle information of IMU are fused to realize the accurate positioning of UWB in complex environment. Finally, the experimental results show that the performance of the joint positioning proposed in this paper is obviously better than that of a single sensor compared with single UWB and single IMU positioning. It provides more solutions for accurate indoor positioning of multi-sensor fusion.
夏楠 , 邱天爽 , 李景春 , 等 . 一种卡尔曼滤波与粒子滤波相结合的非线性滤波算法 [J ] . 电子学报 , 2013 , 41 ( 1 ): 148 - 152 . DOI: 10.3969/j.issn.0372-2112.2013.01.026 http://doi.org/10.3969/j.issn.0372-2112.2013.01.026 提出一种基于卡尔曼滤波与粒子滤波的非线性滤波算法.这种方法对于状态变量服从线性变化而观测方程为非线性的动态系统模型具有显著的效果.首先使用粒子滤波对状态变量进行初估计,然后对估计结果进行卡尔曼滤波,另外推导出该系统模型下状态变量估计误差的克拉美劳下界.通过计算复杂度分析及仿真实验验证,表明新方法与标准粒子滤波算法复杂度相当,但参数估计精度要高于标准粒子滤波以及扩展卡尔曼滤波算法,估计误差甚至要低于系统模型的克拉美劳下界.
XIA N , QIU T S , LI J C , et al. A nonlinear filtering algorithm combining the kalman filter and the particle filter [J ] . Acta Electronica Sinica , 2013 , 41 ( 1 ): 148 - 152 . (in Chinese) DOI: 10.3969/j.issn.0372-2112.2013.01.026 http://doi.org/10.3969/j.issn.0372-2112.2013.01.026 A nonlinear filtering algorithm is proposed based on the Kalman filter and the particle filter.The method can provide significant performance for dynamic nonlinear system which is consist of linear state equation and nonlinear measurement equation.Firstly,the particle filter is utilized for initial estimation of the state variables,and then the Kalman filter is performed.The Cramer-Rao Bound is derived for the nonlinear model.Computation complexity analysis and numerical simulations demonstrate that the proposed algorithm has the same complexity as the standard particle filter,but the estimation accuracy is higher than the standard particle filter and the extended Kalman filter.The estimation error is even lower than the Cramer-Rao Bound of the system model.
刘燕 , 张健 , 肖庆高 , 等 . UKF与EKF在导航定位中的对比研究 [J ] . 微处理机 , 2023 , 44 ( 4 ): 30 - 33 .
LIU Y , ZHANG J , XIAO Q G , et al. A comparative study of UKF and EKF in navigation and positioning [J ] . Microprocessors , 2023 , 44 ( 4 ): 30 - 33 . (in Chinese)
刘向阳 . 几种典型非线性滤波算法及性能分析 [J ] . 舰船电子工程 , 2019 , 39 ( 7 ): 32 - 36 .
LIU X Y . Several typical nonlinear filtering algorithms and performance analysis [J ] . Ship Electronic Engineering , 2019 , 39 ( 7 ): 32 - 36 . (in Chinese)
HU E W , DENG Z L , XU Q Q , et al. Relative entropy-based kalman filter for seamless indoor/outdoor multi-source fusion positioning with INS/TC-OFDM/GNSS [J ] . Cluster Computing , 2018 , 22 ( S4 ): 8351 - 8361 . DOI: 10.1007/s10586-018-1803-1 http://doi.org/10.1007/s10586-018-1803-1
高嵩 , 宋佳鹏 , 房穹 , 等 . 抗差自适应容积卡尔曼滤波在UWB室内定位中的应用 [J ] . 导航定位学报 , 2023 , 11 ( 1 ): 142 - 147 .
GAO S , SONG J P , FANG Q , et al. Application of adaptively robust cubature kalman filter in UWB indoor location [J ] . Journal of Navigation and Positioning , 2023 , 11 ( 1 ): 142 - 147 . (in Chinese)
徐阳扬 , 陈明 , 赵艳 , 等 . 基于粒子滤波的室内机器人定位加速收敛算法 [J ] . 电子设计工程 , 2023 , 31 ( 14 ): 6 - 11 .
XU Y Y , CHEN M , ZHAO Y , et al. Speedup convergence algorithm for robot indoor localization based on particle filter [J ] . Electronic Design Engineering , 2023 , 31 ( 14 ): 6 - 11 . (in Chinese)
苏佳 , 杨泽超 , 易卿武 , 等 . 基于遗传算法优化BP神经网络的GNSS干扰源定位技术 [J/OL ] . 无线电工程 , 2023 ( 2023-08-29 )[ 2023-12-06 ] . http://kns.cnki.net/kcms/detail/13.1097.TN.20230829.1520.006.html http://kns.cnki.net/kcms/detail/13.1097.TN.20230829.1520.006.html http://kns.cnki.net/kcms/detail/13.1097.TN.20230829.1520.006.html.
SU J , YANG Z C , YI Q W , et al. GNSS interference source localization technology based on genetic algorithm optimized BP neural network [J/OL ] . Radio Engineering , 2023 ( 2023-08-29 )[ 2023-12-06 ] . http://kns.cnki.net/kcms/detail/13.1097.TN.20230829.1520.006.html http://kns.cnki.net/kcms/detail/13.1097.TN.20230829.1520.006.html http://kns.cnki.net/kcms/detail/13.1097.TN.20230829.1520.006.html. (in Chinese)
CHU P , ZHANG H , CHEN Y R , et al. Multi-source data high-performance indoor positioning considering genetic optimization neural network algorithm [J ] . Mathematical Problems in Engineering , 2022 , 2022 ( 9 ): 1 - 11 .
鱼瑜 , 吴明亮 , 张来喜 , 等 . 多传感器融合定位方法探讨 [J ] . 导航定位学报 , 2023 , 11 ( 5 ): 151 - 163 .
YU Y , WU M L , ZHANG L X , et al. Discussion on positioning methods of multi-sensor fusion [J ] . Journal of Navigation and Positioning , 2023 , 11 ( 5 ): 151 - 163 . (in Chinese)
冯硕 . 基于UWB与深度学习融合的单基站定位算法 [D ] . 海口 : 海南大学 , 2022 .
FENG S . Single base station location algorithm based on UWB and deep learning [D ] . Haikou : Hainan University , 2022 . (in Chinese)
李玉柏 , 孙迅 . 基于迁移学习提高WiFi室内定位中信道状态信息指纹库的鲁棒性 [J ] . 电子与信息学报 , 2023 , 45 ( 10 ): 3657 - 3666 .
LI Y B , SUN X . A highly robust indoor location algorithm using WiFi channel state information based on transfer learning reinforcement [J ] . Journal of Electronics & Information Technology , 2023 , 45 ( 10 ): 3657 - 3666 . (in Chinese)
CARRIO A , SAMPEDRO C , RODRIGUEZ-RAMOS A , et al. A review of deep learning methods and applications for unmanned aerial vehicles [J ] . Journal of Sensors , 2017 ( 2 ): 1 - 13 .
吴杰宏 , 李丹阳 . 无人机集群编队控制方法研究综述 [J ] . 无线电通信技术 , 2023 , 49 ( 4 ): 589 - 596 .
WU J H , LI D Y . A review of UAV cluster formation control methods [J ] . Radio Communications Technology , 2023 , 49 ( 4 ): 589 - 596 . (in Chinese)
武成锋 , 程进 , 郭晓云 , 等 . 飞行器集群协同定位与导航对抗技术发展与展望 [J ] . 宇航学报 , 2022 , 43 ( 2 ): 131 - 142 .
WU C F , CHENG J , GUO X Y , et al. Development and prospect of aircraft clusters cooperative positioning and navigation countermeasures technology [J ] . Journal of Astronautics , 2022 , 43 ( 2 ): 131 - 142 . (in Chinese)
ZHU X D , LAI J Z , ZHOU B C , et al. Weight factor graph co-location method for UAV formation based on navigation performance evaluation [J ] . IEEE Sensors Journal , 2023 , 23 ( 12 ): 13037 - 13051 . DOI: 10.1109/JSEN.2023.3252019 http://doi.org/10.1109/JSEN.2023.3252019 https://ieeexplore.ieee.org/document/10077540/ https://ieeexplore.ieee.org/document/10077540/
TANG C K , WANG C , ZHANG L L , et al. Geometric-manifold-assisted distributed navigation probabilistic information fusion cooperative positioning algorithm [J ] . Remote Sensing , 2021 , 13 ( 24 ): 4987 . DOI: 10.3390/rs13244987 http://doi.org/10.3390/rs13244987 https://www.mdpi.com/2072-4292/13/24/4987 https://www.mdpi.com/2072-4292/13/24/4987 Positioning information is the cornerstone of a new generation of electronic information technology applications represented by the Internet of Things and smart city. However, due to various environmental electromagnetic interference, building shielding, and other factors, the positioning source can fail. Cooperative positioning technology can realize the sharing of positioning information and make up for the invalid positioning source. When one node in the cooperative positioning network has error, the positioning stability of all nodes in the whole cooperative network will be significantly reduced, but the positioning probability information technology can effectively reduce the impact of mutation error. Based on this idea, this paper proposes an information-geometry-assisted distributed algorithm for probabilistic cooperative fusion positioning (IG-CP) of navigation information. The position information of different types of navigation sources is utilized to establish a probability density model, which effectively reduces the influence of a single position error on the whole cooperative position network. Combined with the nonlinear fitting characteristics of the information geometric manifold, mapping and fusion of the ranging information between cooperative nodes on the geometric manifold surface are conducted to achieve cooperative positioning, which can effectively improve the stability of the positioning results. The proposed algorithm is simulated and analyzed in terms of the node positioning error, ranging error, convergence speed, and distribution of the cooperative positioning network. The simulation results show that our proposed cooperative positioning algorithm can effectively improve the positioning stability and display better positioning performance.
朱徐东 , 赖际舟 , 周本川 , 等 . 基于构型寻优的多无人机鲁棒自适应协同定位方法 [J ] . 中国惯性技术学报 , 2023 , 31 ( 7 ): 650 - 658 ,64.
ZHU X D , LAI J Z , ZHOU B C , et al. Robust adaptive cooperative localization method for multiple UAVs based on configuration optimization [J ] . Journal of Chinese Inertial Technology , 2023 , 31 ( 7 ): 650 - 658 ,64. (in Chinese)
朱奎宝 , 温紫晴 , 狄世彦 , 等 . 多机器人系统的可观测性及协同定位精度分析 [J/OL ] . 电讯技术 , 2023 ( 2023-06-05 )[ 2023-12-06 ] . https://doi.org/10.20079/j.issn.1001-893x.230417003 https://doi.org/10.20079/j.issn.1001-893x.230417003 . https://doi.org/10.20079/j.issn.1001-893x.230417003 https://doi.org/10.20079/j.issn.1001-893x.230417003
ZHU K B , WEN Z Q , DI S Y , et al. Observability and co-positioning accuracy analysis of multi-robot systems [J/OL ] . Telecommunication Engineering , 2023 ( 2023-06-05 )[ 2023-12-06 ] . https://doi.org/10.20079/j.issn.1001-893x.230417003 https://doi.org/10.20079/j.issn.1001-893x.230417003 . (in Chinese) https://doi.org/10.20079/j.issn.1001-893x.230417003 https://doi.org/10.20079/j.issn.1001-893x.230417003
刘杨 . 多AUV协同导航优化算法与编队构型设计 [D ] . 哈尔滨 : 哈尔滨工程大学 , 2015 .
LIU Y . Optimized algorithm of multi-AUV cooperative navigation system and design of its formation configuration [D ] . Harb in:Harbin Engineering University, 2015 . (in Chinese)
LIU W L , WU S T , WU X L . Relative navigation of missile formation and INS error correction methods [C ] // Proceedings of the 2017 29th Chinese Control and Decision Conference. Chongqing , China : IEEE , 2017 .
王小刚 , 郭继峰 , 崔乃刚 . 基于数据链的智能导弹协同定位方法 [J ] . 中国惯性技术学报 , 2009 , 17 ( 3 ): 319 - 323 .
WANG X G , GUO J F , CUI N G . Cooperative localization approach to intelligent missile based on data link [J ] . Journal of Chinese Inertial Technology , 2009 , 17 ( 3 ): 319 - 323 . (in Chinese)
GONG Z , WANG M G , HE J G , et al. A robust adaptive control algorithm for multimissile cooperative formation [J ] . International Journal of Aerospace Engineering , 2022 , 2022 : 5483667 .
闵海根 , 李尧 , 汪建球 , 等 . 考虑通信时延的智能网联汽车协同定位方法 [J ] . 中国公路学报 , 2023 , 36 ( 6 ): 220 - 234 . DOI: 10.19721/j.cnki.1001-7372.2023.06.019 http://doi.org/10.19721/j.cnki.1001-7372.2023.06.019 为了满足网联环境下自动驾驶车辆安全行驶的需求,必须实现车辆全时空高精度定位。针对单车定位(Single Vehicle Localization, SVL)方法的不足,提出了一种基于双层滤波结构的智能网联汽车协同定位框架。首先,基于卡尔曼滤波对各车辆状态进行修正;然后设计基于联邦卡尔曼滤波的协同定位估计方法,通过构建一个主滤波器和多个局部滤波器,将本车状态与修正后的邻车状态进行融合;使用多种数据拟合方法,基于真实数据构建传输时延概率模型,基于高斯分布构建处理时延概率模型;此外,提出一种通信时延误差补偿方法,并融入协同定位框架;最后,设计了5组仿真试验,评估SVL、未进行通信时延误差补偿的协同定位方法(CLWC)和基于通信时延误差补偿的协同定位方法(CLC)的定位性能,并深入分析了速度和行驶方向对定位结果的影响。研究结果表明:在城市道路环境下,CLWC相较于SVL,精度提高了15%~23%;在空旷道路环境下,通信时延较小情况时,CLWC优于SVL,CLC在CLWC基础上将精度进一步提高了5%~13%。在长直道、弯道、隧道等场景,CLC能够保证定位轨迹平滑,精度明显高于SVL,同时进一步验证了存在通信时延情况下,车辆速度对协同定位的影响。所提方法不仅克服了SVL误差累积的缺陷,同时有效降低了通信时延的影响,可为车辆提供连续稳定的高精度位置。
MIN H G , LI Y , WANG J Q , et al. Cooperative localization method for connected and autonomous vehicles considering communication delay [J ] . China Journal of Highway and Transport , 2023 , 36 ( 6 ): 220 - 234 . (in Chinese)
张红娟 , 钱闯 , 招倩莹 , 等 . 顾及通信延迟的车路协同高精度定位 [J/OL ] . 测绘学报 , 2023 ( 2023-06-08 )[ 2023-12-06 ] . http://kns.cnki.net/kcms/detail/11.2089.P.20230608.0903.002.html http://kns.cnki.net/kcms/detail/11.2089.P.20230608.0903.002.html http://kns.cnki.net/kcms/detail/11.2089.P.20230608.0903.002.html.
ZHANG H J , QIAN C , ZHAO Q Y , et al. Vehicle high-precision positioning considering communication delay for intelligent vehicle-infrastructure cooperation system [J/OL ] . Acta Geodaetica et Cartographica Sinica , 2023 ( 2023-06-08 )[ 2023-12-06 ] . http://kns.cnki.net/kcms/detail/11.2089.P.20230608.0903.002.html http://kns.cnki.net/kcms/detail/11.2089.P.20230608.0903.002.html http://kns.cnki.net/kcms/detail/11.2089.P.20230608.0903.002.html. (in Chinese)
卢健 , 陈旭 , 罗毛欣 , 等 . 考虑通信延迟的多自治水下航行器协同定位算法 [J ] . 控制理论与应用 , 2020 , 37 ( 9 ): 2061 - 2072 .
LU J , CHEN X , LUO M X , et al. Cooperative localization algorithm considering of communication delay for autonomous underwater vehicles [J ] . Control Theory & Applications , 2020 , 37 ( 9 ): 2061 - 2072 . (in Chinese)
刘天豪 . 空中自组织网络优化分簇相对定位算法研究 [D ] . 北京 : 中国电子科技集团公司电子科学研究院 , 2019 .
LIU T H . Research on relative location algorithm of optimized clustering for FANET [D ] . Beijing : China Academic of Electronics and Information Technology , 2019 . (in Chinese)
彭宏泽 . 无人机组合导航与多机协同定位研究 [D ] . 长春 : 吉林大学 , 2023 .
PENG H Z . Research on UAV integrated navigation and multi-UAV cooperative localization [D ] . Changchun : Jilin University , 2023 . (in Chinese)
严恭敏 , 翁浚 . 捷联惯导算法与组合导航原理 [M ] . 西安 : 西北工业大学出版社 , 2019 .
YAN G M , WENG J . Inertial navigation algorithm and principle of integrated navigation [M ] . Xi’an : Northwestern Polytechnical University Press , 2019 . (in Chinese)
秦永元 , 张洪钺 , 王叔华 . 卡尔曼滤波与组合导航原理 [M ] . 西安 : 西北工业大学出版社 , 2012 .
QIN Y Y , ZHANG H Y , WANG S H . Kalman filtering and principle of integrated navigation [M ] . Xi’an : Northwestern Polytechnical University Press , 2012 . (in Chinese)
CHENG J , REN P , DENG T X . A novel ranging and IMU-based method for relative positioning of two-MAV formation in GNSS-denied environments [J ] . Sensors (Basel) , 2023 , 23 ( 9 ): 4366 . DOI: 10.3390/s23094366 http://doi.org/10.3390/s23094366 https://www.mdpi.com/1424-8220/23/9/4366 https://www.mdpi.com/1424-8220/23/9/4366 Global Navigation Satellite Systems (GNSS) with weak anti-jamming capability are vulnerable to intentional or unintentional interference, resulting in difficulty providing continuous, reliable, and accurate positioning information in complex environments. Especially in GNSS-denied environments, relying solely on the onboard Inertial Measurement Unit (IMU) of the Micro Aerial Vehicles (MAVs) for positioning is not practical. In this paper, we propose a novel cooperative relative positioning method for MAVs in GNSS-denied scenarios. Specifically, the system model framework is first constructed, and then the Extended Kalman Filter (EKF) algorithm, which is introduced for its ability to handle nonlinear systems, is employed to fuse inter-vehicle ranging and onboard IMU information, achieving joint position estimation of the MAVs. The proposed method mainly addresses the problem of error accumulation in the IMU and exhibits high accuracy and robustness. Additionally, the method is capable of achieving relative positioning without requiring an accurate reference anchor. The system observability conditions are theoretically derived, which means the system positioning accuracy can be guaranteed when the system satisfies the observability conditions. The results further demonstrate the validity of the system observability conditions and investigate the impact of varying ranging errors on the positioning accuracy and stability. The proposed method achieves a positioning accuracy of approximately 0.55 m, which is about 3.89 times higher than that of an existing positioning method.
YANG B , LI J , SHAO Z P , et al. Self-supervised deep location and ranging error correction for UWB localization [J ] . IEEE Sensors Journal , 2023 , 23 ( 9 ): 9549 - 9559 . DOI: 10.1109/JSEN.2023.3258432 http://doi.org/10.1109/JSEN.2023.3258432 https://ieeexplore.ieee.org/document/10087287/ https://ieeexplore.ieee.org/document/10087287/
GULER S , ABDELKADER M , SHAMMA J S . Peer-to-peer relative localization of aerial robots with ultrawideband sensors [J ] . IEEE Transactions on Control Systems Technology , 2021 , 29 ( 5 ): 1981 - 1996 . DOI: 10.1109/TCST.2020.3027627 http://doi.org/10.1109/TCST.2020.3027627 https://ieeexplore.ieee.org/document/9217573/ https://ieeexplore.ieee.org/document/9217573/
杨彬 . 基于MDS的无人机群协同定位算法研究 [D ] . 西安 : 西安电子科技大学 , 2021 .
YANG B . Cooperative localization algorithm of UAV swarm based on MDS [D ] . Xi’an : Xidian University , 2021 . (in Chinese)
0
浏览量
167
下载量
0
CNKI被引量
关联资源
相关文章
相关作者
相关机构
京公网安备11010802024360号