1.基于蓝牙AOA和IMU融合的室内导航定位系统,其特征在于,包括IMU传感器、IMU位置计算单元、蓝牙AOA传感器、蓝牙AOA位置计算单元、融合位置计算单元;
所述IMU传感器安装于载体目标上,用以采集载体运动过程中的三轴加速度数据与三轴角速度数据;
所述IMU位置计算单元与IMU传感器连接,并根据三轴加速度数据与三轴角速度数据对目标进行定位,得到目标的第一定位数据;
所述蓝牙AOA传感器包括固定在目标上的未知发射节点和固定在空间已知位置上的两个基站接收节点,所述未知发射节点用于向空间中发射蓝牙信号数据,所述基站接收节点用于采样所述未知发射节点发射出的蓝牙信号数据获得蓝牙信号采样数据,并将蓝牙信号采样数据发送到所述蓝牙AOA位置计算单元;
所述蓝牙AOA位置计算单元根据所述蓝牙信号采样数据对所述目标进行定位,得到目标的第二定位数据;
所述融合位置计算单元对所述IMU位置计算单元和所述蓝牙AOA位置计算单元的数据进行扩展卡尔曼滤波融合,得到最终的目标定位数据;
所述蓝牙AOA位置计算单元采用基于测角的定位方法,所述测角的定位方法采用一种改进的多重信号分类算法,该算法的步骤包括:(1)基站节点对信号进行采样,获得蓝牙信号采样数据 ;
(2)计算采样数据自相关矩阵 ,并进一步得到前向平滑矩阵 ;
(3)对前向平滑矩阵 进行特征分解,构造空间谱函数 ;
(4)利用空间谱函数进行谱峰搜索,得到信号到达角矩阵 ;
(5)利用到达角数据 重构阵列流形矩阵 ,逆推得到信号自相关矩阵 ;
(6)利用信号自相关矩阵 中,主对角线元素的大小关系,剔除多径信号,得到蓝牙信号到达角度 ;
(7)当基站获得蓝牙信号到达角度数据后,使用三角定位算法计算出载体目标位置坐标;
(8)利用当前时刻与上一时刻的载体目标位置坐标,确定目标当前的航向角信息。
2.如权利要求1所述的基于蓝牙AOA和IMU融合的室内导航定位系统,其特征在于,所述IMU位置计算单元对三轴加速度数据与三轴角速度数据进行处理,用以计算出载体目标的方向姿态信息与位置坐标信息。
3.如权利要求2所述的基于蓝牙AOA和IMU融合的室内导航定位系统,其特征在于,利用三轴加速度计获取目标静止状态下的横滚角 和俯仰角 ,利用三轴陀螺仪获取目标动态下的欧拉角数据,将静止状态和动态下获取的数据进行互补融合。