CN113891270A - 用于提升定位的平滑度与精准度的电子装置及方法 - Google Patents

用于提升定位的平滑度与精准度的电子装置及方法 Download PDF

Info

Publication number
CN113891270A
CN113891270A CN202010632980.2A CN202010632980A CN113891270A CN 113891270 A CN113891270 A CN 113891270A CN 202010632980 A CN202010632980 A CN 202010632980A CN 113891270 A CN113891270 A CN 113891270A
Authority
CN
China
Prior art keywords
module
state
coordinates
coordinate
estimated
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010632980.2A
Other languages
English (en)
Other versions
CN113891270B (zh
Inventor
叶书玮
高柏山
吕巧薇
杨万安
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Quanta Computer Inc
Original Assignee
Quanta Computer Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Quanta Computer Inc filed Critical Quanta Computer Inc
Publication of CN113891270A publication Critical patent/CN113891270A/zh
Application granted granted Critical
Publication of CN113891270B publication Critical patent/CN113891270B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/30—Services specially adapted for particular environments, situations or purposes
    • H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S3/00—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received
    • G01S3/02—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received using radio waves
    • G01S3/14—Systems for determining direction or deviation from predetermined direction
    • G01S3/46—Systems for determining direction or deviation from predetermined direction using antennas spaced apart and measuring phase or time difference between signals therefrom, i.e. path-difference systems
    • G01S3/48—Systems for determining direction or deviation from predetermined direction using antennas spaced apart and measuring phase or time difference between signals therefrom, i.e. path-difference systems the waves arriving at the antennas being continuous or intermittent and the phase difference of signals derived therefrom being measured
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
    • G01S5/017—Detecting state or type of motion
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0294—Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/04—Position of source determined by a plurality of spaced direction-finders
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/06—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/021—Services related to particular areas, e.g. point of interest [POI] services, venue services or geofences
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/025—Services making use of location information using location based information parameters
    • H04W4/027—Services making use of location information using location based information parameters using movement velocity, acceleration information
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/029—Location-based management or tracking services
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S3/00—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received
    • G01S3/02—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received using radio waves
    • G01S3/14—Systems for determining direction or deviation from predetermined direction
    • G01S3/46—Systems for determining direction or deviation from predetermined direction using antennas spaced apart and measuring phase or time difference between signals therefrom, i.e. path-difference systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

一种电子装置，包括一室内定位器及一定位引擎服务器。室内定位器具有一数组天线，接收来自一用户装置的一无线信号，依据无线信号时的相位差及时间差，计算无线信号的一到达角。无线信号包括该用户装置的一状态数据。定位引擎服务器将到达角转换为对应于用户装置位置的一坐标，并且将该坐标输入于一交互多模模块。交互多模模块包括一第一状态模块及一第二状态模块，依据用户装置的状态数据，调整赋予该第一状态模块及该第二状态模块的权重值，并且依据该坐标及权重值计算输出一预估坐标。

Description

用于提升定位的平滑度与精准度的电子装置及方法
技术领域
本发明涉及电子装置，特别涉及用于提升定位的平滑度与精准度的电子装置。
背景技术
室内定位无线标签(wireless tag)主要通过其本身具备的无线信号发射器(wireless transmitter)持续地将无线信号发射出来，而由室内定位无线接收器将所接收。室内定位无线接收器将接收的无线信号其内所包含的数据回传至后端定位引擎服务器以运算位置。然往往于量测过程中所定位出来的位置或坐标会有误差产生，一般常见的方式系于定位引擎服务器加入卡尔曼滤波(Kalman Filter：KF)，使得所定位出来的位置或坐标能够更加平滑与精准。
然而，具备室内定位无线卷标的物体在整体移动过程中，时而静止状态、时而为移动状态(例如走路或跑步)。在上述的情境下，以一组卡尔曼滤波器模型无法完全满足物体时而移动时而停止的状态。
发明内容
依据本发明实施例的电子装置，包括一室内定位器以及一定位引擎服务器。该室内定位器具有一数组天线，用以接收来自一用户装置的一无线信号，依据该无线信号时的相位差及时间差，计算该无线信号的一到达角(AOA)；其中，该无线信号包括该用户装置的一状态数据。该数据状态包括该用户装置的移动状态和速度方向。该定位引擎服务器，将该到达角转换为对应于该用户装置的位置的一坐标。该定位引擎服务器执行一交互多模(interacting multiple model：IMM)算法，产生一交互多模模块，并且将该坐标输入于该交互多模模块中。其中，该交互多模模块包括一第一状态模块及一第二状态模块，依据该用户装置的该状态数据，计算调整赋予该第一状态模块及该第二状态模块的权重值，并且依据该坐标及权重值计算输出一预估坐标。
依据本发明实施例的方法，用于提升定位的平滑度与精准度，包括：接收来自一用户装置的一无线信号；依据该无线信号的相位差及时间差，计算该无线信号的一到达角(AOA)；其中，该无线信号包括该用户装置的一状态数据；其中，该状态数据包括该用户装置的移动状态和速度方向；将该到达角转换为对应于该用户装置的位置的一坐标；执行一交互多模(interacting multiple model：IMM)算法，用以产生一交互多模模块；将该坐标输入于该交互多模(interacting multiple model：IMM)模块中；其中，该交互多模模块包括一第一状态模块及一第二状态模块；该交互多模模块依据该用户装置的该状态数据，计算调整赋予该第一状态模块及该第二状态模块的权重值，并且依据该坐标及权重值计算输出一预估坐标。
附图说明
图1为本发明实施例的室内定位系统的示意图。
图2为本发明实施例的卡尔曼滤波器(KF)的预估状态图。
图3为本发明实施例的用于提升定位的平滑度与精准度的方法的流程图。
图4为本发明实施例的图2的量测坐标(Yk+1)与交互多模模块所输出的一预估坐标
Figure BDA0002566443770000021
的比较图。
附图标记列表
100：室内定位系统
102-1、102-n：室内定位器
104：定位引擎服务器
106-1、106-2：室内定位标签
108：无线信号发射器
110：传感器
200、KF：卡尔曼滤波
Yk+1：时间点k+1时的量测值或量测坐标
Figure BDA0002566443770000022
时间点k+1时的预估值或预估坐标
Figure BDA0002566443770000023
时间点k时的预估值或预估坐标
X0|0：初始值或初始坐标
Q：过程噪声
R：高斯白噪声或量测噪声
S300、S302、S304、S306、S308、S310、S312：步骤
400：量测坐标图
402：预估坐标图
410、420：路径
具体实施方式
本发明系参照所附图式进行描述，其中遍及图式上的相同参考数字标示了相似或相同的组件。上述图式并没有依照实际比例大小描绘，其仅仅提供对本发明的说明。一些发明的型态描述于下方作为图解示范应用的参考。这意味着许多特殊的细节，关系及方法被阐述来对这个发明提供完整的了解。无论如何，拥有相关领域通常知识的人将认识到若没有一个或更多的特殊细节或用其他方法，此发明仍然可以被实现。以其他例子来说，众所皆知的结构或操作并没有详细列出以避免对这发明的混淆。本发明并没有被阐述的行为或事件顺序所局限，如有些行为可能发生在不同的顺序亦或同时发生在其他行为或事件之下。此外，并非所有阐述的行为或事件都需要被执行在与现有发明相同的方法之中。
图1为本发明实施例的室内定位系统的示意图。如图1所示，室内定位系统100包括复数室内定位器102-1、…、102-n、一定位引擎服务器104，以及室内定位标签106-1、106-2。在一些实施例中，室内定位标签的数目不限定为2个，本发明系以2个室内定位标签做为例示。以室内定位标签106-1为例，室内定位标签106-1，具有一无线信号发射器108及一传感器110。在一些实施例中，无线信号发射器108系用以周期性地发射蓝芽信标(beacon)。传感器110为一多轴惯性测量单元模块(Inertial measurement unit：IMU)。当无线信号发射器108发出一个蓝芽信标时，其将包含当下传感器110的状态数据(包含室内定位标签106-1的移动状态或速度方向)，并由室内定位器102-1的数组天线所接收。
在一些实施例中，室内定位器102-1、…、102-n可设置于室内的不同位置(例如设置于走廊、走道转角、楼梯、或房间内)，每一室内定位器具有一数组天线，用以接收由室内定位标签106-1、106-2所发射出的无线信号。室内定位器102-1、…、102-n将所接收无线信号转换为IQ取样数据，IQ取样数据中记录着无线信号之正弦波的强度与相位变化，通过数组天线接收无线信号的相位时间差，即可计算出室内定位标签106-1、106-2相对室内定位器的到达角(亦即该无线信号从室内定位标签106-1、106-2传送过来的入射角)，并可进一步将到达角的信息通过网络传送予定位引擎服务器104。
定位引擎服务器104系用以执行(1)一封包接收子程序、(2)一到达角(AOA)数据处理子程序、(3)一坐标位置过滤子程序及(4)一平滑子程序。如图1所示，室内定位器102-1、…、102-n将接收到的无线信号(例如蓝芽信标)转换成到达角数据后，再将到达角数据传送至定位引擎服务器104，由(1)封包接收子程序取得，接着由(2)到达角数据处理子程序将到达角数据转换成对应的一坐标，最后由(3)坐标位置过滤子程序以及(4)平滑子程序将该坐标通过递归滤波以提高坐标的平滑度与精准度。
在定位引擎服务器104的(4)平滑子程序中，定位引擎服务器104首先执行一交互多模(interacting multiple model：IMM)算法，而产生一交互多模模块。之后，定位引擎服务器104将(2)到达角数据处理子程序所输出的坐标输入于该交互多模模块中。交互多模模块的基础为卡尔曼滤波器(Kalman Filter：KF)。换句话说，交互多模模块系由多个卡尔曼滤波器所构成。图2为本发明实施例的卡尔曼滤波器(KF)200的预估状态图。如图2所示，卡尔曼滤波器200为一种最佳的线性最小均方误差预估器，以状态空间模式发展的一种递归式滤波方法，其特点为不储存过去迭代取样时间点的数据，根据所得到当下的量测信号(例如图2中的Yk+1，例如图1室内定位标签106-1当下的坐标)和前一个迭代取样时间点的状态预估值(例如图2中的
Figure BDA0002566443770000041
)，通过卡尔曼滤波器的迭代表达式，可求得当下的状态预估值(例如图2中的
Figure BDA0002566443770000042
)。图2中的X0|0表示输入于卡尔曼滤波器的一初始值(或称一初始坐标)。
在一些实施例中，初始值X0|0为来自(2)到达角数据处理子程序的5笔坐标的平均值(但本发明不限于此)，使得卡尔曼滤波器所输出的预估坐标可较快速地逼近所输入的量测坐标。图2中的Q为递归滤波过程中的过程噪声，R为递归滤波过程中的高斯白噪声或量测噪声。在一些实施例中，可藉由设定过程噪声Q及高斯白噪声R的数值，进而调整卡尔曼滤波器或交互多模模块所输出的预估坐标的准确度或平滑度。
卡尔曼滤波器所预估的目标物(例如图1的室内定位标签106-1)为单一运动状态之物体，若目标物的动/静状态符合卡尔曼滤波器的模型假设时，其追踪效能会显得相当理想。然而，在现实生活中，物体并非只会做单一的运动，而是会有不同运动模式转换，当目标物运动状态改变时(例如由静止状态变为移动状态、或由移动状态变为静止状态)，卡尔曼滤波器无法实时对运动状态的改变做出反应，因而导致滤波器的追踪效能变差。此时，可藉由具有两种或多种不同状态模型的卡尔曼滤波器的交互多模模块，通过不同状态模型间互相切换的方式来反应目标物运动状态的改变。
换句话说，交互多模模块(或称交互多模预估器)是利用多个卡尔曼滤波器同时追踪一个目标物，并且其藉由更新多个卡尔曼滤波器各别的权重来考虑多个模型之间的交互作用。在进行目标追踪时，交互多模模块最大的特性是由接收到的量测信号(例如图2中的Yk+1)来迭代更新每个模型机率。此外，具备多个模型之间的交互作用，相较于单纯地使用卡尔曼滤波器，其能够较适应目标物运动状态之变化，对于追踪目标物有较佳的效果。
因此，在执行图1的定位引擎服务器104的(4)平滑子程序时，该交互多模模块包括一静态模块(stable model)及一动态模块(motion model)，依据该目标物(例如图1的室内定位标签106-1)的该状态数据(即移动状态、速度方向)，计算调整赋予该静态状态模块及该动态模块的权重值，并且依据来自定位引擎服务器104的(2)到达角数据处理子程序的该坐标及权重值计算输出一预估坐标(例如图2的
Figure BDA0002566443770000051
)。在一些实施例中，静态模块为一卡尔曼滤波器，动态模块为另一卡尔曼滤波器。换句话说，交互多模模块包括两个卡尔曼滤波器。在该交互多模模块的递归滤波运算过程中，该静态模块经计算可得到一第一权重值(μ1)，该动态模块经计算可得到一第二权重值(μ2)。当用户装置为停止状态时，该第一权重值(μ1)会大于该第二权重值(μ2)。当该用户装置为移动状态时，该第二权重值(μ2)会大于该第一权重值(μ1)。其中，该第一权重值(μ1)加上该第二权重值(μ2)等于1。一般来说，在一时间点k+1的情况下，该交互多模模块系以以下式子计算得到该静态模型的该第一权重值(μ1)。
Figure BDA0002566443770000052
其中，μ1(k+1)为时间点k+1时该静态模块的该第一权重值，
Figure BDA0002566443770000053
为正规化常数，p12为由该静态模型转换到该动态模型的机率，以及p11(k+1)为时间点k+1时停留在该静态模型的机率。
在一时间点k+1的情况下，该交互多模模块系以以下式子计算得到该动态模型的该第二权重值(μ2)。
Figure BDA0002566443770000061
其中，μ2(k+1)为时间点k+1时该动态模块的该第二权重值，
Figure BDA0002566443770000062
为正规化常数，p21为由该动态模型转换到该静态模型的机率，以及p22(k+1)为时间点k+1时停留在该动态模型的机率。由于在该交互多模模块的递归滤波运算过程中，机率p11(k+1)、p22(k+1)会随着每次的递归滤波运算做更新，因此该第一权重值(μ1)及该第二权重值(μ2)也会随着每次的递归滤波运算做更新。
参考图2，在一时间点k+1，该静态模块依据所输入的量测信号或量测坐标(例如图2中的Yk+1)输出一第一预估坐标
Figure BDA0002566443770000063
(未图式)，该动态模块亦依据所输入的量测信号或量测坐标(例如图2中的Yk+1)输出一第二预估坐标
Figure BDA0002566443770000064
(未图式)，则该预估坐标
Figure BDA0002566443770000065
等于该第一预估坐标
Figure BDA0002566443770000066
乘以该第一权重值(μ1)加上该第二预估坐标
Figure BDA0002566443770000067
乘以该第二权重值(μ2)，亦即
Figure BDA0002566443770000068
在一些实施例中，参照图2，该静态模块接收用户装置(例如图1的室内定位标签106-1)于当下时间点的该坐标，并且将该坐标乘以一第一矩阵，而得到该第一预估坐标；该坐标、该第一预估坐标及该第一矩阵之间的关系系以算式一表示如下：
Figure BDA0002566443770000069
Figure BDA00025664437700000610
其中，
Figure BDA00025664437700000611
为时间点k+1的该第一预估坐标；Yk+1为时间点k+1时对应于该用户装置的位置的该坐标；x、y、z为该第一预估坐标中所包括的位置信息；vx、vy、vz为该第一预估坐标所包括的速度信息；wx、wy、wz、wvx、wvy、wvz为过程噪声或状态噪声。
Figure BDA0002566443770000071
为该静态模块的状态转置矩阵，亦即该第一矩阵。值得注意的是，由于在该静态模块无需考虑所输入的量测信号(例如图2中的Yk+1)的速度信息，因此该静态模块的状态转置矩阵
Figure BDA0002566443770000072
中的第4列第4行、第5列第5行及第6列第6行的数值皆为0。在一些实施例中，可藉由设定wx、wy、wz、wvx、wvy、wvz的数值，进而调整该静态模块所输出的该第一预估坐标的准确度或平滑度。
在一些实施例中，参照图2，该动态模块接收用户装置(例如图1的室内定位标签106-1)于当下时间点的该坐标，并且将该坐标乘以一第二矩阵，而得到该第二预估坐标；该坐标、该第二预估坐标及该第二矩阵之间的关系系以算式二表示如下：
Figure BDA0002566443770000073
Figure BDA0002566443770000074
其中，
Figure BDA0002566443770000075
为时间点k+1的该第二预估坐标；Yk+1为时间点k+1时对应于该用户装置的位置的该坐标；x、y、z为该第二预估坐标中所包括的位置信息；vx、vy、vz为该第二预估坐标所包括的速度信息；wx、wy、wz、wvx、wvy、wvz为过程噪声或量测噪声；dT为递归取样时间间隔。
Figure BDA0002566443770000076
为该动态模块的状态转置矩阵，值得注意的是，由于在该动态模块需考虑所输入的量测信号(例如图2中的Yk+1)的速度信息，因此该静态模块的状态转置矩阵
Figure BDA0002566443770000077
中的第4列第4行、第5列第5行及第6列第6行的数值皆为1。在一些实施例中，可藉由设定wx、wy、wz、wvx、wvy、wvz的数值，进而调整该动态模块所输出的该第二预估坐标的准确度或平滑度。
下表1为本发明实施例的交互多模模块的该静态模块及该动态模块于递归滤波运算过程中所需运用到的矩阵及所需设定的参数。
Figure BDA0002566443770000081
表1
如表1所示，不管是交互多模模块的该静态模块还是该动态模块，皆会是用到相同的单位矩阵P0及量测矩阵H。其中，量测矩阵H系用于取出量测信号(例如图2中的Yk+1)之x、y、z的分量。在一些实施例中，高斯白噪声R1、R2系可设定为如上述表1。其中，高斯白噪声R1意思为该静态模块将x、y、z各轴中每10cm(0.1公尺)的范围订为系统容许的x、y、z个别的误差范围，使系统能获得越准确的值(x、y、z)。相同的，高斯白噪声R2意思为该动态模块将x、y、z各轴中每30cm(0.3公尺)的范围订为系统容许的x、y、z个别的误差范围。须说明的是，上述误差范围系为常态分布。
在过程噪声Q1、Q2中，变异数
Figure BDA0002566443770000082
表示所输入量测信号(例如图2中的Yk+1)在x方向位置的变异数。同理，变异数
Figure BDA0002566443770000083
表示所输入量测信号在y方向位置的变异数，变异数
Figure BDA0002566443770000091
表示所输入量测信号在z方向位置的变异数。变异数
Figure BDA0002566443770000092
表示所输入量测信号(例如图2中的Yk+1)在x方向速度的变异数。同理，变异数
Figure BDA0002566443770000093
表示所输入量测信号在y方向速度的变异数，变异数
Figure BDA0002566443770000094
表示所输入量测信号在z方向速度的变异数。
在一些实施例中，该静态模块的过程噪声Q1中的变异数
Figure BDA0002566443770000095
变异数
Figure BDA0002566443770000096
及变异数
Figure BDA0002566443770000097
系设定为0.0004((0.02)2)，并且变异数
Figure BDA0002566443770000098
变异数
Figure BDA0002566443770000099
及变异数
Figure BDA00025664437700000910
设定为0。在一些实施例中，该动态模块的过程噪声Q2中的变异数
Figure BDA00025664437700000911
变异数
Figure BDA00025664437700000912
及变异数
Figure BDA00025664437700000913
系设定为0.0064((0.08)2)，并且变异数
Figure BDA00025664437700000914
变异数
Figure BDA00025664437700000915
及变异数
Figure BDA00025664437700000916
设定为0.04((0.2)2)。
在一些实施例中，本发明系将该交互多模模块的模型转移机率矩阵
Figure BDA00025664437700000917
设定为一初始机率
Figure BDA00025664437700000918
换句话说，在该交互多模模块的递归过滤运算中，由该静态模块停留在该静态模块的机率系默认为0.97，由动态模块停留在动态模块的机率系默认为0.97，由静态模块转换到动态模块的机率为0.03，并且由动态模块转移到静态模块的机率为0.03。随着交互多模块的递归滤波运算，交互多模块依据所输入的量测信号或量测坐标(即图2的Yk+1)及权重值(即第一权重值(μ1)、第二权重值(μ2))更新该静态模块及该动态模块之间的一模型转移机率矩阵
Figure BDA00025664437700000919
图3为本发明实施例的用于提升定位的平滑度与精准度的方法的流程图。如图3所示，本发明所揭露一种用于提升定位的平滑度与精准度方法，包括：接收来自一用户装置的一无线信号(步骤S300)；通过所接收该无线信号的相位差及时间差，计算该无线信号的一到达角(AOA)(步骤S302)；其中，该无线信号包括该用户装置的一状态数据，该状态数据包括该用户装置的移动状态和速动方向；通过坐标转换，将该到达角转换为对应于该用户装置的位置的一坐标(步骤S304)；执行一交互多模算法(interacting multiple model：IMM)，用以产生一交互多模模块(步骤S306)；将该坐标输入于该交互多模模块中；其中，该交互多模模块包括一第一状态模块及一第二状态模块(步骤S308)；该交互多模模块依据该用户装置的该状态数据，计算调整赋予该第一状态模块及该第二状态模块的权重值(步骤S310)；以及该交互多模模块依据该坐标及权重值计算输出一预估坐标(步骤S312)。
在一些实施例中，图1的室内定位器102-1系执行步骤S300、S302。图1的定位引擎服务器104系执行步骤S304、S306、S308、S310及S312。其中，定位引擎服务器104系通过该交互多模模块执行步骤S308、S310及S312。在一些实施例中，该交互式多模模块系储存在定位引擎服务器104的一储存器中，并且于执行步骤S308、S310及S312时，定位引擎服务器104的一处理器读取储存于该储存器中的该交互式多模模块的算法，用以达成提升定位的平滑度与精准度的目的。
图4为本发明实施例的图2的量测坐标(Yk+1)与交互多模模块所输出的一预估坐标
Figure BDA0002566443770000101
的比较图。如图4所示，量测坐标图400包括一路径410，路径410为图2的量测坐标(Yk+1)依时序排列而成的路径。预估坐标图402包括一路径420，路径420为图2的预估坐标
Figure BDA0002566443770000102
依时序排列而成的路径。明显地，交互多模模块会将较不合理的坐标点进行平滑化，通过量测值与预估值的交互作用下，其得到的最佳之角度误差(Root-Mean-SquareError：RMSE)也相对较小。
虽然本发明的实施例如上述所描述，我们应该明白上述所呈现的只是范例，而不是限制。依据本实施例上述示范实施例的许多改变是可以在没有违反发明精神及范围下被执行。因此，本发明的广度及范围不该被上述所描述的实施例所限制。更确切地说，本发明的范围应该要以以下的申请专利范围及其相等物来定义。尽管上述发明已被一或多个相关的执行来图例说明及描绘，等效的变更及修改将被依据上述规格及附图且熟悉这领域的其他人所想到。此外，尽管本发明的一特别特征已被相关的多个执行之一所示范，上述特征可能由一或多个其他特征所结合，导致可能有需求及有助于任何已知或特别的应用。
本说明书所使用的专业术语只是为了描述特别实施例的目的，并不打算用来作为本发明的限制。除非上下文有明确指出不同，如本处所使用的单数型，一、该及上述的意思系也包含复数型。再者，用词“包括”，“包含”，“(具、备)有”，“设有”，或其变化型不是被用来作为详细叙述，就是作为申请专利范围。而上述用词意思是包含，且在某种程度上意思是等同于用词“包括”。除非有不同的定义，所有本文所使用的用词(包含技术或科学用词)是可以被属于上述发明的技术中拥有一般技术的人士做一般地了解。我们应该更加了解到上述用词，如被定义在众所使用的字典内的用词，在相关技术的上下文中应该被解释为相同的意思。除非有明确地在本文中定义，上述用词并不会被解释成理想化或过度正式的意思。

Claims (11)

1.一种电子装置，包括：
室内定位器，具有一数组天线，用以接收来自用户装置的无线信号，依据该无线信号时的相位差及时间差，计算该无线信号的到达角；其中，该无线信号包括该用户装置的状态数据，该状态数据包括该用户装置的移动状态和速度方向；
定位引擎服务器，将该到达角转换为对应于该用户装置的位置的坐标；其中，该定位引擎服务器执行交互多模算法，产生交互多模模块，并且将该坐标输入于该交互多模模块中；
其中，该交互多模模块包括第一状态模块及第二状态模块，依据该用户装置的该状态数据，计算调整赋予该第一状态模块及该第二状态模块的权重值，并且依据该坐标及权重值计算输出预估坐标。
2.如权利要求1所述的电子装置，其中，该第一状态模块及该第二状态模块依据该用户装置于当下时间点的该坐标及于前一时间点的预估坐标，计算出该用户装置于当下时间点的该预估坐标。
3.如权利要求2所述的电子装置，其中，该第一状态模块具有第一权重值，该第二状态模块具有第二权重值；当该用户装置为停止状态时，该第一权重值会大于该第二权重值；当该用户装置为移动状态时，该第二权重值会大于该第一权重值。
4.如权利要求3所述的电子装置，其中，该第一状态模块输出第一预估坐标，该第二状态模块输出第二预估坐标，该预估坐标等于该第一预估坐标乘以该第一权重值加上该第二预估坐标乘以该第二权重值。
5.如权利要求3所述的电子装置，其中，该第一权重值加上该第二权重值等于1。
6.如权利要求4所述的电子装置，其中，
该第一状态模块接收该用户装置于当下时间点的该坐标，并且将该坐标乘以第一矩阵，而得到该第一预估坐标；该坐标、该第一预估坐标及该第一矩阵之间的关系系以算式一表示如下：
Figure FDA0002566443760000021
其中，
Figure FDA0002566443760000022
为时间点k的该第一预估坐标；Yk为时间点k时对应于该用户装置的位置的该坐标；x、y、z为该第一预估坐标中所包括的位置信息；vx、vy、vz为该第一预估坐标所包括的速度信息；wx、wy、wz、wvx、wvy、wvz为过程噪声或量测噪声；
Figure FDA0002566443760000023
为该第一矩阵。
7.如权利要求4所述的电子装置，其中，
该第二状态模块接收该用户装置于当下时间点的该坐标，并且将该坐标乘以第二矩阵，而得到该第二预估坐标；该坐标、该第二预估坐标及该第二矩阵之间的关系系以算式二表示如下：
Figure FDA0002566443760000024
其中，
Figure FDA0002566443760000025
为时间点k的该第二预估坐标；Yk为时间点k时对应于该用户装置的位置的该坐标；x、y、z为该第一预估坐标中所包括的位置信息；vx、vy、vz为该第二预估坐标所包括的速度信息；wx、wy、wz、wvx、wvy、wvz为过程噪声或量测噪声；dT为递归取样时间间隔；
Figure FDA0002566443760000026
为该第二矩阵。
8.如权利要求1所述的电子装置，其中，该交互多模模块依据该坐标及权重值更新该第一状态模块及该第二状态模块之间的模型转移机率；其中该模型转移机率为：
Figure FDA0002566443760000031
其中，p11为停留在该第一状态模块的机率；p12为由该第一状态模块转换到该第二状态模块的机率；p21为由该第二状态模块转换到该第一状态模块的机率；以及p22为停留在该第二状态模块的机率。
9.一种方法，用于提升定位的平滑度与精准度，包括：
接收来自用户装置的无线信号；
依据该无线信号的相位差及时间差，计算该无线信号的到达角；其中，该无线信号包括该用户装置的状态数据；其中，该状态数据包括该用户装置的移动状态和速度方向；
将该到达角转换为对应于该用户装置的位置的坐标；
执行交互多模算法，用以产生交互多模模块；
将该坐标输入于该交互多模模块中；其中，该交互多模模块包括第一状态模块及第二状态模块；
该交互多模模块依据该用户装置的该状态数据，计算调整赋予该第一状态模块及该第二状态模块的权重值；以及
依据该坐标及权重值计算输出预估坐标。
10.如权利要求9所述的方法，其中，该第一状态模块及该第二状态模块依据当下时间点的该坐标及前一时间点的预估坐标，计算出当下时间点的该预估坐标。
11.如权利要求10所述的方法，其中，该第一状态模块具有第一权重值，该第二状态模块具有第二权重值；当该用户装置为停止状态时，该第一权重值会大于该第二权重值；当该用户装置为移动状态时，该第二权重值会大于该第一权重值；该第一权重值加上该第二权重值等于1。
CN202010632980.2A 2020-06-17 2020-07-02 用于提升定位的平滑度与精准度的电子装置及方法 Active CN113891270B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
TW109120307 2020-06-17
TW109120307A TWI739479B (zh) 2020-06-17 2020-06-17 用於提升定位的平滑度與精準度的電子裝置及定位方法

Publications (2)

Publication Number Publication Date
CN113891270A true CN113891270A (zh) 2022-01-04
CN113891270B CN113891270B (zh) 2024-04-02

Family

ID=78778205

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010632980.2A Active CN113891270B (zh) 2020-06-17 2020-07-02 用于提升定位的平滑度与精准度的电子装置及方法

Country Status (3)

Country Link
US (1) US11290847B2 (zh)
CN (1) CN113891270B (zh)
TW (1) TWI739479B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102663771A (zh) * 2012-03-14 2012-09-12 北京航空航天大学 一种基于协方差交叉的交互式多模型估计方法
CN105611627A (zh) * 2016-01-08 2016-05-25 重庆邮电大学 基于双天线的wlan接入点aoa的估计方法
CN107045125A (zh) * 2017-03-17 2017-08-15 电子科技大学 一种基于预测值量测转换的交互多模型雷达目标跟踪方法
WO2020102184A1 (en) * 2018-11-12 2020-05-22 Qualcomm Incorporated Staggered channel state information reference signal resource sets for tracking used for positioning

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2014049911A1 (ja) * 2012-09-28 2016-08-22 日本電気株式会社 移動通信システム、移動予測装置及びページングエリアの決定方法
TWI692267B (zh) * 2017-09-07 2020-04-21 建漢科技股份有限公司 自主定位系統及其方法
US10587987B2 (en) * 2017-12-07 2020-03-10 SCRRD, Inc. High accuracy tracking and interaction for low observable devices

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102663771A (zh) * 2012-03-14 2012-09-12 北京航空航天大学 一种基于协方差交叉的交互式多模型估计方法
CN105611627A (zh) * 2016-01-08 2016-05-25 重庆邮电大学 基于双天线的wlan接入点aoa的估计方法
CN107045125A (zh) * 2017-03-17 2017-08-15 电子科技大学 一种基于预测值量测转换的交互多模型雷达目标跟踪方法
WO2020102184A1 (en) * 2018-11-12 2020-05-22 Qualcomm Incorporated Staggered channel state information reference signal resource sets for tracking used for positioning

Also Published As

Publication number Publication date
US11290847B2 (en) 2022-03-29
TW202201247A (zh) 2022-01-01
TWI739479B (zh) 2021-09-11
CN113891270B (zh) 2024-04-02
US20210400435A1 (en) 2021-12-23

Similar Documents

Publication Publication Date Title
CN107426687B (zh) 面向WiFi/PDR室内融合定位的自适应卡尔曼滤波方法
US9763035B2 (en) System, method and computer program for anonymous localization
Faragher et al. SmartSLAM-an efficient smartphone indoor positioning system exploiting machine learning and opportunistic sensing
JP2015531053A (ja) 無線マップを動的に作成するためのシステム、方法、及びコンピュータプログラム
Afuosi et al. Indoor positioning based on improved weighted KNN for energy management in smart buildings
CN109379711B (zh) 一种定位方法
CN109655786B (zh) 移动自组网协作相对定位方法及装置
CN112533136B (zh) 一种基于深度学习的wlan指纹定位方法
Potortì et al. The EvAAL evaluation framework and the IPIN competitions
Wang et al. Deep neural network‐based Wi‐Fi/pedestrian dead reckoning indoor positioning system using adaptive robust factor graph model
CN111182460A (zh) 混合型室内定位方法、装置、计算机设备及存储介质
CN113189541B (zh) 一种定位方法、装置及设备
CA2725250A1 (en) System, method and computer program for anonymous localization
Adamkiewicz et al. Improving UWB indoor localization accuracy using sparse fingerprinting and transfer learning
CN113891270B (zh) 用于提升定位的平滑度与精准度的电子装置及方法
Sakr et al. Efficient Wi-Fi signal strength maps using sparse Gaussian process models
KR20140119333A (ko) 위치 정확도 향상을 위한 위치 측위 방법 및 장치
CN114035218A (zh) 融合定位方法、装置、电子设备及存储介质
CN110692260B (zh) 终端设备定位系统和方法
Machaj et al. Impact of radio map on the performance of fingerprinting algorithms
US11832146B2 (en) Electronic device and method for improving angle of arrival of a signal
CN114745674B (zh) 一种基于改进bp神经网络的测距模型定位算法
Wang et al. An improved PDR/WiFi integration method for indoor pedestrian localization
CN113686335B (zh) 通过一维卷积神经网用imu数据进行精确室内定位的方法
JP7334538B2 (ja) 位置推定装置および位置推定方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant