Electronic device for estimating relative position and pose and operating method of the same

Patent metadata

Field	Value
Publication number	US-12429550-B2
Application number	US-202318216112-A
Country	US
Kind code	B2
Filing date	Jun 29, 2023
Priority date	Jun 30, 2022
Publication date	Sep 30, 2025
Grant date	Sep 30, 2025

Abstract

An electronic device includes a first sensor including an anchor and a tag, and a second sensor including an inertial sensor and a geo-magnetic sensor, and a processor configured to estimate a first relative position of an external electronic device based on a time of arrival at which a signal from the anchor arrives at the external device, estimate a first relative pose of the external electronic device, based on measurements of the inertial sensor and the geo-magnetic sensor, convert an acceleration of the electronic device in a sensor frame into an acceleration in a navigation frame, based on the relative pose of the external electronic device, calculate a relative acceleration of the external device, based on the converted acceleration, and estimate a relative position and a relative pose of the external electronic device by applying the calculated relative position and the first relative position of the external electronic device to an Extended Kalman Filter.

First claim

What is claimed is:

1. An electronic device comprising:
a first sensor comprising: at least one anchor configured to transmit a signal having a preset frequency, and a tag;
a second sensor comprising an inertial sensor configured to measure an acceleration of the electronic device and an angular velocity of the electronic device, and a geo-magnetic sensor configured to measure a magnetic field around the electronic device;
a memory storing at least one instruction; and
a processor operatively connected to the first sensor and the second sensor,

wherein the processor is configured to execute the at least one instruction to:
estimate a first relative position of the external electronic device relative to the electronic device, based on a time of arrival at which a signal transmitted from the at least one anchor arrives at the external electronic device,
estimate a first relative pose of the external electronic device relative to the electronic device, based on a value measured by the inertial sensor and a value measured by the geo-magnetic sensor,
convert an acceleration of the electronic device in a sensor frame, measured by the inertial sensor, into an acceleration of the electronic device in a navigation frame, based on the estimated first relative pose of the external electronic device relative to the electronic device,
calculate a relative acceleration of the external electronic device relative to the electronic device, based on the converted acceleration of the electronic device in the navigation frame, and
estimate a relative position and a relative pose of the external electronic device relative to the electronic device by applying the calculated relative acceleration and the estimated first relative position of the external electronic device to an Extended Kalman Filter.

2. The electronic device of claim 1 , wherein the first sensor comprises:
a first anchor disposed parallel to the tag;
a second anchor spaced apart from the first anchor and arranged parallel to the tag;
a third anchor disposed perpendicular to the tag; and
a fourth anchor spaced apart from the third anchor and disposed perpendicular to the tag.

3. The electronic device of claim 2 , wherein the first anchor, the second anchor, the third anchor, and the fourth anchor are arranged radially with reference to the tag, and
wherein the tag is disposed at a central position between of the first anchor and the second anchor, and between the middle of the third anchor and the fourth anchor.

4. The electronic device of claim 2 , wherein the processor is further configured to execute the at least one instruction to:
measure a range between the first anchor, the second anchor, the third anchor, the fourth anchor and a tag of the external electronic device, based on a time of arrival at which signals transmitted from the first anchor, the second anchor, the third anchor, and the fourth anchor arrive at the tag of the external electronic device,
calculate, through a moving average filter, a moving average of the measured range between the first anchor, the second anchor, the third anchor, the fourth anchor and the tag of the external electronic device, after excluding a maximum value and a minimum value of the measured range between the first anchor, the second anchor, the third anchor, the fourth anchor and the tag of the external electronic device, and
calculate the relative position of the external electronic device relative to the electronic device, based on the calculated moving average.

5. The electronic device of claim 4 , wherein the processor is further configured to execute the at least one instruction to:
estimate the first relative position by applying, to the Extended Kalman Filter, the estimated relative position of the external electronic device relative to the electronic device.

6. The electronic device of claim 1 , wherein the processor is further configured to execute the at least one instruction to:
estimate a pose and a gyro bias of the electronic device by applying, to a Kalman Filter, the value measured by the inertial sensor and the value measured by the geo-magnetic sensor.

7. The electronic device of claim 1 , wherein the processor is further configured to execute the at least one instruction to:
calculate the relative acceleration of the external electronic device relative to the electronic device, based on a difference between the acceleration of the electronic device in the navigation frame and an acceleration of the external electronic device in the navigation frame obtained from the external electronic device.

8. The electronic device of claim 1 , wherein the processor is further configured to execute the at least one instruction to:
estimate a second relative position of the external electronic device relative to the electronic device, based on the calculated relative acceleration of the external electronic device relative to the electronic device.

9. The electronic device of claim 8 , wherein the processor is further configured to execute the at least one instruction to:
estimate the second relative position by performing a double integral with respect to the relative acceleration of the external electronic device relative to the electronic device.

10. The electronic device of claim 8 , wherein the processor is further configured to execute the at least one instruction to:
fuse the first relative position and the second relative position through the Extended Kalman Filter.

11. The electronic device of claim 10 , wherein the processor is further configured to execute the at least one instruction to:
apply the first relative position and the second relative position to the Extended Kalman Filter in which a relative position error, a relative velocity error, and a relative acceleration bias error of the external electronic device relative to the electronic device are set as state parameters.

12. The electronic device of claim 11 , wherein the processor is further configured to execute the at least one instruction to:
estimate the relative position of the external electronic device relative to the electronic device based on the relative position, the relative velocity, and the relative acceleration bias of the external electronic device relative to the electronic device estimated through the Extended Kalman Filter.

13. A method of estimating a relative position and a relative pose of an external electronic device relative to an electronic device, the method comprising:
estimating a first relative position of the external electronic device relative to the electronic device, based on a time of arrival at which a signal transmitted from at least one anchor of the electronic device arrives at the external electronic device;
estimating a first relative pose of the external electronic device relative to the electronic device, based on a value measured by an inertial sensor of the external device and a value measured by a geo-magnetic sensor of the external device;
converting an acceleration of the electronic device in a sensor frame, measured by the inertial sensor, into an acceleration of the electronic device in a navigation frame, based on the estimated first relative pose of the external electronic device relative to the electronic device;
calculating a relative acceleration of the external electronic device relative to the electronic device, based on the converted acceleration of the electronic device in the navigation frame; and
estimating a relative position and a relative pose of the external electronic device relative to the electronic device by applying the calculated relative acceleration and the estimated first relat

Assignees

• Samsung Electronics Co Ltd
• Industry Academia Cooperation Group Of Sejong Univ

Inventors

• Lee Heesae
• Kim Hyungseok
• Park Soyoung
• Sagar A S M Sharifuzzaman
• Kim Hanjun
• Bae Hanwook
• Jeon Hyuncheol
• Hong Seokpyo

Classifications

• G01S5/0284

  Relative positioning · CPC title

• G01S5/0294

  Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering · CPC title

• G01S5/14

  Determining absolute distances from a plurality of spaced points of known location · CPC title

• G01C19/02

  Rotary gyroscopes · CPC title

• G01C17/30

  Earth-inductor compasses · CPC title