WO2017019315A1 - Visual inertial odometry attitude drift calibration - Google Patents

Visual inertial odometry attitude drift calibration Download PDF

Info

Publication number
WO2017019315A1
WO2017019315A1 PCT/US2016/042286 US2016042286W WO2017019315A1 WO 2017019315 A1 WO2017019315 A1 WO 2017019315A1 US 2016042286 W US2016042286 W US 2016042286W WO 2017019315 A1 WO2017019315 A1 WO 2017019315A1
Authority
WO
WIPO (PCT)
Prior art keywords
time
gnss
displacement
measurements
estimate
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.)
Ceased
Application number
PCT/US2016/042286
Other languages
English (en)
French (fr)
Inventor
Lionel Jacques Garin
Xinzhou Wu
Jubin Jose
Urs NIESEN
Venkatesan NALLAMPATTI EKAMBARAM
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.)
Qualcomm Inc
Original Assignee
Qualcomm 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 Qualcomm Inc filed Critical Qualcomm Inc
Priority to JP2018503752A priority Critical patent/JP2018526626A/ja
Priority to EP16745296.0A priority patent/EP3329301B1/en
Priority to CN201680042038.2A priority patent/CN107850673B/zh
Publication of WO2017019315A1 publication Critical patent/WO2017019315A1/en
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/43Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • G01S19/44Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/485Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an optical system or imaging system
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/53Determining attitude
    • G01S19/54Determining attitude using carrier phase measurements; using long or short baseline interferometry
    • G01S19/55Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/46Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Definitions

  • Advanced Driver Assistance Systems (ADAS) mapping and/or navigation systems may use a point cloud of Light Detection And Ranging (LIDAR.) measurements in a 360 degrees horizontal pattern around the vehicle, which is correlated with a previously obtained high accuracy gcoreferenced texture map.
  • LIDAR. Light Detection And Ranging
  • many ADAS demand absolute accuracy levels in the ra ge of 1 meter or less and relative accuracy (e.g. between two successive positions in a time period) in the decimeter range. Therefore, to maintain accuracy levels, the maps are often frequently updated
  • G SS Global Navigation Satellite Systems
  • ONSS accuracy may degrade significantly in urban canyons, where m hipath effects may induce an absolute position error of the order of tens of meters (e.g. as much as 50 meters) and relative position error of the order several meters.
  • accuracy may be further degraded by the limited availability of good G SS measurements.
  • GNSS measurements that use carrier phase, to achieve higher accuracy, positioning accuracy is dependent on a constant lock obtained by maintaining a clear view to at least four satellites, which may not be possible due to environmental conditions - (eg; in urban canyons).
  • accurate G SS positioning also relies on the presence of a nearby reference receiver, which may not be available in many situations. In instances where aecelerometer or iMU based inertia] systems are used iricrtiai sensor drift and other biases prevent reliable and accurate position determination.
  • a method on a user equipment ma comprise; determining a first absolute position of the UE at a first time (tl ) based on GN SS meas urements from a set of satellites at the first time (tl ); determining, at a second time (t2), a first estimate of displacement of the UE relative to tine first absolute position, wherein the second lime ( ⁇ 2) is subsequent to the first time (tl ), wherein the first estimate of displacement is determined using non-GNSS measurements; and determining, at the second time (t2), a second estimate of displacement of the LIE relative to the first absolute position based, in part, on: GNSS carrier phase
  • tneasnrements at the first time (tl) from the set of satellites and GNSS carrier phase tneasnrements at the second time (t2) from a subset comprising two or more satellites of the set of satelli tes, and the first estimate of displacement of the UE.
  • a User Equipment may comprise: a GNSS receiver capable of performing GNSS measurements; at least one non-GNSS displacement sensor to determine UB displacement; a memory to store the GNSS measurements and the non-GNSS displacement sensor measurements; and a processor coupled to the GNSS receiver and the non-GNSS displacement sensor, in some embodiments, the processor may be configured to: determine a first absolute position of the UE at a first lime (tl) based on GNSS measurements from a set of satellites at the first lime (tl); determine, at a second time (t2), a first estimate of displacement of the UB relative to the first absolute position, wherein the second time (t2) is subsequent to the first time (tl), wherein the first estimate of displacement is determined using non- GNSS measurements from the at least one non-GNSS displacement sensor; and determine, at the second time (t2>, a second estimate of displacement of the UB relative to the first absolute position based, in part,, on:
  • a User Equipment ma comprise: GNSS receiving means capable of performing GNSS measurements; at least one non-GNSS displacemen sensing means to determine UE displacement; means for determining a first absolute position of the UE at a first time ( l ⁇ based on GNSS measurements from a set of satellites at the first time (tl ); means for determining, at a second time Ct2), a ' first -estimate of displacement of the UE relative to the first absolute position, wherein the second time (12) is subsequent to the first time (tl), wherein the first estimate of displacement is determined using non-GNSS measurements determined by the non-GNSS displacement sensing means; and means for determining, at the second time ( ⁇ 2), a second estimate of displacement of the U E relative to the first ' bsolute position based, in part, on; GNSS carrier phase measurements at the first time (tl ) from the set of satellites,, and GNSS carrier phase measurements at the second time
  • a non-transitory computer readable medium may comprise instructions, which when executed by a processor, cause the processor to; determine a first absolute position of a User Equipment (UE) at a first time (tl) based on GNSS measurements from a set of satellites at the first time (tl); determine, at a second time (t2), a first estimate of displacement of the UE relative to the first absolute position, wherein the second time (t2) is subsequent to fee first time (tl), wherein the first estimate of displacement is determined using non-GNSS measurements; and determine, at the second time (t2), a second estimate of displacement of the UE relative to the first absolu te position based, in part, on: GNSS carrier phase
  • the methods disclosed may be performed by UE, including mobile stations, mobile devices, etc. using a combination of GNSS signals, including carrier phase measurements. Visual Inertia! Odometry and. i conjunction with terrestrial wireless systems, including LPP, LPPe, or other protocols.
  • Embodiments disclosed also relate to software, firmware, arid program instructions .created, stored, accessed, read, or modified by processors using «o3 ⁇ 4 transitory computer readable media or ' computer readable memory.
  • FIG. 1 shows a schematic block diagram illustrating certain exemplar features of an UE enabled to support position determination in accordance with disclosed embodiments.
  • FIG..2 shows an architecture of a system capable of providing Location, and or Navigation services to UEs including, the transfer of location assistance dat or location information.
  • J0012f Fig, 3A shows an example skyplot of eight GNSS Satellite Vehicles at a point in time.
  • Fig, 3B shows a map ofaa exemplary urban environment with UE 100 and some GNSS Satellite Vehicles.
  • Fig, 4 shows traditional carrier phase measurements and exemplary hybrid GNSS-VIO carrier phase measurement in accordance with some embodiments disclosed herein.
  • FIG. 5 show -a UE 100 which may be in a vehicle moving from. a.
  • Fig. 6 illustrates an example of single difference carrier phase integer reconstructio / back projection according to some disclosed embodiments.
  • FIG. 7 shows that VIO or another non-GNSS positioning estimate of relati ve displacement between points Pi 10 and P2 620 may be used to baek project and resol ve integer ambiguities for SVs 280-1 and 280-2.
  • Figs, 8 A and SB show an exemplary method 800 for hybrid GNSS- VIO or hybrid.
  • Fig. 9 shows an exemplary method 900 for hybrid GNSS - non-CNSS position determination in accordance with some disclosed embodiments
  • mapping and/or navigation may use one or more continuous, reliable, and accurate sources of both absolute and relative positioning
  • ADAS mapping and/or navigation systems may use LIDAR measurements and/or RADAR measurements to obtain relative displacement estimates.
  • the term "relative positioning” or “relative displacement” is used herein to refer to a baseline vector between two positions occupied by a single mapping/navigation entity, such as a single vehicle, or a single user equipment, or a single mobile station over a time period.
  • the relative displacement may be expressed in an absolute reference framework, "Relative Positioning" as described above is therefore different from the instantaneous baseline vector between two distinct receivers (e.g. a reference and a rover) at a point in time.
  • GNSS- VIO hybrid approach that combines Visual inertial Odomctry (VIO) with GNSS.
  • VIO Visual inertial Odomctry
  • GNSS signal quality parameters may include, for example, whether line Of Sight (LOS) exists to a subset of the visible GNSS satellites, the extent of GN SS signal degradation due to multipath (MP) etc.
  • GNSS positioning locations may be obtained using various sensors/techniques and may include the use of images captured by cameras/optical sensors and or measurements by Inertia! Measurement Units (JMUs).
  • Relative displacement and position between two GNSS positioning occasions may also be determined using LIDA o Radio Detectio and Ranging (RADAR).
  • LIDAR refers to remote sensing technology that measures distance by illuminating a target (e.g. with a laser or other light) and analyzing the reflected light.
  • VIO based techniques may be used to determine relative displacement and position between two or more locations where GNSS measurements that meet quality parameters are available.
  • VIO and/or an alternate sensor based technique of similar accuracy may be used to determine relative displacement and position between times t.i and l2.
  • the time separated GNSS rneasureraents obtained daring positioning ma include GNSS carrier phase
  • the term "muUipath” is used to refer to errors that occur when a UE receives a mi of direct and indirec signals or indirect-only signals (Non Line of Sight),
  • the indirect signals may come from surrounding buildings or from atmospheric conditions affecting signals from satellites at low elevations relative to the horizon.
  • Disclosed embodiments facili tate relative motion and position determination when the number of v isible satellites is less than the number used during traditional (e.g. 4 or more satellites for a three-dimensional (3D) mode) position calculation.
  • time-separated Line Of Sight (LOS) GNSS measurements may be stitched together based on VIO, for example, by dead reckoning with a camera or image sensor.
  • the GNSS measurements when available, may also be used to correct VIO drift, offset and misalignment errors, in some embodiments, measurements can be stitched together by fusing GNSS measurements collected, for example, at a time tl, with measurements from another sensor (e.g. camera and/or ⁇ and/or LIDAR and or RADAR and/or another method) or technique that determines an accurate relative motion vector between a time tl and another time t2.
  • parameters for GNSS measurements at time t2 may be determined based on the GNSS measurements at time tl and the accurate relative motion vector between times t l and i ' 2.
  • Some disclosed embodiments may be viewed as facilitating the transport of discontinnous GNSS measurements collected at a first time tl. to another second time epoch 12, using relative displacement information obtained from another rion-GNSS sensor/technique (e.g. V iO IMII/LID AR/RADAR based) of similar accuracy.
  • position continuity may be maintained by propagating the last fix based on the displacement measured since that last fix.
  • a fix at time tl may be propagated to a time t2 based on displacement measured since tl . in some
  • displacement sensor frame of reference may be performed in conjunction with the position fix.
  • GNSS carrier phase measurements that meet quality parameters may be collected at both tl and t2, ViO based techniques may be used to determine displacement between times l an t2, and carrier phase integer ambiguity resolution may be performed for the GNSS measurements.
  • GN SS measurements are simultaneously collected from two receivers: a Reference receiver and from a .Rover (moving) receiver to resolve carrier phase ambiguities
  • the term "Relative Positioning” refers to the instantaneous baseline vector between two distinct receivers (e.g. a reference and a rover) at a point in time.
  • data from the same receiver, but collected, at different times may be used to resolve carrier phase: ambiguities.
  • the position p.1 of UE at time tl may be considered as the "rover receiver” position
  • the position p2 of the UE at time t2 may be considered the as the "reference recei ver" position
  • VlOmeasured relative displacement may be used, in part, to resol e ambiguities and facilitate real time position determination even when cycle slips occur, in some embodiments, carrier phase ambiguities .between two successive positions occupied by the receiver may be .resolved using the Vernier principle, in the Vernier principle, two scales ⁇ e.g.
  • VIO-based and carrier phase based) with different periodicities or graduations may be used to increase the 'accurac of the measured displacement between the two successive receiver positions, j 01)30 ⁇
  • Disclosed embodiments also resolve other biases relating to ⁇ position determination such, as those arising from non-simultaneous GNSS measurements, the motion of satellites between times tl and tl, ionospheric delays partial spatial decorrelation, receiver clock drift, etc.
  • the techniques disclosed may also be used for and/or in conjunction with Precise Point Positioning (PPP) iechmtpies that facilitate global location determination with high accuracy using a single GNSS receiver,
  • PPP Precise Point Positioning
  • the terms "User De vice” (U ) or “user equipment” (UE) are used interchangeably herein and ma refer to a device suc as a cellular or other wireless communication device, personal communication system (PCS) device, personal navigation device (PND), Personal information Manager (P1M), Personal Digital Assistant (PDA), laptop or other suitable mobile device which is capable of receiving wireless communication and/or navigation signals.
  • PCS personal communication system
  • PND personal navigation device
  • P1M Personal information Manager
  • PDA Personal Digital Assistant
  • laptop or other suitable mobile device which is capable of receiving wireless communication and/or navigation signals.
  • the terms are also intended to include devices whic communicate with a personal navigation device (PND), such as by short-range wireless, infrared, wireline connection, or other connection - regardless • of whether satellite signal reception, assistance data reception, and/or position-related processing occurs at the device or at the PND.
  • the UE may represent a mobile telephone, notepad computer, or laptop, or it may be a vehicle that collects measurement sets for the purpose
  • target are intended to include all devices, including wireless and wireline
  • a server such as via the Internet, Wi-Fi, cellular wireless network, DSL network, packet cable network or other network, and regardless of whether satellite signal reception, assistance data reception, and/or position-related processing occurs at the device, at a server, or at another device associated with the network. Any operable combination of the above are also considered a "u ser device.”
  • Fig, 1 shows a schematic block diagram illustrating certain exemplary features of UE 100 enabled to support mapping based, on a combination of GNSS signal and sensor based measurements to compute relative displacement, including camera or other image based techniques.
  • UE 00 may also support hybrid G SS-VIO based position determination by combining image based techniques with ONSS carrier-phase signal measurements.
  • hybrid is used to refer to the use of a combination of one or more of displacement sensor and/or V1Q based
  • 034 UE 100 may, for example, include one or ' more processors or
  • UE .100 may also optionally or additionally include one or more of; a magnetometer, an altimeter, a barometer, and sensor bank 185 (collectively referred to as sensors 185).
  • UE 100 may include Inertia! Measurement Unit (IM.U) 170.
  • IM.U Inertia! Measurement Unit
  • non-transitory computer-readable medium 160 display 190, and memory 130, which ma be operatively coupled to each other with one or .more connections 120 (e.g., buses, lines, fibers, links, etc.). in certain example implementations, all or part of UE 100 may take the form of a chipset, and/or the like.
  • GNSS receiver 140 may be enabled to receive signals associated with one or more SPS/GNSS resources. Received SPS/GNSS signals ma be stored in memory 130 and/or used by processors) 150 to determine a position of UE 100.
  • GNSS receiver 140 may include a code phase receiver and a carrier phase receiver, winch may measure carrier wave related information.
  • the carrier wave which typically has a much higher frequency than the pseado random noise (PRN) (code phase) sequence that it carries, may facilitate more accurate position
  • PRN pseado random noise
  • code phase measurements refer to measurements using a Coarse Acquisition (C/A) code receiver, which uses the information contained in the PRN sequence to calculate the position of UE 100.
  • carrier phase refers to measurements using a Coarse Acquisition (C/A) code receiver, which uses the information contained in the PRN sequence to calculate the position of UE 100.
  • the carrier signal may take the form, for example for GPS, of the signal LI at 1575.42 MHz (which carries both a status message and a pseudo-random code for timing) and the 12 signal at 1227.60 MHz (which carries a more precise miliary pseudo-random code),
  • carrier phase measurements ' may be used to determine position in conjunction with, code phase .measurements and differentia! techniques, when GNSS signals that meet quality parameters are available.
  • the use of carrier phase measurements along with differential correction can yield relative
  • UE may use techniques based on or variants of real-time carrier phase differential GPS (CDGPS) to determine the position of UE at various point and times, when such measurements are a vailable.
  • CDGPS real-time carrier phase differential GPS
  • the carrier phase measurements at the reference station may be used to estimate the residuals of (e.g.. portions not corrected by navigation messages) satellite clock biases of visible satellites.
  • the satellite clock biases are transmitted to "roving receivers" which use the received informatio to correct their respective measurements.
  • the position pi of UE 10 at time tl may be considered as the "rover recei ver" position, while the position p2 of the UE at time t2 may be considered the as the "reference receiver” position and differential techniques may he applied to minimize or remove errors induced by satellite clock biases. Because the same receiver is used at time t l and t2sorge no data needs to be actually transmitted .from the "reference" receiver (i.e. receiver at. rime tl), to the "rover" receiver, (i.e. same receiver at time t2). in some embodiments, instead of the data transmission, between rover and receiver that occurs in classical RT , a local data buffering operation may be used to hold data at times l and t2,
  • differencing refers to error reduction techniques that subtract GNSS carrier phase measurements at a li ' E 100 from, a single satellite S at time t2 from GNSS carrier measurements at UE 100 from: same satellite S at time tl.
  • doubled GNSS carrier phase measurements at a li ' E 100 from, a single satellite S at time t2 from GNSS carrier measurements at UE 100 from: same satellite S at time tl.
  • differencing refers to the carrier phase double difference observable between the times tl and ⁇ 2 S which may be obtained as the difference between the above single difference carrier phase observable for a satellite SJ and the above single difference carrier phase observable for a satellite S j.
  • Transceiver 110 may, for example, include a transmitter 1 12 enabled to transmit one or more signals over one or more types of wireless communication networks and a receiver 1 14 to receive one or more signals transmitted over one or more types of wireless communication networks.
  • Wireless communication networks may include, for example.
  • WWAN Wireless Wide Area Networks
  • WLANs Wireless Local Area Networks
  • UE 100 may comprise optical sensors such as
  • optical sensors may include or be coupled to a L1.DAR unit/ lasers with associated instrumentation including scanners, photo-detectors and receiver electronics.
  • Optical sensors / camera(s) are hereinafter referred to "cameraCs) 180", CameraCs) 180 may convert an optical image into an electronic or digital image and may send captured images to processor ' s) 150.
  • eamera(s) 180 may be housed separately, and may be operationally coupled to display 1 0, processors) 150 and/or other functional units in UE i O,
  • UE 100 may also include Inertiai Measurement Unit (1MU 170,
  • IMU 170, winch ma comprise 3-axis aeceieromeier(s), 3-axis gyroscope(s), and/or magneiomeier(s), may provide velocity, orientation, and/or other position related information to processors) 150.
  • IMC " 170 may be configured to measure and output measured
  • the output of IMU 170 may be used, in part, by processors) 150 to determine a position and orientation of UE 100.
  • non-GNSS displacement sensor is used herein to refer to any combination of sensors that may be used, to detemrine displacement.
  • non-GNSS displacement sensor as used herein, ma refer to one or more of; IMUs, accelerometers, Visual Inertiai Odometry (VIO) based on captured images, ' LJDAR etc. i i
  • the terra "hon-GNSS rtteasurements" may refer to measurements from any of the above sensors,
  • the capture of GNSS measurements by UE 100 when available may be synchronized and/or correlated with the capture of images by camerais) I SO. Further, in some embodiments, the capture of non-GNSS measurements (e.g. by IMU 170) measurements may be synchronized with the capture of images by the camera(s) 180 UE 100.
  • IMU measurements, GNSS measurements, and captured images may be iimestarnped and the measurements and images may be associated with each other based on the time stamps. The association of one or more measurements with image and/or with each other may occur concurrently with measurement / image recordation, and/or at a later point in time based on the timestamps associated with the measurements.
  • the term "measurement set” is used to refer to signal measurement performed by a UE at a measurement location at a point in time or within some specified interval of a point in time.
  • the signal measurements made may be related to mapping and/or position determination.
  • the signal measurements made may also depend on UE 100, the capabilities of UE 1 0, environmental characteristics and/or signal characteristics that are available for measurement by UE 1 0 at a specific location rime.
  • a measurement set may comprise available GNSS
  • VIO measurements e. g. based on captured iraage(s) or LIDAR measurements
  • IMU measurements where each element of toe measurement set may have been recorded within some specified time interval of a point in time.
  • the measurement sets recorded by UE 100 may be stored irt memory 130 on UE 100.
  • processor(s) 150 may be implemented using a combination of hardware, firmware, and software, in some embodiments, processor(s) 150 may include Computer Vision Processor (CVP) 155, which may implement a variet of image processing, VIO, and Computer Vision (CV) functions.
  • CVP Computer Vision Processor
  • camera(s) 1 SO may include multiple cameras, front and/or rear facing cameras, wide-angle cameras, and may also incorporate CCD, CMOS, and/or other sensors.
  • Camera(s) 180 which may be still and or video cameras, ma capture a series of 2-Dimensional (2D) still and/or video image frames of an environment and send the captured image frames to processors) 150.
  • camera I SO may capture a series of 3 -dimensional (3D) images from a Time-of-Plight camera, or associated pairs or multiple 2-dimenskmal (2D) frames captured by stereo, trifocal or multifocal cameras.
  • camera(s) 180 may b a wearabl camera, or an externa!
  • images captured by camera(s) IS may be in a raw uncompressed format and may be compressed prior to being processed and/or stored in memory 1 0, In some embodiments, image
  • compression may be performed by processors) 150 (e.g. by CVP 155) using lossless or lossy compression techniques.
  • camera 180 may be a depth sensing camera or may be coupled to depth sensors.
  • depth sensor is used to refer to functional units- that may be used to obtain depth information for an environment independently and or in conjunction wife eamera(s) ISO.
  • camera(s) 180 ma take the form of a 3D Ti me Of Flight (3DTOF) camera.
  • 3DTOF 3D Ti me Of Flight
  • the depth sensor may take the form of a strobe light coupled to the 3DTOF camera(s) 180, which may illuminate objects in a scene and reflected light may be captured by a CCD/CMOS sensor in camera 110, Depth information may be obtained hy measuring the time that the light pulses take to travel to the objects and back to the sensor.
  • UE .100 may include or be coupled to LIDAR sensors, which may provide measurements to estimate relative displacement of UE 100 between two locations.
  • the depth sensor may take the form of a light source coupled to camera(s) 180.
  • the light source may project a structured or textured light pattern, which may consist of one or more narrow bands of light, onto objects in a scene.
  • Depth information may then be obtained by exploiting geometrical distortions of " the projected pattern caused by the surface shape of the object.
  • depth information may be obtained from stereo sensors such as a combination of an infra-red structured Sight projector and an infra-red camera registered to a RGB camera, in some embodiments, eaniera(s) 1 0 may be stereoscopic cameras capable of capturing 3 Dimensional (3D) mages.
  • camera's) I SO may include depth sensors that are capable of estimating depth information.
  • a depth sensor may form part of a passive stereo vision sensor, which may use two or more cameras to obtain depth information for a scene. The pixel coordinates of points common to both cameras in a captured scene may be used along with camera pose information and/or triangulaiion techniques to obtain per-pixel depth infonnatioo.
  • depth sensors may be disabled, when, not in use. For example, the depth sensor may be placed in a standby mode, or powered off when not being used.
  • processors 150 may disable (or enable) depth sensing at one or more points in time.
  • Processo (s) 150 may also execute software to process image frames captured by camera's) 180.
  • rocessor's) 150 and/or CVP 155 may be capable of processing one or more image frames received from camera's) 180 to determine the pose of camera's) 180 and; or UE 1.00. implementing various co mputer vision and image processing algorithms and/or performing VIO based on the images received from camera's) ISO.
  • the pose of camera's) ISO refers to the position and orientation of the camera's) 180 relative to a frame of reference.
  • camera pose may be determined for 6-Degrees Of Freedom (6-DOF), which refers to three translation components (which may be gi ven by ⁇ , ⁇ , ⁇ coordinates of a frame of reference) and three angular components (e.g. roll, pitch .and yaw relative to the same frame of reference),
  • 6-DOF 6-Degrees Of Freedom
  • the pose of camera's) 180 and/or U E 100 may be determined and/or tracked by processor's) 150 using a visual tracking solution based on image frames captured by camera's) 180.
  • processor's) 150 and/or CVP 155 may he implemented using dedicated circuitry, such as Application Specific Integrated Circuits (ASICs), Digital Signal Processors (DSPs), and/or dedicated processor.
  • ASICs Application Specific Integrated Circuits
  • DSPs Digital Signal Processors
  • CVP 155 may implement various computer vision and/or image processing methods such as 3D reconstruction, image compression and filtering. CVP 155 ma also implement computer vision based tracking, VIO, model-based tracking, ' Simultaneous ' Localization And Mapping (SLAM), etc.
  • SLAM Simultaneous ' Localization And Mapping
  • the methods implemented by CVP 155 may be based on color or grayscale image data captured by camera(s) .1 SO, which may be used to generate estimates of 6-DOF pose measurements of the camera
  • SLAM refers to a class of techniques where a map of an environment, such as a map of an environment being modeled by UE 100, is created while simultaneously tracking the pose of UE 100 relative to that map
  • SLAM techniques include Visual SLAM (VLSAM), where images captured by a camera, such as cameras) 180 on UE 100, ma be used to create a map of an environment while simultaneously tracking the camera's pose relative to that map
  • VSLAM may thus i nvolve tracking the 6DOF pose of a camera while also determining the 3-D structure of the surrounding environraent
  • the techniques outlined above may identify salient feature patches or keypoints or feature descriptors in a captured image frames, which may be tracked in a subsequent image frames.
  • Image feature descriptors may take the form of Scale Invariant Feature Transform (SIFT). Speeded-Up Robust Descriptors (SURF), etc., which are well-known in the art.
  • SIFT Scale Invariant Feature Transform
  • SURF Speeded-Up Robust Descriptors
  • the determined/stored image descriptors may be utilized at a later point by an image or object detector to determine the pose of a HE,
  • GNSS signals may be unavailable during some time periods.
  • the term "unavailable" in relation to GNSS signals is used to refer to one or more of; a temporary loss of lock and/or discontinuities and/or interruptions of GNSS signals; various environmental (including atmospheric, geographical etc) conditions that may detrimentally affect reception and/or reliability of GNSS signals; and/or non-availability of GN SS signals.
  • GNSS signals such as carrier phase signals
  • are unavailable or unreliable such as in dense outdoor environments (e.g.
  • VIO based tracking can be done using VIO based tracking, which,, in some embodiments, may use a combina tion of visual and inertial tracking systems.
  • images captured by earnera(s) 180 may be used in conjunction ith measurements by IMU 170 and/or sensors in sensor ban 85 (e.g. altimeter, barometer, magnetometer etc) to determine the pose of UE 100 and/or camera(s) 380.
  • depth data from a depth sensor which may be captured in conjunction with the capture of a depth -image by eamera(s) 180, may be used, in part, to compute camera pose in some embodiments, ViO based techniques may be used, in part, to correct for errors (such as biases and drift) in IMU 170.
  • GNSSS coordinates may also be used to provide location information.
  • the pose of the camera may be used to recalibrate sensors in IMU 170, and/or to compensate for and/or remove biases from measurements of sensors 185 aad or sensors in I U 170,
  • IMU 170 and/or sensors 185 may output measured information in synchronization with the capture of each image frame by camera(s) 180 by UE 100.
  • the camera pose can be estimated accurately, for example, based on the images (e.g. successful detection of one or more
  • a hybrid VIO Tracker may incorporate an
  • Extended alnian Filter providing various inputs to the EKF to track the pose of camera(s) 180 and/or UE 100.
  • the alman Filter is a widely used method for tracking and pose estimation. Specifically, the KF operates recursively on a sequence of noisy input measurements over time to produce a statistically optimal estimate of the underlying system state, which may include estimates of unknown variables.
  • the EKF linearizes noa-Uaear models to facilitate application of the KF.
  • processors 150 may further comprise a
  • PE 156 Positioning Engine (PE) 1.56 (hereinafter PE 156) , which may use information deri ved from images, sensor and wireless measurements by UE 100 either independently, or in conjunction with received locationo assistance data to determine a position and/or a position uncertainty estimate for UE 100.
  • PE 156 may be implemented using software, firmware, and/or dedicated circuitry, such, as Application Specific integrated Circuits (ASICs), Digital Signal Processors (DSPs), aad/or dedicated processor (such as processors) 150).
  • ASICs Application Specific integrated Circuits
  • DSPs Digital Signal Processors
  • processors 150 aad/or dedicated processor
  • processors 150 may comprise Location
  • L AD Assistance Data Processor
  • L AD may process location assistance information comprising multipath and visibility map assistance information, updated GNSS satellite almanac and/or epheraeris information, which ma then be used by processo s) 150 to select a signal acquisition / measurement strategy and/or determine a location.
  • processors ⁇ 150 / LADP 158 may also be capable of processing various other assistance informatio such as Long Term Evolution (LTE) Positioning Protocol (LPP or LPP extensions (LPPe) messages including assistance information either directly or .in conjunction w t one or more other functional blocks shown in Fig, 1, in some embodiments, PE 156 and/or LADP 158 may be used to obtain an initial absolute location of UE 100,
  • UE 100 may include one or mot e UE antennas
  • UE antennas may be used to transmit and/or receive signals processed by transceiver 1 10 and/or GNSS receiver 140.
  • UE antennas may be coupled to transceiver 110 and GNSS receiverMO.
  • measurements of signals received (transmitted) by UE 100 may be performed at the point of connection of the UE antennas and transceiver 1 10.
  • the measuremen t point of reference for received (transmitted) RF signal measurements ' may be an input (output) terminal of the recei ver 1 14 (transmitter 112) and an output (input) terminal of the UE antennas.
  • the antenna connector may be viewed as a virtual point representing the aggregate output (input) of multiple UE a tennas, in some
  • UE 10 may measure received signals including signal strength and TOA measurements and the raw measurements may be processed by processor(s) 1 0.
  • transceiver 110 may include and/or be coupled to a RADAR unit, which ma be used to obtain non-GNSS displacement measurements.
  • the processors 150 may he implemented within one or more application specific integrated circuits (ASICs), digital signal processors (DSPs), digital signal processing devices (DSPDs), programmable logic devices (PLDs), field programmable gate arrays (PPG As), processors, controllers, micro-controllers, microprocessors, electronic devices, other electronic units designed to perform the functions described herein, or a combination thereof.
  • ASICs application specific integrated circuits
  • DSPs digital signal processors
  • DSPDs digital signal processing devices
  • PLDs programmable logic devices
  • PPG As field programmable gate arrays
  • processors controllers, micro-controllers, microprocessors, electronic devices, other electronic units designed to perform the functions described herein, or a combination thereof.
  • the methodologies may be implemented using code, procedures, functions, and so on that perform the -functions described herein. Any machine-readable medium tangibl embodying instructions may ⁇ be used in implementing the methodologies described herein.
  • software codes may be storcd in hon-transitory computer-readable medium 160 or memory 130 that is connected to and. executed by proeessor(s) .150.
  • Memory may be implemented within the processor unit or external to the processor unit As used herein the term
  • memory refers to any type of long term, short term, volatile, nonvolatile, or other memory and is not to be limited to any particular type of memory or number of memories, or type of media upon which memory is stored.
  • memory 130 ma hold program code that facilitates hybrid GNSS-VIO based location determination, image processing, and other tasks performed b CM 155, PE 156, and/or LADP 158, on processors) 150.
  • memory 160 may hold data, O SS satellite measurements, captured still images, depth information, video frames, program, results, as well as data provided by 1MU 170 and sensors 185.
  • the functions may be stored as one or more instructions or program code on a computer-readable medium, such as medium 160 and/or memory 130.
  • a computer-readable medium such as medium 160 and/or memory 130. Examples include- computer-readable media encoded with computer programs and data associated with or used by the program.
  • the computer-readable medium including program code stored thereon may include program code to support hybrid GNSS-VIO based position determination
  • Computer-readable media 160 includes physical computer storage media
  • a storage medium may be any available medium that can be accessed by a computer.
  • such -non-transitory computer-readable media can comprise RAM, ROM, EEPROM, CD-ROM, flash memory, or other optical disk storage, magnetic disk storage or other magnetic storage devices, or any other medium that can be used to store desired program code in the form of instructions and/or data and that can be accessed by a computer;
  • disk and disc includes compact disc (CD), laser disc, optical disc, digital versatile disc (DVD), floppy disk and bin-ray disc where disks usuall reproduce data magnetically, while discs reproduce data optically with lasers. Combinations of the above should also be included within the scope of computer-readable media.
  • instructions and/or data may be provided as signals on transmission media included in a
  • a communication apparatus may Include a transceiver .1 Ml, which may receive signals through receiver ! 12 indicative of instructions and data.
  • the instructions and data may cause one or more processors to implement hybrid GNSS-VIO based position deteroiination and/or other functions outlined herein. That is, the communication apparatus includes transmission media with signals indicative of information to perform disclosed functions.
  • Memory 130 may represent any data storage mechanism.
  • Memory 130 may include, for example, a primary memory and/or a secondary memory.
  • Primary memory may include, for example, a random access memory, read only memory, etc. While illustrated in this example as being separate from proeessorfs) 150, it should be understood that all or part of a primary memory may be provided within or otherwise eo-iocated coupied with processors) 150.
  • Secondary memory may include, for example, the same or similar type of memory as primary memory and/or one or more data storage devices or systems, such as, for example, a disk drive, an optical disc drive, a tape drive, a solid state memory drive, etc,
  • secondary memory may be operatively receptive of, or otherwise configurable to couple to a non-transitory computer-readable medium 160.
  • the methods and/or apparatuses presented herein may take the form in whole or part of a computer-readable medium 1 0 that ma include computer implemcntable instructions 1108 stored thereon, which if executed by at least one proeessorfs) 150 may be ope.rative.ly enabled to perform all or portions of the example operations as described herein.
  • Computer readable medium 160 may be a part of memory 130.
  • tJE .100 may include a screen or display 190 capable of rendering color images, including 3D images, in some embodiments, display 1 0 may be used to. display live images captured by camerafs) 180, Graphical User Interfaces (GUIs), program output etc.
  • displa 190 may comprise and/or be housed with a touchscreen to permi t users to input data via some combination of virtual keyboards, icons, menus, or other Graphical User interfaces (GUIs), user gestures and/or input devices such as a stylus and other writing implements.
  • GUIs Graphical User interfaces
  • display 190 may be implemented using a Liquid Crystal Display (LCD) display or a Light Emitting Diode (LED) display, such as an Organic LED (OLED) display.
  • LCD Liquid Crystal Display
  • LED Light Emitting Diode
  • display 1 0 may be housed, separately and may be operationally coupled to camera 180, processors) 150, and/or other functional units in UE 100,
  • processors 150 may also receive input from one or more sensors in sensor bank 85 (also referred to as "sensors .185"), which may include, for example, a magnetometer, altimeter and/or barometer.
  • the magnetometer may be capable of measuring the intensity and/or the direction of the Earth's magnetic fieid and may serve as a compass and/or provide an indication of a direction of travel of UE 100.
  • the altimeter may be used to provide -an indication of altitude above a calibrated level, while the barometer may provide an indication of atmospheric pressure, which may also be used to obtain a determination of altitude.
  • sensors 185 may include one or more of an ambient light sensor, acoustic transducers such as microphones/speakers, ultrasonic transducers, and/or depth sensors, which may be used to acquire depth information and/or determine distance to a target.
  • acoustic transducers such as microphones/speakers, ultrasonic transducers, and/or depth sensors, which may be used to acquire depth information and/or determine distance to a target.
  • the list of sensors above in not exhaustive and sensor bank 1 5 may include various other types of sensors and transducers which are increasingly being incorporated into user devices such as vehicle mounted devices, smartphones, and other mobile devices, in some embodiments, UE 100 may not include one or more sensors in sensor bank 185. For example, one or more of an altimeter, barometer, and/or magnetometer may be omitted.
  • Fig. 2 shows an architecture of a system 200 capable of providing
  • system 200 may be used to transfer of location assistance data such as updated almanac or ephemeris data for one or more GNSS satellites to the UEs 100.
  • location assistance data such as updated almanac or ephemeris data for one or more GNSS satellites
  • system 200 may be used for mapping or location services,, such as for use with hybrid GNSS-VK) based location/mapping, in a manner consistent with embodiments disclosed herein.
  • UE 100 may obtain GNSS satellite measurements, which, in some instances, may be captured in conjunction with the capture of images by camera(s) 180. The captured images and/or measurements may he used locally by UE 100 to detemiinc its location. [ ⁇ 07 ⁇
  • the UE 100 may communicate with server 250 through network 230 and base station ahtennas 240-1 - 240- , : collectively referred to as antennas 240, which may be associated with network 230,
  • Server 250 may, in some instances, provide the functionality of one or more of a location server, location assistance server, position determination entity (PDE), or another network enti ty. The transfer of the location and other information may occur at a rate appropriate to both UE 100 and server 250.
  • PDE position determination entity
  • system ! 00 may use messages such as LPP or
  • LPPe messages between UE 100 and server 250 The LPP Protocol is well-known and described in various publicly available technical specifications from an organization known as the 3rd Generation Partnership Project (3GPP). LPPe has been defined by the Open Mobile Alliance (QMA) and may be used in combination with LPP such that each combined LPP/LPPe message would be an LPP message comprising an embedded LPPe message.
  • 3GPP 3rd Generation Partnership Project
  • UE 100 may receive location assistance information seek as almanac / ephetneris data for one or more SVs (e.g. GNSS satellites) 280 from base station antennas 240, which may be used for position determination.
  • SVs e.g. GNSS satellites
  • Antennas 240 may form part of a wireless communication network, which may be a wireless wide area network (WWAN), wireless local, area network (WLAN), etc,
  • a WW AN may be a Code Division Multiple Access (CDMA) network, a Time Division Multiple Access (TDMA) network, a Frequency Division Multiple Access (F.DMA) network, an Orthogonal Frequency Division Multiple Access (OFDMA) network, a Single-Carrier Frequency Division Multiple Access (SC-FDMA) network, Long Terra Evolution (LTE), WiMax and so on.
  • CDMA Code Division Multiple Access
  • TDMA Time Division Multiple Access
  • F.DMA Frequency Division Multiple Access
  • OFDMA Orthogonal Frequency Division Multiple Access
  • SC-FDMA Single-Carrier Frequency Division Multiple Access
  • LTE Long Terra Evolution
  • a CDMA network may implement one or more radio access technologies (RATs) such as cdma2000, Wideband-CDMA (W-CDMA), and so on.
  • Cdma2000 includes 1S-95, IS-2000, and 1S-856 standards.
  • a TDMA network may implement Global System for Mobile Communications (GSM), Digital Advanced Mobile Phone System (D-AMPS), or some other RAT.
  • GSM, W-CDMA, and LTE are described in documents from an organization kno wn as the "3rd Generation Partnership Project' 5 (3GPP).
  • Cdma200 is described in documents from a consortium named "3rd Generation Partnership Project 2" (3GPP2). 3GPP and 3GPP2 documents, are publicly available.
  • a WLAN may be an IEEE 802.
  • antennas 240 and network 230 may form part of, e.g., an evolved UMTS Terrestrial Radio Access Network (E-UTRAN) (LTE) network, a W-CDMA UTRAN network, a GSM/EDGE Radio Access Network (GERAN), a IxRTT network, an E-UTRAN (LTE) network, a W-CDMA UTRAN network, a GSM/EDGE Radio Access Network (GERAN), a IxRTT network, an E-UTRAN (LTE) network, a W-CDMA UTRAN network, a GSM/EDGE Radio Access Network (GERAN), a IxRTT network, an E-UTRAN (LTE) network, a W-CDMA UTRAN network, a GSM/EDGE Radio Access Network (GERAN), a IxRTT network, an E-UTRAN (LTE) network, a W-CDMA UTRAN network, a GSM/EDGE Radio Access Network (GERAN), a IxRTT network, an E-
  • EvDO network a WiMax netw rk or a WLAN.
  • UE 100 may also receive signals from one or more Earth orbitin Space
  • SVs 280 Vehicles (SVs) 280 such as SVs 280-1 - 280-4 collectively referred to as SVs 280, which may be part of a GNSS.
  • SV's 280 may be in a GNSS constellation such as the US Global Positioning System (GPS), the European Galileo system, the Russian Glonass system, or the Chinese Compass system.
  • GPS Global Positioning System
  • the techniques presented ' herein arc not restricted to global satellite systems. For example, the techniques- provided.
  • an SBAS may include an augmentation system(s) that provides integrity information, differential corrections, ete., such as, e.g., . Wide Area Augmentation System (WA AS), European Geostationary Navigation Overlay Service (EGNOS), Mulu-i nctional Satellite
  • an SPS/GNSS may include any combination of one or more global and or regional navigation satellite systems and/or augmentation systems, and SPS/GNSS signals may include SPS, SPS-like, and/or other signals associated with such one or more
  • the SPS/G SS may also include other non-navigation dedicated satellite systems such as iridium or -One Web.
  • GNSS reeeiver!40 may be configured to receive signals from one or more of the above SPS/GNSS/satellite systems.
  • system 100 may comprise multiple cells indicated by 245-k (0 ⁇ k ⁇ N ⁇ is, where N ee s h is the number of ceils) with additional networks 230, LCS clients 260, UDs KM), . servers 250, (base station) antennas 240, and Space Vehicles (SVs) 280, System 100 may further comprise a mix of ceils including microeeils and fenrtocells in a manner consistent with embodiments disclosed herein,,
  • ' 0076J UE 100 may be capable of wirelessiy communicating with server 250 through one or more networks 230 that support positioning and location services to obtain, an initial coarse location, which may be used in conjunction with
  • UE 100 may use a hybrid GNSS-VIO based position determination and compute its position based on measurements from one or more of: IMU 170, and/or captured images and/or, GNSS carrier phase observables (e.g. based on measurements of signals recei ved from SVs 280).
  • FIG. 3A shows an example skyplot 300 of eight GNSS SVs 280-1 through 280-8 at a point in time.
  • Fig. 38 shows UE 100 in an urban environment. As shown in Fig. 3B, UE 100 is travelling along Avenue 1 along Path 310 starting at time point P0, As shown in Fig. 3B, UE 100 can receive LOS signals from GNSS SVs 280-1 and 2.80-2, However, because only 2 GNSS satellites are visible, UE UK) ma not be able to determine a full 3D location.
  • signals from GNSS S Vs 280-3, 280-4, 280-5, 280-6, 280-7, and 280-8 may be blocked or experience significant degradation due to an urban canyon environment thereby preventing MS 3D GNSS position location by UE 100.
  • UE 100 may receive LOS signals from GNSS SVs 280-1 , 280-2, 280-3 and 280-4, Accordingly, at point PI, UE 100 may be able to calculate full accurate 3D location based on carrier phase measurements from LOS signals received from GNSS SVs 280-1, 280-2, 280-3 and 280-4.
  • UE 100 may lose signals from GNSS SVs 280-3 and 280-4, which may be blocked or experience significant degradation including multtpath due to the urba canyo environment. ⁇ 0080] UE 100 may obtain / re-acquire a lock on GNSS SVs 280-3 and ' 280-4 In
  • non-GNSS positioning techniques may be used to determine the location of UE 100 by measuring displacement relative to the last GNSS carrier phase determined position.
  • the terms "non-GNSS positioning sensor 5 "non-GNSS positioning techniques", “non-GNSS position determination sensor” are used synonymously herein and refer to measurements by sensors and/of by techniques that do not depend on GNSS and may be used to determine the position of UE 100, For example, measurements provided by VIO and/or 1MU 170 and/or a LIDA ' senso may be used to determine relative displacement.
  • the known VIO determined location of UE 100 may be used to resolve carrier phase ambiguities as described further ' below.
  • Fig, 4 shows traditional carrier phase measurements 410 and exemplary
  • Hybrid G ' NSS-VJO carrier phase measurement 450 in accordance with some disclosed embodiments.
  • Traditional carrier phase measurement compares the continuous satellite carrier signal 420 with the receiver reference clock 430 to determine total phase ⁇ 422, which may then be used to determine position PI 470 of a UE at a given time.
  • continuous -carrier phase measurements are used to determined position s at subsequent times. For example, if (he phase at position P2 480 is ⁇ 2 428, then the phase difference 425 of the total phase given by ⁇ - ⁇ 2 ⁇ of carrier signal 420 ma be used to determine and track the positio of a UE,
  • Carrier phase measurements include an integer cycle ambiguity or carrier phase ambiguity" N' ⁇
  • the integer cycle ambiguity represents the number of ' Ml phase cy cles between the satellite and the receiver at the time the recei ver first locks on to a GNSS satellite signal.
  • the integer cycle ambiguity does not change from the ' time the receiver locks on until the end of the observation period, unless the signal is interrupted and/or lock is lost.
  • the receiver reacquires the signal the integer ambiguity has changed and the receiver count of the number of integer cycles from die time of initial lock is lost. Therefore, in conventional techniques loss of lock involves re-determining the integer ambiguity to when the carrier phase signal is reacquired. Further, the loss of lock also incurs a loss of accurate relative positioning until earner phase signal reacquisition is achieved.
  • Cycle slips In conventional positioning, cycle slips, which may occur because of environmental reasons, may degrade positioning accuracy. Cycle slips refer to discontinuities or interruptions in the series of carrier-phase measurements due to a receiver temporarily losing its lock on the carrier of a GNSS signal. For example, as shown in Fig. 4, interrupted carrier signal 460 is lost between good measurement window 1 462 and good measurement window 2 468. During the time that GNSS signal is interrupted, in con ventional carrier phase positioning, the receiver loses count of the number of consecutive changes in full phase cycles, which introduces errors and affects the accuracy and reliability of positioning. Thus, to maintain accuracy the process of resolving integer ambiguity is restarted. Moreover, because a loss of lock is not uncommon when odoraetry is performed in urban canyons, the use of carrier phase based techniques in conventional odoraetry has been constrained.
  • the relative displacement in the satellite direction may be determined to be M) m 465 between good measurement window 1 462 at posi tion PI
  • any nonTi SS positioning technique of similar accuracy may he used to determine the relative displacement in the satellite direction.
  • VIO measurements may be taken until the GNSS carrier phase measurement is once again available at measurement good measurement window 2 468.
  • Equation (I) may be used in a hybrid GNSS-VIO position determination system, to calculate phase difference between two instants t ' l and t2 in time w en GNSS measurements are available, even if carrier phase GNSS signals are unavailable between times tl and t2.
  • UE 1 0 first acquires GNSS signal from an SV at good measurement window i , the acquisition may begin initially at some fractional phase ⁇ 452.
  • the acquisition may .restart at some fractional phase ' 2 458.
  • the relative displacement &D m , 465 in. the satellite direction between points PI 470 and P2 480 may be measured using VIO or another non-GNSS method of sirailar accuracy.
  • the relative displacement ⁇ £) ;3 ⁇ 4> 465 may be used to calculate the phase difference A ⁇ p 455 using equation (1) above.
  • JiMi J Fig, 5 shows a UE 1 0 which may be in a vehicle at location PI 520 at time ti and travel to location P2 53 at time t2 along path 510 (shown, by the dashed line).
  • SV 280-1 is at position SI 1 540, while at time 2, SV 280-1 is at position -SI 2 550.
  • SV 280-2 is at position S21 560, while at time t2, SV 280-2 is at position S22 570.
  • ephemeris data may be used to determine locations SI.1 540 and S21 560 at time tl .
  • non-GNSS positioning techniques may be used to determine the position of UE 100 at time t2.
  • the movement of satellites: between times tl and t2 may be taken in to account.
  • the displacement of UE 100 relative to SV 280-1 at satellite position S12 550 and SV 280-2 at position S22 570 may be determined and used to resolve carrier phase ambiguities.
  • ephemeris data may be used to determine locations S.12 550 and S22 570 at time t2.
  • ephemeris data may be stored in memory 130 of U E 100 and/or an updated ephemeris may be obtained from wireless communication network 230 (Fig. 2).
  • the integer nature of the ambigui ies may be exploited to: (i) increase the accuracy of VIO displacement measurement (eg, to the order of a decimeter or less) thus compensating for VIO drift when aligning the local VIO spatial reference frame within a global reference frame; and (ii) to solve for all double difference ambiguities between two points successively occupied by the .same GPS/GNSS receiver,
  • UE 100 may collect fractional carrier phase measurements for all: visible satellites at a time tl (which may correspond, for example, to good measurement window 1 462 in Fig. 4).
  • measurements may be collected for signals meeting preset quality parameters. For example, outliers may be detected and eliminated. As another example, signals with large muitipath distortions may be detected and eliminated.
  • time t2 (which may correspond, for example, to good measurement window 2 468 in Fig. 4), the same UE 300 collects another set of fractional carrier phase data, when good quality signals are available.
  • VIO may be used to obtain an estimate of the relative displacement of UE 100 shown by length of 012 baseline 580 (or the distance) between position PI 520 at time tland position P2 530 at time f2.
  • the accuracy of the estimate may depend on the baseline distance between two locations.
  • Fig. 6 illustrates an example of single difference earner phase integer reconstruction / back projection according to some disclosed embodiments.
  • Fig 6 shows a simplified illustration of single difference case for a relative angle ⁇ , between the
  • the angle of SVs 280 (e.g. SV 280-1) relative to positions Pi and P2 may be may be viewed as relatively constant over the time period.
  • the carrier phase difference measured for the satellite 280-1 at two positions Pi 510 and P2 520 by the same receiver is projected onto the baseline between positions PI 510 mid P2 520.
  • the distanc difference in the LOS direction of the sateiiite generates a periodic likelihood function due to the integer nature of the lambda carrier phase ambiguity.
  • the periodic likelihood function can be thought as a series of narrow Gaussian curves, exhibiting a periodicity X in the direction of the satellite,
  • D !.2 baseline 580 exhibits a different periodicity given by, ⁇ / cos( f3 ⁇ 4 ) which depends on. the relative angle & i between, the LOS of satellite 280- and the displacement (e.g. D.12 baseline 580) baseline of UE 100.
  • the likelihood of the difference of two projected single differences for SVs 280-1 and 280-2 provides another compound likelihood function of similar periodic behavior, but with a different periodicity given by
  • the periodicity becomes arbi trarily large, and the number of possible solutions (i.e. for a non zero likelihood function) for the baseline becomes very small.
  • the increase in periodicity interval may be accompanied by an increase in width of the non zero domains (uncertainty).
  • the VIO likelihood function e.g. a single Gaussian with standard deviation equal to the VIO displacement uncertainty
  • the number of non zero domains may be reduced and a unique VIO displacement solution may be obtained. [0 9?
  • the combined likelihood function will have a vary limited num er of peaks.
  • the correct length of D12 baseline 580 corresponds to one of the peaks
  • a first estimate of the length of D12 baseline 580 may be obtained based on die peak location.
  • the first double difference solution is termed the "float ambiguity solution” or "float solution” because the ambiguities are estimated as real or floating point numbers.
  • the float solution is re-projected onto each satellite LOS, the float ambiguities are fixed and double difference integers may be solved and a single integer solution may be determined.
  • the VIO displacement estimate may be obtained as a maximum of the combined likelihood function.
  • the maximum of the combined likelihood function may exhibit a peak ' much narrower than the initial VIO uncertainty, thereby impro ving die VIO displacement solution beyond the VIO uncertainty.
  • each integer double difference ambiguity may then be extracted by subtracting the projected double difference fractional carrier phase from the computed VIO displacement: estimate, and then dividing by the apparent periodicity along the baseline.
  • the likelihood function re-projections are parameterized with the orientation and translation errors around initial rotation and translation matrices, and orientation and translation errors may be determined in conjunction with the VIO displacement
  • the accuracy of the DI2 baseline 580 length estimate may be further improved by re-projecting the integer distance onto the D12 baseline 580, then averaging all estimates by a variance weight. For example, each double difference-based estimate of the baseline will have a different associated uncertainty, thai is twice the carrier phase one-sigma noise (assuming that all 4 carrier phases have the same noise standard deviation), multiplied by the .re-projection factor onto the baseline. The re-projection factor may be determined as As the re-projection factor is different for each double
  • the accuracy for the baseline can be improved by computing a weighted sum of all. double difference contributions, roe weight being inversely proportional to the re- projection factor.
  • a simple form of the earner phase observahies may be written as: ⁇ ⁇ *3 ⁇ 4) - ⁇ (P l - P,)jj - c. ( ⁇ ⁇ ( - ⁇ )) - N - ⁇ . ⁇ ⁇ ,) -
  • - c. (T 2 (t f ) - r l (t f » - ⁇ Atf
  • A is GPS LI wavelength
  • P 3 is the first (fixed) position
  • P 2 (3 ⁇ 4) is the secon position of the receiver at. time 3 ⁇ 4
  • T 4' ⁇ 3 ⁇ 4) is die clock offset at satellite s at time t ( ;(in seconds)
  • T,. (i j) is the clock offset at receiver r at time 3 ⁇ 4 (in seconds)
  • /V is the integer number of wavelength ambiguities from satellite s to receiver r, on the total distance from satellite to receiver.
  • 0 s is the angle between the baseline from position I to position 2, and the direction of satellite s.
  • the minimum step size for the double difference ambiguity increase (or decrease) is ⁇ 1 .
  • the associated (discrete) step size for PI to P2 distance is
  • Each distinct pair of satellites provides one corresponding likelihood function, with a corresponding periodicity and the fractional phase or offset.
  • the overall likelihood function may be determined as the product of all likelihood functions by pairs of satellite, multiplied by the likelihood VIO function (centered around vector combination of VIO), with a standard deviation combination of the VIO displacement estimate error.
  • each "float" value of the double difference ambiguit is replaced by its closest integer.
  • Each double difference provides a ne integer estimate of VIO, weighted with the back-projected standard deviation.
  • T he fi nal VIO displacement estimate is the weighted average of all the individual estimates.
  • embodiments facilitate carrier phase integer reconstruction even when tracking is lost, between two times ⁇ 1 and t2.
  • [OOllGj Fig. 7 illustrates back projection using VIO or another noii-GNSS positioning estimate of relative displacement between points Pi 510 and P2 520 to resolve integer ambiguities for SVs 280- 1 and 280-2,
  • the first VIO distance estimate is the direct VIO distance estimaie 705
  • the second ViO distance estimate 715 is the back projected single difference of the satellite 280-1 with periodicity 710
  • the third VIO .distance estimate 725 is the back projected single difference of the satellite 280-2 with
  • Period 720 and so on. All these Hseasureraents pertain to the same baseline distance, but with periodic structures of different periodicities.
  • Gi ven the known accuracy of the direct VIO distance estimate 705, a set comprising the number of periodicities associated with each VIO distance estimate (e.g. 715, 725 , , .) may be determined, A relative displacement between points PI 510 and P2 520 may thus be determined where the non zero domains of the likelihood functions are aligned with each other.
  • die VIO displacement estimate may be obtained as a maximum, of the combined likelihood function,
  • FIG. 8 shows an exemplary method 800 for .hybrid G SS-VIO or hybrid GNSS - noB-GNSS position determination in accordance with some disclosed
  • method 800 may be performed by a single UE 100. In some embodiments, method 800 may be performed by processors ) 150 and one or more of FE 156 or CVF 155 on UE 100.
  • aad othet VIO /sensor measurements may be taken and recorded by UE periodically at some specified time intervai 3 ⁇ 4. For example, every t, time units starting at a time 3 ⁇ 4. Corresponding timestamped VIO and GNSS CP measurements ma also be recorded and stored in memory. Further, the measurements may be stored in a FIFO, ' The FIFO may be indexed, by satellite pairs and/or a separate FIFO may be maintained for each satelli te pair for which measurements have been obtained within some specified time interval of the current time. [00114] Jn some embodiments, in block 805.
  • the position estimate and velocity estimate of UE 100 may be determined, for example, in absolute co-ordinates from GNSS measurements, or by any other suitable approach.
  • the position may be determined in Earth Centric Earth Fixed (ECEF) coordinate frame.
  • the initial position estimate and velocity estimate of UE 100 may be determined from pseudorangc and Dopplcr .measurement.
  • the initial position estimate may be an approximate location.
  • the inaccuracy associated with the initial position estimate may be of the order of 100m or more.
  • a counter "k” winch maintains a count of the number of elapsed time intervals fy. ⁇ k since the initial .position, estimate at time to is initialized and set to 0,
  • a VIO process may be started. Is some embodiments, the VIO process may nm continuously to independently determine the relative position and displacement of UE 100.
  • Translation Matrices which may include parameters to convert relative VIO
  • the initial position estimate of UE 100 at time to may he selected as the origin of a local VIO coordinate system.
  • the VIO frame of reference may be initialized with one axis in the vertical direction and with the initial orientation set at 0.
  • VIO based displacement and camera pose (or UE pose) may be obtained in 6 Degrees of Freedom (6DOF) in the VIO local frame of reference. All the subsequent VIO positions and orientations will be cumulated translations and rotations from this initial position.
  • VIO-ECEF rotation and translation matrices may be determined based on the initial position of UE 100 in the absolute reference frame and the ini tial position of U E 1 0 in the local VIO reference frame, fCM!l 17)
  • the counter k may be incremented and UE may attempt t obtai the first/next available GNSS carrier phase measurements.
  • Jn block. 815, at a first or .next time t if a sufficient slumber of GNSS carrier phase measurements: a available ( ⁇ ' in block 8.15),. then, in block 817, the position of UE 100 may be obtained based on die available GNSS carrier phase measurements.
  • the determined position of U E 100 may be used to refine the VIO-ECEF translation and rotation matrices.
  • the VIO determined position and displacement at time t3 ⁇ 4 ⁇ *t s may be stored i memory 130.
  • GNSS carrier phase measurements for "if satellites are available then, the measurements may be grouped by satellite pairs so that a total of -— ⁇ — -measurements corresponding to distinct pairs of satellites may be obtained from the -measurements of the n satellites, in some embodiments, satellites for which GNSS carrier phase measurements arc available may be grouped in pairs and the measurements associated with one or more satellite pairs may be stored in a FIFO in memory 130 of UE 100.
  • the FIFO in memory 130 of U E 100 may be cheeked to determine if the CP measurements in the FIFO include prior CP measurements for at least one pair of currently (at time fc) measured satellites that were previously measured together within some time window of the current time. [00123] if the FIFO does not include prior measurements for at least one pair of currentl measured satellites within the time window ("N" in step 835), men, in block 840, the GNSS carrier phase measuremen s for time 3 ⁇ 4 may be stored and counter k is incremented prior to beginning another iteration in block 813.
  • the FIFO includes prior measurements within some time window for some number q (q >. i) pairs of currently measured satellites ("N" in ste 835), then, in block 845, the most recent of prior earner phase measurements for the q curre tly measured satellite pairs may be validated.
  • the validation may be determined from the double difference of the snapshots of the carrier phase observabi.es for the r (r ⁇ q) satellite pairs (feat were measured both at time hi nd time t ⁇ 3 ⁇ 4.
  • p s;. in some embodiments, the double difference of the snapshots of the earner phase observabies for the r satellite pairs measured at times and time %.
  • p( *i may be projected onto the baseline and validated against VIO displacement that occurred during the time interval p*t, between k*t, and (k -/>)*3 ⁇ 4.
  • the VIO displacement in between times 3 ⁇ 4 and t3 ⁇ 4-p> * i may he determined based on the difference between the VIO determined.
  • the VIO pose of the UE at given tim may be determined by tracking features in images captured by a camera coupled to the UE and/or IMU measurements.
  • corresponding measurements that are validated may be tagged as validated and a corresponding count of validated measurements for the satellite pair may be incremented.
  • a subset $ ⁇ a ⁇ r) of the r satellite pairs may be tagged as validated and, for each of the satellite pairs, the corresponding count of validated measurements may he increased,
  • the translation and rotation matrices at time k*3 ⁇ 4 may be determined based on the at least one validated double difference measurement in ,s.
  • a corrected VIO displacement which compensates for the VIO drift, may then be determined using Vernier's principle (e.g. a described abo ve in relation t Figs, 6 and 7).
  • Vernier's principle e.g. a described abo ve in relation t Figs, 6 and 7.
  • the double difference traditional observab.es may be reconipui ed, and integer ambiguities may be solved.
  • likelihood functions with different respective periodicities may be used along with ⁇ he estimated ViO/non-GNSS measurement to determine a maximum of all the likelihood functions.
  • the maximum of ail the likelihood functions may be determined as that displacement where all the non zero domains of each likelihood function are aligned wi th each other within the known accuracy of the VIO
  • corrections to ail Independent parameters of translation and rotation matrices may be determined using global bundle adjustment.
  • global bundle adjustment multiple double differences (for the same satellite pairs) measured at multiple time instants are used for matrix corrections at multiple instants.
  • the depth of the bundle estimation may be adjusted depending on the severity of the VIO drift.
  • the depth of the FIFO may also be adjusted accordingly.
  • the corrections which compensate for iranslational and rotational VIO drift, may yield accurate translation and rotation matrices, which may permit
  • the position of UE .100 may be computed in absolute coordinates (e.g. ECEF coordinates).
  • the rotation and translation matrices solved for in step 855 are directly used for absolute position computation.
  • Fig. 9 shows an exemplary method 900 for hybrid GNSS-VIO or hybrid GNSS - non-G SS position determination in accordance with some disclosed embodiments,
  • method 900 may be performed by a single UE 100.
  • method 900 may be performed by proeessorfs) 150 nd one or more of PE J S6 or €VP 155 on lJE 100.
  • a first absolute position of the UE at a first lime (tl) may be determined (e.g. by UE 100) based on GNSS measurements from a set of satellites at the first time (tl). In some embodiments, the first absolute position of the UE at a first time (tl ) may be determined and/or obtained using any appropriate method.
  • a first displacement of the UE relative to the first absolute position may be determined, wherein the second time (t2) is subsequent to the first time (tl), wherein the
  • the non-GNSS measurements may include one or more of: Visual Inertia! Odometry (VIO) measurements, and/or measurements provided by an IMU, and/or Light Detection and Ranging (LiDA ) measurements, and/or Radio Detection And Ranging (RADAR) measurements, in some embodiments, the VIO measurements used to ' determine displacement may " be based, at least in part, on: tracking a plurality of features across a plurality of images captured by a camera coupled to the UE to obtain a 6 Degrees of Freedom (6DOF) pose of the UE relative to the first absolute position, wherein the plurality of images are captured in a time interval between the first time (tl ) and the second time (t2), or tracking optical flow from the plurality of images,
  • 6DOF 6 Degrees of Freedom
  • the displacement of the UE relati ve to the first absolute position may he determined at the second time (t2) based, in part, on: (a) GNSS carrier phase measurements at the secood time (t ' 2 from a subset comprising two or more satellites of the set of satellites, and (b) the first estimate of the displacement of the UE.
  • all or part of GNSS measurements may be unavailable between times tl and t2 because of; a temporary loss of lock and/or discontinuities and/or interruptions of GNSS signals; various environmental (including atmospheric, geographical, etc) conditions that may detrimentally affect reception and/or reliability of GNSS signals: and/or non-availability of GNSS signals.
  • the second estimate of the displacement of the UE may be used, for example, to correct drift, biases, or other errors .of the eon GNSS sensor, j ⁇ HH40)
  • the ' second estimate of the displacement of the UE may be determined by resolving a corresponding carrier phase ambiguity for each satellite in the subset based, in part, on: (a) GNSS carrier phase measurements for satellites in the subset at the first lime (tl), and (b) the fust estimate of displacement of the UE, in some embodiments, the corresponding carrier phase ambiguity tor eac satellite in the subset of two or more satellites may be resolved by; determining one or more satellite pairs in me subset of two or more satellites, and projecting, for eac h satellite pair of the one or more satellite pairs in the subset, a corresponding periodic likelihood function on to a baseline represented by the first estimate of the displacement of the UE.
  • Each periodic likelihood function may be based on the corresponding doable differenced GNSS carrier phase measurement tor the satellite pair. Further, a combined likelihood function may be determined as a function of the corresponding periodic likelihood functions for the one or more satellite pairs and a non-periodic likelihood function corresponding to the baseline. Integral carrier phase ambiguities for each satellite may then be determined based, in part, on the combined likelihood function. In some embodiments, a second estimate of displacement of the UE may be determined based,, in part, on a maximum of the combined likelihood function and the first absolute position.
  • a second absolute position of the UE may be determined based on the second estimate of displacement of the UE.
  • the method may further include correcting one or more of; a plurality rotational rameter, or a plurality- of ranslational parameters, wherein the rotational parameters and the translatidnal parameters -are- used to transform, the nou-GNSS measurements from a local coordinate system to an absolute coordinate system used to represent the first absolute position and the second absolute position.
  • the processor 1 152 may be implemented within one or more application specific integrated circuits (ASICs), digital signal processors (DSPs), digital signal processing devices (DSPDs), programmable logic devices (PLDs), field programmable gate arrays (FPGAs), processors, controllers, micro-controllers, microprocessors, electronic devices, other electronic units designed to perform the functions described herein, or a combination thereof.
  • ASICs application specific integrated circuits
  • DSPs digital signal processors
  • DSPDs digital signal processing devices
  • PLDs programmable logic devices
  • FPGAs field programmable gate arrays
  • processors controllers, micro-controllers, microprocessors, electronic devices, other electronic units designed to perform the functions described herein, or a combination thereof.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)
PCT/US2016/042286 2015-07-27 2016-07-14 Visual inertial odometry attitude drift calibration Ceased WO2017019315A1 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2018503752A JP2018526626A (ja) 2015-07-27 2016-07-14 視覚慣性オドメトリ姿勢ドリフト較正
EP16745296.0A EP3329301B1 (en) 2015-07-27 2016-07-14 Visual inertial odometry attitude drift calibration
CN201680042038.2A CN107850673B (zh) 2015-07-27 2016-07-14 视觉惯性测距姿态漂移校准

Applications Claiming Priority (6)

Application Number Priority Date Filing Date Title
US201562197510P 2015-07-27 2015-07-27
US62/197,510 2015-07-27
US201662304062P 2016-03-04 2016-03-04
US62/304,062 2016-03-04
US15/078,862 2016-03-23
US15/078,862 US10324195B2 (en) 2015-07-27 2016-03-23 Visual inertial odometry attitude drift calibration

Publications (1)

Publication Number Publication Date
WO2017019315A1 true WO2017019315A1 (en) 2017-02-02

Family

ID=57882357

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/US2016/042286 Ceased WO2017019315A1 (en) 2015-07-27 2016-07-14 Visual inertial odometry attitude drift calibration

Country Status (5)

Country Link
US (1) US10324195B2 (enExample)
EP (1) EP3329301B1 (enExample)
JP (1) JP2018526626A (enExample)
CN (1) CN107850673B (enExample)
WO (1) WO2017019315A1 (enExample)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109490931A (zh) * 2018-09-03 2019-03-19 天津远度科技有限公司 飞行定位方法、装置及无人机

Families Citing this family (41)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9933263B2 (en) * 2016-04-22 2018-04-03 Novatel Inc. System and method for long baseline accelerometer/GNSS navigation
US10520943B2 (en) * 2016-08-12 2019-12-31 Skydio, Inc. Unmanned aerial image capture platform
US10578748B2 (en) * 2016-10-14 2020-03-03 Eung Gi Paek High-performance time transfer using time reversal (T3R)
US10849134B2 (en) 2016-11-04 2020-11-24 Qualcomm Incorporated Indicating a range of beam correspondence in a wireless node
US11295458B2 (en) 2016-12-01 2022-04-05 Skydio, Inc. Object tracking by an unmanned aerial vehicle using visual sensors
US10859713B2 (en) 2017-01-04 2020-12-08 Qualcomm Incorporated Position-window extension for GNSS and visual-inertial-odometry (VIO) fusion
US10267924B2 (en) 2017-01-04 2019-04-23 Qualcomm Incorporated Systems and methods for using a sliding window of global positioning epochs in visual-inertial odometry
US10371530B2 (en) 2017-01-04 2019-08-06 Qualcomm Incorporated Systems and methods for using a global positioning system velocity in visual-inertial odometry
US11138742B2 (en) 2017-02-14 2021-10-05 The Trustees Of The University Of Pennsylvania Event-based feature tracking
US10327218B2 (en) 2017-03-16 2019-06-18 Qualcomm Incorporated Robust downlink positioning
KR102463176B1 (ko) 2017-10-16 2022-11-04 삼성전자주식회사 위치 추정 장치 및 방법
US10514456B2 (en) 2017-11-29 2019-12-24 Qualcomm Incorporated Radar aided visual inertial odometry outlier removal
US10739784B2 (en) * 2017-11-29 2020-08-11 Qualcomm Incorporated Radar aided visual inertial odometry initialization
US11740321B2 (en) * 2017-11-30 2023-08-29 Apple Inc. Visual inertial odometry health fitting
US10948605B2 (en) * 2017-12-21 2021-03-16 Valeo Comfort And Driving Assistance Broadcast and utilization of precise GNSS correction data
WO2019167517A1 (ja) * 2018-02-28 2019-09-06 古野電気株式会社 航法装置、vslam補正方法、空間情報推定方法、vslam補正プログラム、および、空間情報推定プログラム
US11609346B2 (en) * 2018-05-29 2023-03-21 Topcon Positioning Systems, Inc. GNSS-based attitude determination algorithm and triple-antenna GNSS receiver for its implementation
EP3855216A4 (en) * 2018-09-21 2022-07-06 Furuno Electric Co., Ltd. NAVIGATION DEVICE AND METHOD AND PROGRAM FOR GENERATION OF NAVIGATION ASSISTANCE INFORMATION
US11032189B2 (en) * 2018-09-28 2021-06-08 Lg Electronics Inc. Method for transmitting packet when radio link failure is detected in wireless communication system and apparatus therefor
CN111025339B (zh) * 2018-10-09 2022-04-15 百度在线网络技术(北京)有限公司 确定定位延时的方法、装置、设备和计算机可读存储介质
JP7521532B2 (ja) * 2019-07-08 2024-07-24 ソニーグループ株式会社 情報処理装置、情報処理方法およびプログラム
EP4028844B1 (en) * 2019-09-09 2024-11-27 Mtd Products Inc. Real time kinematics power equipment device with auto-steering
CN110426717B (zh) * 2019-09-12 2021-08-03 香港理工大学 一种协同定位方法及系统、定位设备、存储介质
US12174305B2 (en) 2019-09-19 2024-12-24 Nippon Telegraph And Telephone Corporation Position measurement system, positioning calculation apparatus, position measurement method and program
WO2021070813A1 (ja) 2019-10-08 2021-04-15 株式会社デンソー 誤差推定装置、誤差推定方法、誤差推定プログラム
WO2021070814A1 (ja) 2019-10-08 2021-04-15 株式会社デンソー 同期装置、同期方法、同期プログラム
US11921522B2 (en) * 2019-11-04 2024-03-05 The Regents Of The University Of California Sub-meter accurate navigation and cycle slip detection with long-term evolution (LTE) carrier phase measurements
CN111272181B (zh) * 2020-02-06 2022-04-26 北京京东乾石科技有限公司 构建地图的方法、装置、设备和计算机可读介质
US11785176B1 (en) 2020-02-28 2023-10-10 Apple Inc. Ambient light sensor-based localization
CN111487859A (zh) * 2020-04-29 2020-08-04 莆田市信田农业科技有限公司 一种无人机自动驾驶仪安全冗杂方法及装置
EP4200646A4 (en) 2020-08-20 2024-06-26 QUALCOMM Incorporated DETECTION AND CALCULATION OF THE POSITION OF A DGNSS/RTK BASE STATION
CN112230240A (zh) * 2020-09-30 2021-01-15 深兰人工智能(深圳)有限公司 激光雷达与相机数据的时空同步系统、装置及可读介质
CN113242597B (zh) * 2021-05-13 2023-06-02 北斗星通智联科技有限责任公司 位姿信息的确定方法、装置及终端设备
CN113325454B (zh) * 2021-05-18 2022-06-14 武汉大学 一种基于ArduRover无人车的组合定位方法
CN113296139B (zh) * 2021-05-27 2022-05-03 桂林电子科技大学 一种自适应图像光流与rtk融合测姿方法
KR102860889B1 (ko) 2021-07-29 2025-09-18 삼성전자주식회사 포즈를 추정하는 방법 및 장치
CN113884098B (zh) * 2021-10-15 2024-01-23 上海师范大学 一种基于具体化模型的可迭代的卡尔曼滤波定位方法
US12078738B2 (en) * 2021-11-09 2024-09-03 Msrs Llc Method, apparatus, and computer readable medium for a multi-source reckoning system
CN116929407A (zh) * 2022-04-02 2023-10-24 北京三快在线科技有限公司 一种自适应数据校准方法及装置
CN117450910B (zh) * 2023-10-12 2025-07-08 中铁工程设计咨询集团有限公司 一种基于虚拟基准站的变形解算方法、装置、设备及介质
US12259246B1 (en) 2024-05-13 2025-03-25 Msrs Llc Method, apparatus, and computer readable medium for calculating a handrail influence intensity factor

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6720913B1 (en) * 2002-11-08 2004-04-13 Honeywell International Inc. Lock slip detection using inertial information
US20060012493A1 (en) * 2002-12-17 2006-01-19 Karlsson L N Systems and methods for incrementally updating a pose of a mobile device calculated by visual simultaneous localization and mapping techniques
US20130135145A1 (en) * 2011-11-24 2013-05-30 Kabushiki Kaisha Toyota Chuo Kenkyusho Positioning device and storage medium
US20130234885A1 (en) * 2012-03-08 2013-09-12 Raytheon Company Global Positioning System (GPS) Carrier Phase Cycle Slip Detection and Correction

Family Cites Families (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11281728A (ja) * 1998-03-31 1999-10-15 Japan Aviation Electronics Ind Ltd キネマテック法gpsと慣性航法装置併用測位方法
JP2001099910A (ja) * 1999-10-04 2001-04-13 Japan Aviation Electronics Industry Ltd Rtk・gps−imu併用測位方法
US7221313B2 (en) * 2005-07-05 2007-05-22 Center For Remote Sensing, Inc. GPS receiver with calibrator
US7532159B2 (en) * 2006-05-19 2009-05-12 Trimble Navigation Limited Fast time to first fix by calibration of a real time clock
CN102017741A (zh) * 2008-04-29 2011-04-13 爱立信电话股份有限公司 使用e-utran测量的无线电指纹识别
ATE477508T1 (de) * 2008-04-30 2010-08-15 Gmv Aerospace And Defence S A Verfahren für autonome bestimmung von sicherheitsebenen für gnss-positionierung auf basis von navigationsanpassungsfehlern und isotroper konfidenzrate
WO2009140768A1 (en) * 2008-05-22 2009-11-26 Novatel Inc. Gnss receiver using signals of opportunity and assistance information to reduce the time to first fix
US8164514B1 (en) 2009-05-07 2012-04-24 Chun Yang Method and apparatus for fusing referenced and self-contained displacement measurements for positioning and navigation
US8350756B2 (en) * 2010-01-12 2013-01-08 Andrew Llc Detecting and compensating for erroneous time measurement for mobile device position calculation
JP5586994B2 (ja) 2010-03-11 2014-09-10 三菱電機株式会社 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム
US20110299644A1 (en) * 2010-06-08 2011-12-08 Bing Xu Emission Suppression for Wireless Communication Devices
US8756001B2 (en) 2011-02-28 2014-06-17 Trusted Positioning Inc. Method and apparatus for improved navigation of a moving platform
GB2491218B (en) * 2011-12-22 2013-06-26 Renesas Mobile Corp Timing-based positioning
US9370040B2 (en) * 2011-12-27 2016-06-14 Qualcomm Incorporated Methods and apparatus for improving NFC LLCP partitioning
US9374134B2 (en) * 2012-02-02 2016-06-21 Qualcomm Incorporated Methods and apparatus for improving the identification of multiple NFC-A devices
US9552503B2 (en) * 2012-05-01 2017-01-24 5D Robotics, Inc. Distributed positioning and collaborative behavior determination
US9726748B2 (en) * 2012-09-21 2017-08-08 Qualcomm Incorporated Cyclic shift delay detection using signaling
US20150019159A1 (en) * 2013-07-15 2015-01-15 Honeywell International Inc. System and method for magnetometer calibration and compensation
US20150092048A1 (en) 2013-09-27 2015-04-02 Qualcomm Incorporated Off-Target Tracking Using Feature Aiding in the Context of Inertial Navigation
US20150219767A1 (en) 2014-02-03 2015-08-06 Board Of Regents, The University Of Texas System System and method for using global navigation satellite system (gnss) navigation and visual navigation to recover absolute position and attitude without any prior association of visual features with known coordinates
CN104297773B (zh) * 2014-02-27 2017-06-06 北京航天时代光电科技有限公司 一种高精度北斗三频sins深组合导航系统
CN104459731B (zh) * 2014-11-27 2017-01-04 上海交通大学 一种接收极弱gnss信号的高轨卫星定轨方法
US10132933B2 (en) * 2016-02-02 2018-11-20 Qualcomm Incorporated Alignment of visual inertial odometry and satellite positioning system reference frames
US10371530B2 (en) * 2017-01-04 2019-08-06 Qualcomm Incorporated Systems and methods for using a global positioning system velocity in visual-inertial odometry
US10859595B2 (en) * 2017-04-04 2020-12-08 Qualcomm Incorporated Systems and methods for improving location accuracy for a mobile device using sensors

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6720913B1 (en) * 2002-11-08 2004-04-13 Honeywell International Inc. Lock slip detection using inertial information
US20060012493A1 (en) * 2002-12-17 2006-01-19 Karlsson L N Systems and methods for incrementally updating a pose of a mobile device calculated by visual simultaneous localization and mapping techniques
US20130135145A1 (en) * 2011-11-24 2013-05-30 Kabushiki Kaisha Toyota Chuo Kenkyusho Positioning device and storage medium
US20130234885A1 (en) * 2012-03-08 2013-09-12 Raytheon Company Global Positioning System (GPS) Carrier Phase Cycle Slip Detection and Correction

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
TRAUGOTT J ET AL: "A Time-Relative Approach for Precise Positioning with a Miniaturized L1 GPS Logger", GNSS 2008 - PROCEEDINGS OF THE 21ST INTERNATIONAL TECHNICAL MEETING OF THE SATELLITE DIVISION OF THE INSTITUTE OF NAVIGATION (ION GNSS 2008), THE INSTITUTE OF NAVIGATION, 8551 RIXLEW LANE SUITE 360 MANASSAS, VA 20109, USA, 19 September 2008 (2008-09-19), pages 1883 - 1894, XP056002773 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109490931A (zh) * 2018-09-03 2019-03-19 天津远度科技有限公司 飞行定位方法、装置及无人机

Also Published As

Publication number Publication date
US20170031032A1 (en) 2017-02-02
CN107850673B (zh) 2021-07-27
EP3329301B1 (en) 2019-08-21
US10324195B2 (en) 2019-06-18
EP3329301A1 (en) 2018-06-06
CN107850673A (zh) 2018-03-27
JP2018526626A (ja) 2018-09-13

Similar Documents

Publication Publication Date Title
EP3329301B1 (en) Visual inertial odometry attitude drift calibration
US9947100B2 (en) Exterior hybrid photo mapping
US10267924B2 (en) Systems and methods for using a sliding window of global positioning epochs in visual-inertial odometry
US10371530B2 (en) Systems and methods for using a global positioning system velocity in visual-inertial odometry
US10327218B2 (en) Robust downlink positioning
US10502840B2 (en) Outlier detection for satellite positioning system using visual inertial odometry
WO2010063844A1 (fr) Procede de geo-localisation d'un objet par multitelemetrie
US20220276394A1 (en) Map-aided satellite selection
US12235349B2 (en) Position accuracy using sensor data
EP3137923A1 (en) Dead reckoning system based on locally measured movement
FR2939517A1 (fr) Procede de geo-localisation d'un objet par multitelemetrie

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 16745296

Country of ref document: EP

Kind code of ref document: A1

DPE1 Request for preliminary examination filed after expiration of 19th month from priority date (pct application filed from 20040101)
ENP Entry into the national phase

Ref document number: 2018503752

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 2016745296

Country of ref document: EP