This disclosure relates generally to wireless communications systems. Embodiments of this disclosure relate to methods and apparatuses for device-based indoor positioning using Wi-Fi fine timing measurements.
Indoor positioning has grown in popularity over the last decade in parallel with the growth in the number of personal wireless devices as well as wireless infrastructure. A variety of indoor positioning use cases include smart homes and buildings, surveillance, disaster management, industry and healthcare. All of these require wide availability and good accuracy. Most conventional positioning techniques suffer from one or more drawbacks, including inaccuracy, impracticality, and uncommonness. Ultra-wide band (UWB) wireless technology falls under this broad category. While UWB provides great accuracy, UWB transceivers for use as ranging anchor points are uncommon compared to Wi-Fi, which can be found in most commercial and residential spaces. Given the pervasiveness of Wi-Fi access points and devices, Wi-Fi positioning techniques have become strong contenders for indoor positioning.
Embodiments of the present disclosure provide methods and apparatuses for device-based indoor positioning using Wi-Fi fine timing measurements.
In one embodiment, a method includes scanning for registered fine-time measurement (FTM)-enabled Wi-Fi nodes to generate a list of the FTM-enabled Wi-Fi nodes. The method also includes performing a ranging operation by (i) selecting nodes to range with from the list of the FTM-enabled Wi-Fi nodes and (ii) processing ranging responses from the selected nodes to generate distance measurements. The method further includes estimating a position of a device based on the distance measurements generated from the ranging operation.
In another embodiment, a device includes a transceiver and a processor operably connected to the transceiver. The processor is configured to: scan for registered FTM-enabled Wi-Fi nodes to generate a list of the FTM-enabled Wi-Fi nodes; perform a ranging operation by (i) selecting nodes to range with from the list of the FTM-enabled Wi-Fi nodes and (ii) processing ranging responses from the selected nodes to generate distance measurements; and estimate a position of the device based on the distance measurements generated from the ranging operation.
In another embodiment, a non-transitory computer readable medium includes program code that, when executed by a processor of a device, causes the device to: scan for registered FTM-enabled Wi-Fi nodes to generate a list of the FTM-enabled Wi-Fi nodes; perform a ranging operation by (i) selecting nodes to range with from the list of the FTM-enabled Wi-Fi nodes and (ii) processing ranging responses from the selected nodes to generate distance measurements; and estimate a position of the device based on the distance measurements generated from the ranging operation.
Other technical features may be readily apparent to one skilled in the art from the following figures, descriptions, and claims.
Before undertaking the DETAILED DESCRIPTION below, it may be advantageous to set forth definitions of certain words and phrases used throughout this patent document. The term “couple” and its derivatives refer to any direct or indirect communication between two or more elements, whether or not those elements are in physical contact with one another. The terms “transmit,” “receive,” and “communicate,” as well as derivatives thereof, encompass both direct and indirect communication. The terms “include” and “comprise,” as well as derivatives thereof, mean inclusion without limitation. The term “or” is inclusive, meaning and/or. The phrase “associated with,” as well as derivatives thereof, means to include, be included within, interconnect with, contain, be contained within, connect to or with, couple to or with, be communicable with, cooperate with, interleave, juxtapose, be proximate to, be bound to or with, have, have a property of, have a relationship to or with, or the like. The term “controller” means any device, system or part thereof that controls at least one operation. Such a controller may be implemented in hardware or a combination of hardware and software and/or firmware. The functionality associated with any particular controller may be centralized or distributed, whether locally or remotely. The phrase “at least one of,” when used with a list of items, means that different combinations of one or more of the listed items may be used, and only one item in the list may be needed. For example, “at least one of: A, B, and C” includes any of the following combinations: A, B, C, A and B, A and C, B and C, and A and B and C. As used herein, such terms as “1st” and “2nd,” or “first” and “second” may be used to simply distinguish a corresponding component from another and does not limit the components in other aspect (e.g., importance or order). It is to be understood that if an element (e.g., a first element) is referred to, with or without the term “operatively” or “communicatively”, as “coupled with,” “coupled to,” “connected with,” or “connected to” another element (e.g., a second element), it means that the element may be coupled with the other element directly (e.g., wiredly), wirelessly, or via a third element.
As used herein, the term “module” may include a unit implemented in hardware, software, or firmware, and may interchangeably be used with other terms, for example, “logic,” “logic block,” “part,” or “circuitry”. A module may be a single integral component, or a minimum unit or part thereof, adapted to perform one or more functions. For example, according to an embodiment, the module may be implemented in a form of an application-specific integrated circuit (ASIC).
Moreover, various functions described below can be implemented or supported by one or more computer programs, each of which is formed from computer readable program code and embodied in a computer readable medium. The terms “application” and “program” refer to one or more computer programs, software components, sets of instructions, procedures, functions, objects, classes, instances, related data, or a portion thereof adapted for implementation in a suitable computer readable program code. The phrase “computer readable program code” includes any type of computer code, including source code, object code, and executable code. The phrase “computer readable medium” includes any type of medium capable of being accessed by a computer, such as read only memory (ROM), random access memory (RAM), a hard disk drive, a compact disc (CD), a digital video disc (DVD), or any other type of memory. A “non-transitory” computer readable medium excludes wired, wireless, optical, or other communication links that transport transitory electrical or other signals. A non-transitory computer readable medium includes media where data can be permanently stored and media where data can be stored and later overwritten, such as a rewritable optical disc or an erasable memory device.
Definitions for other certain words and phrases are provided throughout this patent document. Those of ordinary skill in the art should understand that in many if not most instances, such definitions apply to prior as well as future uses of such defined words and phrases.
For a more complete understanding of the present disclosure and its advantages, reference is now made to the following description taken in conjunction with the accompanying drawings, in which like reference numerals represent like parts:
Aspects, features, and advantages of the disclosure are readily apparent from the following detailed description, simply by illustrating a number of particular embodiments and implementations, including the best mode contemplated for carrying out the disclosure. The disclosure is also capable of other and different embodiments, and its several details can be modified in various obvious respects, all without departing from the spirit and scope of the disclosure. Accordingly, the drawings and description are to be regarded as illustrative in nature, and not as restrictive. The disclosure is illustrated by way of example, and not by way of limitation, in the figures of the accompanying drawings.
The present disclosure covers several components which can be used in conjunction or in combination with one another or can operate as standalone schemes. Certain embodiments of the disclosure may be derived by utilizing a combination of several of the embodiments listed below. Also, it should be noted that further embodiments may be derived by utilizing a particular subset of operational steps as disclosed in each of these embodiments. This disclosure should be understood to cover all such embodiments.
The wireless network 100 includes access points (APs) 101 and 103. The APs 101 and 103 communicate with at least one network 130, such as the Internet, a proprietary Internet Protocol (IP) network, or other data network. The AP 101 provides wireless access to the network 130 for a plurality of stations (STAs) 111-114 within a coverage area 120 of the AP 101. The APs 101-103 may communicate with each other and with the STAs 111-114 using Wi-Fi or other WLAN communication techniques. The STAs 111-114 may communicate with each other using peer-to-peer protocols, such as Tunneled Direct Link Setup (TDLS).
Depending on the network type, other well-known terms may be used instead of “access point” or “AP,” such as “router” or “gateway.” For the sake of convenience, the term “AP” is used in this disclosure to refer to network infrastructure components that provide wireless access to remote terminals. In WLAN, given that the AP also contends for the wireless channel, the AP may also be referred to as a STA. Also, depending on the network type, other well-known terms may be used instead of “station” or “STA,” such as “mobile station,” “subscriber station,” “remote terminal,” “user equipment,” “wireless terminal,” or “user device.” For the sake of convenience, the terms “station” and “STA” are used in this disclosure to refer to remote wireless equipment that wirelessly accesses an AP or contends for a wireless channel in a WLAN, whether the STA is a mobile device (such as a mobile telephone or smartphone) or is normally considered a stationary device (such as a desktop computer, AP, media player, stationary sensor, television, etc.).
Dotted lines show the approximate extents of the coverage areas 120 and 125, which are shown as approximately circular for the purposes of illustration and explanation only. It should be clearly understood that the coverage areas associated with APs, such as the coverage areas 120 and 125, may have other shapes, including irregular shapes, depending upon the configuration of the APs and variations in the radio environment associated with natural and man-made obstructions.
As described in more detail below, one or more of the APs may include circuitry and/or programming for facilitating device-based indoor positioning using Wi-Fi fine timing measurements. Although
The AP 101 includes multiple antennas 204a-204n and multiple transceivers 209a-209n. The AP 101 also includes a controller/processor 224, a memory 229, and a backhaul or network interface 234. The transceivers 209a-209n receive, from the antennas 204a-204n, incoming radio frequency (RF) signals, such as signals transmitted by STAs 111-114 in the network 100. The transceivers 209a-209n down-convert the incoming RF signals to generate IF or baseband signals. The IF or baseband signals are processed by receive (RX) processing circuitry in the transceivers 209a-209n and/or controller/processor 224, which generates processed baseband signals by filtering, decoding, and/or digitizing the baseband or IF signals. The controller/processor 224 may further process the baseband signals.
Transmit (TX) processing circuitry in the transceivers 209a-209n and/or controller/processor 224 receives analog or digital data (such as voice data, web data, e-mail, or interactive video game data) from the controller/processor 224. The TX processing circuitry encodes, multiplexes, and/or digitizes the outgoing baseband data to generate processed baseband or IF signals. The transceivers 209a-209n up-converts the baseband or IF signals to RF signals that are transmitted via the antennas 204a-204n.
The controller/processor 224 can include one or more processors or other processing devices that control the overall operation of the AP 101. For example, the controller/processor 224 could control the reception of forward channel signals and the transmission of reverse channel signals by the transceivers 209a-209n in accordance with well-known principles. The controller/processor 224 could support additional functions as well, such as more advanced wireless communication functions. For instance, the controller/processor 224 could support beam forming or directional routing operations in which outgoing signals from multiple antennas 204a-204n are weighted differently to effectively steer the outgoing signals in a desired direction. The controller/processor 224 could also support OFDMA operations in which outgoing signals are assigned to different subsets of subcarriers for different recipients (e.g., different STAs 111-114). Any of a wide variety of other functions could be supported in the AP 101 by the controller/processor 224 including facilitating device-based indoor positioning using Wi-Fi fine timing measurements. In some embodiments, the controller/processor 224 includes at least one microprocessor or microcontroller. The controller/processor 224 is also capable of executing programs and other processes resident in the memory 229, such as an OS. The controller/processor 224 can move data into or out of the memory 229 as required by an executing process.
The controller/processor 224 is also coupled to the backhaul or network interface 234. The backhaul or network interface 234 allows the AP 101 to communicate with other devices or systems over a backhaul connection or over a network. The interface 234 could support communications over any suitable wired or wireless connection(s). For example, the interface 234 could allow the AP 101 to communicate over a wired or wireless local area network or over a wired or wireless connection to a larger network (such as the Internet). The interface 234 includes any suitable structure supporting communications over a wired or wireless connection, such as an Ethernet or RF transceiver. The memory 229 is coupled to the controller/processor 224. Part of the memory 229 could include a RAM, and another part of the memory 229 could include a Flash memory or other ROM.
As described in more detail below, the AP 101 may include circuitry and/or programming for facilitating device-based indoor positioning using Wi-Fi fine timing measurements. Although
The STA 111 includes antenna(s) 205, transceiver(s) 210, a microphone 220, a speaker 230, a processor 240, an input/output (I/O) interface (IF) 245, an input 250, a display 255, and a memory 260. The memory 260 includes an operating system (OS) 261 and one or more applications 262.
The transceiver(s) 210 receives from the antenna(s) 205, an incoming RF signal (e.g., transmitted by an AP 101 of the network 100). The transceiver(s) 210 down-converts the incoming RF signal to generate an intermediate frequency (IF) or baseband signal. The IF or baseband signal is processed by RX processing circuitry in the transceiver(s) 210 and/or processor 240, which generates a processed baseband signal by filtering, decoding, and/or digitizing the baseband or IF signal. The RX processing circuitry sends the processed baseband signal to the speaker 230 (such as for voice data) or is processed by the processor 240 (such as for web browsing data).
TX processing circuitry in the transceiver(s) 210 and/or processor 240 receives analog or digital voice data from the microphone 220 or other outgoing baseband data (such as web data, e-mail, or interactive video game data) from the processor 240. The TX processing circuitry encodes, multiplexes, and/or digitizes the outgoing baseband data to generate a processed baseband or IF signal. The transceiver(s) 210 up-converts the baseband or IF signal to an RF signal that is transmitted via the antenna(s) 205.
The processor 240 can include one or more processors and execute the basic OS program 261 stored in the memory 260 in order to control the overall operation of the STA 111. In one such operation, the processor 240 controls the reception of forward channel signals and the transmission of reverse channel signals by the transceiver(s) 210 in accordance with well-known principles. The processor 240 can also include processing circuitry configured to facilitate device-based indoor positioning using Wi-Fi fine timing measurements. In some embodiments, the processor 240 includes at least one microprocessor or microcontroller.
The processor 240 is also capable of executing other processes and programs resident in the memory 260, such as operations for facilitating device-based indoor positioning using Wi-Fi fine timing measurements. The processor 240 can move data into or out of the memory 260 as required by an executing process. In some embodiments, the processor 240 is configured to execute a plurality of applications 262, such as applications for facilitating device-based indoor positioning using Wi-Fi fine timing measurements. The processor 240 can operate the plurality of applications 262 based on the OS program 261 or in response to a signal received from an AP. The processor 240 is also coupled to the I/O interface 245, which provides STA 111 with the ability to connect to other devices such as laptop computers and handheld computers. The I/O interface 245 is the communication path between these accessories and the processor 240.
The processor 240 is also coupled to the input 250, which includes for example, a touchscreen, keypad, etc., and the display 255. The operator of the STA 111 can use the input 250 to enter data into the STA 111. The display 255 may be a liquid crystal display, light emitting diode display, or other display capable of rendering text and/or at least limited graphics, such as from web sites. The memory 260 is coupled to the processor 240. Part of the memory 260 could include a random-access memory (RAM), and another part of the memory 260 could include a Flash memory or other read-only memory (ROM).
Although
As discussed above, indoor positioning has grown in popularity over the last decade in parallel with the growth in the number of personal wireless devices as well as wireless infrastructure. A variety of indoor positioning use cases include smart homes and buildings, surveillance, disaster management, industry and healthcare. All of these require wide availability and good accuracy. Most conventional positioning techniques suffer from one or more drawbacks, including inaccuracy, impracticality, and uncommonness. Ultra-wide band (UWB) wireless technology falls under this broad category. While UWB provides great accuracy, UWB transceivers for use as ranging anchor points are uncommon compared to Wi-Fi, which can be found in most commercial and residential spaces. Given the pervasiveness of Wi-Fi access points and devices, Wi-Fi positioning techniques have become strong contenders for indoor positioning. In particular, Wi-Fi round-trip time (RTT) has arguably become the strongest contender for indoor positioning. Furthermore, Wi-Fi RTT standardizes the Fine Timing Measurement (FTM) mechanism for accurate ranging.
Fine Timing Measurement (FTM) is a wireless network management procedure, defined in IEEE 802.11-2016 (unofficially known to be defined under 802.11mc), that allows a Wi-Fi station (STA) to accurately measure the distance from other Wi-Fi nodes (e.g., STAs or APs) by measuring the RTT between the two.
In an example where a STA measures its distance from other STAs, a STA wanting to localize itself (known as the initiating STA) with respect to other STAs (known as responding STAs) schedules an FTM session during which the STAs exchange messages and measurements. The FTM session includes three phases: negotiation, measurement, and termination.
In the negotiation phase, the initiating STA negotiates key parameters with the responding STA, such as frame format and bandwidth, number of bursts, burst duration, the burst period, and the number of measurements per burst. The negotiation starts when the initiating STA sends an FTM Request frame (a Management frame with subtype Action) called Initial FTM Request frame to the responding STA. The Initial FTM Request frame contains the negotiated parameters and their values in the frame's FTM Parameters element. The responding STA responds with an FTM frame called Initial FTM frame, which either approves of or overwrites the parameter values proposed by the initiating STA.
The measurement phase includes one or more bursts, and each burst includes one or more Fine Time measurements. The duration of a burst and the number of measurements therein are defined by the parameters Burst Duration and FTMs Per Burst. The bursts are separated by an interval defined by the parameter Burst Duration.
As shown in
The R-STA 504 then sends the first FTM frame 510 to the I-STA 502 and captures the time it is sent t1(1). Upon receiving the first FTM frame 510, the I-STA 502 captures the time it was received t2(1). The I-STA 502 responds with an ACK 512, and captures the time it is sent t3(1). Upon receiving the ACK 512, the R-STA 504 captures the time it was received t4(1).
The R-STA 504 sends a second FTM frame 514 to the I-STA 502 and captures the time it is sent t1(2). The purpose of the second FTM frame 514 is twofold: First, the second FTM frame 514 is a follow-up to the first FTM frame 510, i.e., it is used to transfer the timestamps t1(1) and t4(1) recorded by the R-STA 504. Second, the second FTM frame 514 starts a second measurement. Upon receiving the second FTM frame 514, the I-STA 502 extracts the timestamps t1(1) and t4(1) and computes the RTT according to the following equation:
RTT=(t4(1)−t1(1))−(t3(1)−t2(1)).
The I-STA 502 also responds with an ACK 516, and captures the time the second FTM frame 514 was received t2(2).
The two STAs 502 and 504 continue exchanging FTM frames and ACKs for as many measurements as has been negotiated between the two. In the measurement phase 500, this includes a third FTM frame 518 and a third ACK 520.
In order to be useful for positioning and proximity apps, the RTT between the two STAs can be translated into a distance, such as by the following equation:
where d is the distance between the two STAs and c is the speed of light.
Each FTM of the burst will yield a distance sample, with multiple distance samples per burst. Given multiple FTM bursts and multiple measurements per burst, the distance samples can be combined in different ways to produce a representative distance measurement. For example, the mean distance, the median distance, or some other percentile of distance can be reported. Furthermore, other statistics (e.g., the standard deviation) could be reported as well to be used by the positioning algorithm.
Trilateration
There are many ways to solve the problem mathematically, employing both linear and non-linear methods. One common method is to define a non-linear least squares problem with the following objective function:
where fa(p) is the distance between the object, currently at a position p, and anchor point a. The position p* would then be obtained by minimizing the objective function F(p) using general methods, e.g., Gauss-Newton or Levenberg-Marquardt.
While trilateration is an intuitive technique to derive an object's position from ranging measurements, the resulting positioning accuracy under trilateration is highly sensitive to the ranging accuracy. For example, RTT distances (i.e., distances obtained through FTM) can suffer from low precision and low accuracy, with the latter leading to a steady shift in the estimated position if the distance measurements remain biased for an extended period of time. When trilateration also ignores temporal correlation across a sequence of measurements and their underlying positions, its performance pales in comparison to that of probabilistic approaches that estimate position over time from measurements coupled with an underlying motion model, e.g., Bayesian filtering, and more specifically, Kalman filtering.
Even though Wi-Fi RTT is a promising technology that marries the ubiquity of Wi-Fi with the accurate ranging techniques of position-centric technologies like UWB, there remains a set of challenging problems facing accurate and smooth positioning. First, as discussed above, Wi-Fi RTT measurement can suffer from both low precision and low accuracy, with the latter leading to a steady shift in position that may be difficult to detect and overcome. Second, ranging with all discovered APs can reduce the measurement rate leading to abrupt changes in position estimates. Third, the APs go in and out of range as the user moves in and out of their coverage areas, so making ranging requests to an AP outside of its coverage area can crowd the wireless channel with wasteful frames.
To address these and other issues, this disclosure provides systems and methods for device-based indoor positioning using Wi-Fi fine timing measurements. As described in more detail below, the disclosed embodiments provide a complete, commercial-grade device-based indoor positioning technique that uses Wi-Fi RTT to localize participating Wi-Fi devices. In some embodiments, the disclosed indoor positioning technique can be used as a computational arm of a comprehensive indoor positioning system (IPS), which includes infrastructure such as Wi-Fi APs with known location. Some of the advantages of the disclosed indoor positioning technique is higher positional accuracy and higher positional precision (e.g., compared to current WiFi RTT measurements).
Note that while some of the embodiments discussed below are described in the context of smart phones, these are merely examples. It will be understood that the principles of this disclosure may be implemented in any number of other suitable contexts or systems, including other portable electronic devices (e.g., tablets, laptops, and the like).
Depending on the implementation, various elements of the process 700 can be implemented in software, firmware, hardware, or a combination of two or more of these. In software, various elements of the process 700 can be implemented as an application, or app, deployed on the STA 111, which can be a Wi-Fi-capable device (e.g., a smart phone or tablet) that a user can interact with. Additionally or alternatively, various elements of the process 700 can be implemented as a service running in the background that provides, through an API with a service, the device position in this case. Additionally or alternatively, various elements of the process 700 can be deployed in the cloud or on a server where it communicates inputs (measurements) and outputs (position estimates) with the STA 111 over an internet connection (e.g., over Wi-Fi or the cellular network). Various elements of the process 700 can additionally or alternatively be implemented in firmware or hardware, as long as an API with the Wi-Fi MAC layer exists to send and receive ranging requests.
The process 700 combines three high-level operations that may run in sequence or in parallel. The three operations include a scanning operation 702, a ranging operation 704, and a positioning operation 706. In the scanning operation 702, the STA 111 periodically scans for registered FTM responders, i.e., FTM-enabled anchor points (such as APs), to build or refresh a detected APs list 712, which is a list of available APs to range with. The scanning operation 702 may be performed in response to a scan request 710. In the ranging operation 704, the STA 111 selects APs to range with from the detected APs list 712, periodically builds and makes ranging requests, and processes ranging responses 714 to extract key information (e.g., RTT/distance, RTT/distance standard deviation, and RSSI). In the positioning operation 706, the STA 111 estimates the position of the STA 111 from distance measurements. Further details about each of the operations 702, 704, 706 are provided below.
Scanning Operation 702.
As shown in
At operation 804, the STA 111 scans for, and detects, FTM responders (i.e., FTM-enabled APs) in the vicinity. The FTM responders may advertise support for FTM by setting to true the Fine Timing Measurement Responder field of the Extended Capabilities element in their beacon frames.
At operation 806, the STA 111 intersects the set of registered FTM APs, which has a size A, with the set of detected FTM responders to produce or update the detected APs list 712. The detected APs list 712 includes the set of detected FTM responders, or detected APs, which has a size AS≤A.
At operation 808, the STA 111 waits for a scanning period TS before going back to operation 804. In some instances, the STA 111 returns to operation 804 before the wait timer runs out (i.e., before the scanning period Ts expires). For example, the STA 111 may immediately jump to operation 804 if the STA 111 receives an external scan request 710, such as from the positioning operation 706, upon the detection of a significant and rapid change in position of the STA 111. Other steps performed by the positioning operation 706 are discussed in further detail below.
Ranging Operation 704.
As shown in
At operation 904, the STA 111 performs a first round of coarse selection that shortlists a set of APs from the set of AS APs in the detected APs list 712. The shortlist has a size AC≤AS. The STA 111 can perform the coarse selection by choosing the set of AC APs that are the closest to the STA 111, where distance is determined using the most recent estimate of the position of the STA 111. If no position estimate of the STA 111 is available yet, the value of AC can be set in different ways. One way is to set AC to AS, and all detected APs become candidates for the next round of selection. Other ways are to choose the first AC APs in the detected APs list 712, or simply choose AC APs arbitrarily.
At operation 906, the STA 111 performs a second round of finer selection that selects a set of AR ping partners (i.e., APs to range with) out of the AC candidates in the shortlist generated in operation 904. The STA 111 obtains the set of ping partners by solving a constrained or unconstrained optimization problem involving one or more objective functions and/or constraints, either exactly or by means of an approximation. In some embodiments, the STA 111 selects the set of APs that minimize a two-dimensional or three-dimensional dilution of precision (DOP) metric, as discussed in greater detail below.
At operation 908, the STA 111 prepares and sends ranging requests to the AR ping partners through the FTM mechanism described earlier, and waits for ranging results.
At operation 910, the STA 111 computes the RTT distances between the STA 111 and the AR ping partners. For example, in some embodiments, the STA 111 extracts measurements of the distance between the STA 111 and each of the AR APs obtained through FTM exchanges. Alternatively, the STA 111 extracts the RTT between the STA 111 and each of the APs and applies a scaling factor to convert that into a distance. Additionally, the STA 111 may extract or compute other key information such as the RSSI, RTT distance standard deviation, and other statistics.
At operation 912, the STA 111 produces an observation (tk, {ya}), where tk is the timestamp at which the ranging response was received by the STA 111, and {ya} is the set of RTT distances from each of the Ay valid APs, i.e., ping partners that responded to the ranging request. Here, AV≤AR.
At operation 914, the STA 111 waits for a ranging period TR before going back to operation 902.
An RTT distance is said to be missing if one of the following events happens:
Positioning Operation 706.
As discussed above, a purpose of the positioning operation 706 is to estimate the device position for every observation produced by the ranging operation 704. In some embodiments, the positioning operation 706 operation includes two phases: A transitory phase and a steady phase. The transitory phase is the first phase of positioning and is performed upon starting the process 700. The transitory phase establishes an initial value for the position of the STA 111, which can be used as the initial state of an Extended Kalman Filter (EKF) (described in greater detail below). The steady phase determines any lost position produced by the transitory phase. The steady phase produces position estimates as long as the process 700 is being performed. Further details for each phase will now be provided.
As shown in
At operation 1004, the STA 111 determines if the value of AV≥3. If AV<3, the positioning operation 706 does not produce a position estimate, and the transitory phase 1000 returns to operation 1002 for fetching of more observations. If AV≥3, then the transitory phase 1000 proceeds to operation 1006.
At operation 1006, the STA 111 decides whether to retain or discard the RTT distances on an anchor-by-anchor basis. In one example, the STA 111 can define a fixed or moving range of acceptable values and accept RTT distances lying therein. The range of acceptable values can be AP-specific. A lower bound of such a range can be set to zero to reject negative measurements of distance. An upper bound of such a range can be set to the shortest distance between an AP and the perimeter. This can help eliminate spurious RTT distances that are erroneous.
At operation 1008, the STA 111 decides whether to propagate (in the EKF) the current RTT distance or duplicate an older one on an anchor-by-anchor basis. If the RTT distance from an AP was retained in operation 1006, the RTT distance is propagated in the EKF. Conversely, if the RTT distance from an AP was discarded in operation 1006, or if an RTT distance is missing, the STA 111 can propagate a recent measurement to fill in for the missing data. If the difference between the timestamp of the current observation and the timestamp of the last observation with an RTT distance is smaller than a predefined value, then the last RTT distance is copied. Otherwise, the RTT distance continues to be treated as missing.
At operation 1010, the STA 111 filters the RTT distance on an anchor-by-anchor basis. In one example, the STA 111 can apply a simple moving average (SMA), an exponential moving average (EMA), or a median filter to the sequence of RTT distances from an AP. In the case of a SMA or median filter, a window with a duration of 1-3 seconds can be used. In the case of an EMA, the auto-regression equation yk=α·rk+(1−α)·yk−1, with α<0.5, can be used to filter the RTT distance rk to obtain yk.
At operation 1012, the STA 111 estimates the current position of the STA 111 using trilateration if the number of RTT distances surviving operations 1004-1010 is greater than or equal to 3.
At operation 1014, the STA 111 averages the position estimate to obtain {circumflex over (x)}k, which is a state estimate for the EKF, as described below. At operation 1016, the STA 111 appends {circumflex over (x)}k to a position buffer.
At operation 1018, the STA 111 determines if the position estimate converges after sufficiently many rounds. The convergence criterion can be, for example, that the distance between pairs of consecutive position estimates ∥{circumflex over (x)}k−{circumflex over (x)}k−1∥ is less than some tolerance distance dr, e.g. dT=2 m, for all rounds k such that kT
If the STA 111 determines at operation 1018 that the position estimate converges after sufficiently many rounds, then the transitory phase 1000 moves to operation 1020, where the STA 111 uses the last position estimate produced during the transitory phase 1000 to initialize and run the EKF, which effectively starts the steady phase.
Otherwise, if the STA 111 determines at operation 1018 that the position estimate does not converge (i.e., if there is a round k* where ∥{circumflex over (x)}k−{circumflex over (x)}k−1∥>dT), then the STA 111 rolls over the interval [kT
Overview of Extended Kalman Filter (EKF)
A Kalman filter recursively estimates the state of a dynamical system from a sequence of measurements obtained over time and an assumption of state trajectory. The Kalman filter assumes an underlying system that is modeled by two linear equations: (i) a state transition/motion equation, and (ii) a measurement/observation equation.
The motion equation describes the evolution of the state of the system and relates the current state to a previous state, such as by the following:
X
k
=A
k
x
k−1
+B
k
u
k
+v
k,
where Xk is the current state, xk−1 is the last state, Ak is the state transition matrix, uk is the current input, Bk is the control/input matrix, and vk˜N(0, Qk) is the process noise which represents uncertainty in state.
The measurement equation relates the current observation to the current state, such as by the following:
y
k
=H
k
x
k
+w
k,
where yk is the latest observation, Hk is the observation matrix, and wk˜N(0, Qk) is the observation noise.
At each time index k, the Kalman filter estimates the state of the system by applying a prediction step followed by an update step. The outcome of these two steps is the state estimate {circumflex over (x)}k at time index k and its covariance matrix Pk which are in turn used to estimate the states at later points in time.
In the prediction step, the Kalman filter predicts the current state {circumflex over (x)}k|k−1 (a priori estimate) from the most recent state estimate Xk−1, its covariance Pk−1, and any inputs using the motion equation as follows:
{circumflex over (x)}
k|k−1
=A
k
{circumflex over (x)}
k−1
+B
k
u
k,
P
k|k−1
=A
k
P
k
A
k
*
+Q
k,
{circumflex over (x)}
k
={circumflex over (x)}
k|k−1
+K
k(yk−Hk{circumflex over (x)}k|k−1),
P
k=(I−KkHk)Pk|k−1,
where Kk is the Kalman gain and is a function of the a priori estimate covariance Pk|k−1, observation matrix Hk, and observation noise covariance matrix Rk.
The EKF is an adaptation of the Kalman filter for handling non-linearities in the motion or measurement models. If the motion or measurement equations are not linear, the Kalman filter could not be used unless these equations are linearized. Consider the following non-linear motion and measurement equations:
x
k
=f
k(xk−1,uk)+vk,
y
k
=h
k(xk)+wk,
where fk and hk are non-linear functions. The EKF applies the prediction and update steps as follows:
Prediction step:
Update step:
The state estimate {circumflex over (x)}k and its covariance Pk are propagated to track the state of system. In the context of positioning, the state is the device position. In the context of Wi-Fi RTT indoor positioning, the observations are RTT distance measurements.
Random Walk EKF.
In some embodiments, in the positioning operation 706, the STA 111 uses a random walk extended Kalman filter (EKF-RW) to estimate the position of the STA 111. The STA 111 assumes the state-space model defined by two models: a kinematic-free motion model and a distance-dependent measurement model. The motion model (or state transition model), which relates the current position to the last position, is defined according to the following equation:
X
k
=X
k−1
+V
k,
where xk denotes the current state, xk−1 denotes the last state, and vk denotes an unknown step size. The unknown step vk is defined according to vk˜N(0, Q), where Qk=diag([(σpΔtk)2, (σpΔtk)2]), Δtk=tk−tk−1 is the duration between two consecutive observation timestamps, and σp is a model parameter representing an average speed.
The measurement model (or observation model), which relates the current observation, or set of RTT distances, to the current position, is defined according to the following equation:
y
a,k
=d(Xk,Xa)+wk,
where ya, k is the RTT distance from AP a, and AP a is one of the valid APs. The term d(xk, xa) denotes the distance between the STA 111, with a current position xk, and AP a, and wk˜N(μk, Rk) denotes the observation noise. As the distance function d(.,.) is not linear, it needs to be linearized so estimation can continue to take place in the efficient Kalman filter framework. Accordingly, the measurement model is linearized as follows:
y
k
=H
k
x
k
+w
k,
where the observation vector yk stacks the RTT distances {ya}, and the matrix Hk is such that an element at its a-th row is j-th column (corresponds to AP a and coordinate xj):
Distance-Dependent Measurement Model
In some embodiments, in the positioning operation 706, the STA 111 uses a distance-dependent measurement model to enhance estimation accuracy. In one example, the elements of the measurement noise vector wk each have a mean and a variance that vary with the RTT distance from the corresponding AP: a shorter distance corresponds to a smaller mean and variance, and a longer distance corresponds to a larger mean and variance. For example, the measurement noise mean μM(ya) and variance σM2(ya) corresponding to an arbitrary AP a can be linear in the RTT distance, piece-wise linear, quadratic, polynomials, or any other monotonically increasing function that suitably fits the data explaining observation errors vs. RTT distances. Instead of all the RTT distance measurements from all of the APs sharing the same noise statistics μM(y) and σM2(y), every AP can be given its own unique mean and variance functions.
During the EKF update step, the STA 111 uses the RTT distance measurement ya to compute the mean μM(ya) and the variance σM2(ya) to compute the Kalman gain.
As shown in
At operation 1104, the STA 111 drops one or more RTT distance measurements. This is similar to operation 1006 of the transitory phase 1000, but the retention/rejection criteria can be different. For example, if for a given AP a, the RTT distance ya is less than a predefined maximum distance dmax, then the distance measurement is dropped, and AV is decremented. The maximum distance dmax can be chosen to be the maximum attainable physical distance between any AP and any feasible device position. The maximum attainable distance can further be scaled upwards to account for over-estimation.
At operation 1106, the STA 111 determines if the number of surviving RTT distances AV>3. If AV<3, the steady phase 1100 proceeds to operation 1108 for deducing the next position. If AV≥3, then the steady phase 1100 proceeds to operation 1110.
At operation 1108, the STA 111 deduces the next position as an offset of the last-produced position estimate using implied velocity Uk. Accordingly, the next position is predicted as follows:
{circumflex over (x)}
k|k
={circumflex over (x)}
k
+(tk−tk
where k+ is the index of the most recent estimate {circumflex over (x)}k
At operation 1110, the STA 111 sets the variance Qk of the step size vk as Qk=diag([(σpΔtk)2, (σpΔtk)2]), where Δtk=tk−tk.
At operation 1112, the STA 111 predicts the next position {circumflex over (x)}k|k−1 using the latest estimate {circumflex over (x)}k and the motion model, and computes the a priori position covariance matrix Pk|k−1, according to the EKF prediction step, as follows:
{circumflex over (x)}
k|k−1
={circumflex over (x)}
k−1
P
k|k−1
=P
k
+Q
k
At operation 1114, the STA 111 computes the observation noise mean and variance for each of the Ay surviving observations according to the distance-dependent measurement model by evaluating the functions μM,a,k(ya, k) and σM,a,k2(ya, k), which are predefined functions.
At operation 1116, the STA 111 updates the position estimate to produce the a posteriori position estimate {circumflex over (x)}k and its covariance matrix Pk by combining the predicted position {circumflex over (x)}k|k−1 with the RTT distance measurements {ya}, according to the EKF update step, as follows:
{circumflex over (x)}
k
={circumflex over (x)}
k|k−1
+K
k(yk−μM,k−Hk{circumflex over (x)}k|k−1)
P
k=(I−KkHk)Pk|k−1,
where Kk is the Kalman gain and is a function of the distance-dependent measurement noise variances {σM,a,k2(ya, k)}a, and μM,k is a column vector whose elements are the distance-dependent noise means {σM,a,k2(ya, k)}a.
At operation 1118, the STA 111 updates the implied velocity uk as follows:
where Nu is chosen such that tk−tk−N
At operation 1120, the STA 111 appends Rk to a position buffer, and the STA 111 repeats the steady phase 1100 for another estimation step k.
Dilution of Precision for Ping-Partner Selection
A common performance precursor used in satellite navigation systems is the dilution of precision (DOP). The DOP helps predict the error bounds of the position estimate as a function of the relative position of the moving object with respect to the position of the anchor points (or reference points) and their ranging errors. Mathematically, the DOP at position (x, y) is defined as:
DOP(x,y)=trace(HTH)−1,
where the a-th row of matrix A×2 matrix H is in turn defined as:
where da(x, y) is the distance between the device and the a-th anchor point.
In some embodiments, during the ranging operation 704 (e.g., in operation 906), the STA 111 can use DOP to select the best set of ping partners S from the set of APs 1 . . . A. For a given subset S of APs, the DOP at position (x, y) becomes:
DOP(x,y;S)=trace(HSTHS)−1,
where Hs=[H]α∈S.
The following describes two variations of using DOP for ping-partner selection.
In one variation, before making a ranging request, the STA 111 checks if the ranging index k is such that k mod IS=0 for a selection interval Is. If the condition is false, the ranging operation 704 proceeds to operation 906. Otherwise, the STA 111 uses the most recently-selected set of ping partners to range with. The STA 111 also determines the subset of APs S* of size Ap, Ap≤AS, that corresponds to the minimal DOP. This can be solved optimally through exhaustive search, or approximately through a greedy algorithm or a heuristic.
In another variation, on startup, the STA 111 partitions the two-dimensional navigable area into an array of L×W square cells of size δp. The STA 111 determines, for each cell (l, w), the optimal AP subset S* that minimizes DOP(lδp, wδp; S). The STA 111 also stores, for each cell (l, w), the optimal subset S* in a corresponding entry in a lookup table of the same size of the partition. Before every ranging request, the STA 111 quantizes the position (x, y) into a cell (l, w), looks up the optimal AP subset for the cell, and makes a ranging request to the APs.
Although
As illustrated in
At step 1404, a ranging operation is performed by (i) selecting nodes to range with from the list of the FTM-enabled Wi-Fi nodes and (ii) processing ranging responses from the selected nodes to generate distance measurements. This could include, for example, the STA 111 performing the ranging operation 704 as shown in
At step 1406, a position of a device is estimated based on the distance measurements generated from the ranging operation. This could include, for example, the STA 111 performing the positioning operation 706 as shown in
Although
Although the present disclosure has been described with an exemplary embodiment, various changes and modifications may be suggested to one skilled in the art. It is intended that the present disclosure encompass such changes and modifications as fall within the scope of the appended claims. None of the description in this application should be read as implying that any particular element, step, or function is an essential element that must be included in the claims scope. The scope of patented subject matter is defined by the claims.
This application claims priority under 35 U.S.C. § 119(e) to U.S. Provisional Patent Application No. 63/352,802 filed on Jun. 16, 2022, which is hereby incorporated by reference in its entirety.
Number | Date | Country | |
---|---|---|---|
63352802 | Jun 2022 | US |