[发明专利]基于GSM/MEMS融合的高精度室内融合定位方法

权利要求书

1.一种基于GSM/MEMS融合的高精度室内融合定位方法，其特征在于，包括以下步骤：

步骤一、选定目标定位区域，设置坐标原点和H个参考点，建立位置指纹坐标系；

步骤二、利用扫频的方式采集GSM信号强度值；利用GSM路测软件，设置不同的预设频点和基站识别色码其中a_i＝1,2,…,N_A,i＝1,2,…f₁，b_j＝1,2,…,N_B,j＝1,2,…f₂；

步骤三、采集并存储所述步骤一中参考点p处在预设频点和基站识别色码下的接收信号强度值p＝1,2…H，直到p＝H时存储完成，构建位置指纹数据库；

步骤四、在线阶段，采集动态行走区域内接收信号强度值RSS^oli，将同一秒中采集到的信号强度序列取均值，按秒为标准进行存储，第t秒采集到的信号强度值对应于步骤二中设置的频点和基站识别色码即

步骤五、运用加权K近邻法算法，将在线阶段采集的接收信号强度与位置指纹数据库进行匹配，得出GSM位置指纹定位结果(x^GSM,y^GSM)；

步骤六、计算加速度计输出的模值和分别表示加速度计输出的3轴加速度，通过检测该模值A_norm为峰值且大于某个设定的阈值A₀来判断跨步，此时累计步数，且在第k步中包含的数据点数为其中，和分别是第k步和第k-1步的加速度计输出模值；

步骤七、由传感器输出频率f_s、每一步间采样点个数ΔN和行人第k步步长P_k，计算行人第k步的步行速度其中，t_k是行人第K步所需的时间；

步骤八、建立导航坐标系与载体坐标系之间的转换关系：

其中：x_n,y_n,z_n对应导航坐标系的东北天坐标轴方向，x_b,y_b,z_b对应载体坐标系的右前上坐标轴方向；是关于四元数s的姿态旋转矩阵，s＝q₀+q₁a₀+q₂b₀+q₃c₀，旋转顺序依次是东-北-天；其中，q_c,c＝0,1,2,3是四元数s中的常数，a₀,b₀,c₀是四元数的三个虚数单位，且a₀·a₀＝b₀·b₀＝c₀·c₀＝-1；

步骤九、利用四元数s表示姿态旋转矩阵若确定旋转四元数能唯一确定姿态旋转矩阵中的各元素；

步骤十、利用三次旋转的欧拉角表示姿态旋转矩阵其中，ψ,θ和γ分别是载体的航向角、俯仰角和横滚角；

步骤十一、根据姿态旋转矩阵的对应关系将欧拉角矩阵转换为四元数表示方式，得出各个欧拉角的四元数表达式：

步骤十二、利用基于四元数的刚体运动方程计算四元数，并建立扩展卡尔曼模型，并利用加速度计和磁力计的输出值修正刚体运动方程中的四元素，更新每一时刻的航向角ψ^MEMS；刚体运动方程为：

式中和是陀螺仪三轴的输出，表示四元素乘法，其中，t为时间，dt表示对时间的微分；

步骤十三、构造融合定位系统的卡尔曼滤波器，分别建立状态方程与观测方程；将步骤五得出的定位结果(x^GSM,y^GSM)，步骤七得出的运动速度v^MEMS和步骤十二得出的航向角ψ^MEMS作为观测信息输入扩展卡尔曼滤波器；

步骤十四、构造等价权函数根据输出的观测残差v_i给观测信息分配不同权重，自适应调整卡尔曼滤波增益并输出最优二维位置估计值(x^opt,y^opt)。