SYSTEMS AND METHODS FOR PROVIDING MULTIPLE STRAPDOWN SOLUTIONS IN ONE ATTITUDE AND HEADING REFERENCE SYSTEM (AHRS)
Various systems benefit from suitable mechanisms and methods for dealing with sensor inaccuracy. For example, various attitude and heading reference system (AHRS) approaches may benefit from systems and methods for providing multiple strapdown solutions. A system can include a plurality of three-axis sensors configured to measure physical quantities (e.g. acceleration, rotational rate), from which can be computed roll, pitch, and heading for a device. The system can also include a controller configured to receive output of the plurality of three-axis sensors as a plurality of inputs, determine a plurality of strapdown solutions each solution of the plurality of solutions based on respective output of the plurality of three-axis sensors, each of which consists of roll, pitch, and possibly heading, weight each output of the plurality of output solutions based on a relation between a given output solution and the other output solutions of the plurality of solutions, and report the roll, pitch, and heading of the device.
1 . A system, comprising:
a plurality of three-axis sensors configured to measure physical quantities from which can be computed roll, pitch, and heading for a device;
a controller configured to
receive output of the plurality of three-axis sensors,
determine a plurality of solutions each solution of the plurality of solutions based on respective output of the plurality of three-axis sensors,
weight each of the plurality of solutions based on a relation between a given solution and the other solutions of the plurality of solutions, and
report the roll, pitch, and heading of the device.
2 . The system of claim 1 , wherein the controller is configured to obtain a median of the plurality of solutions, wherein the relation comprises a relation to the median.
3 . The system of claim 2 , wherein the controller is configured to weight a given solution of the plurality of solutions with a weight of 1 when the given solution is within a first predetermined threshold of the median.
4 . The system of claim 3 , wherein the controller is configured to weight the given solution of the plurality of solutions with a weight that scales from 1 to 0 when the given solution is beyond the first predetermined threshold of the median but within a second predetermined threshold of the median.
5 . The system of claim 4 , wherein the controller is configured to weight the given solution of the plurality of solutions with a weight of 0 when the given solution is beyond the second predetermined threshold of the median.
6 . The system of claim 2 , wherein the median of at least one of the roll, the pitch, or the heading is determined by computing a circular median or circular mean.
7 . The system of claim 1 , wherein the controller is configured to determine weighting separately for heading.
8 . The system of claim 1 , wherein the controller is configured to report the roll, pitch, and heading of the device to a navigation system.
9 . The system of claim 1 , wherein the controller is configured to report the roll, pitch, and heading of the device to a user interface of an aircraft.
10 . The system of claim 1 , wherein the device comprises an unmanned aerial vehicle.
11 . A method, comprising:
receiving, at a controller, output of a plurality of three-axis sensors configured to measure physical quantities from which can be computed roll, pitch, and heading for a device,
determining, by the controller, a plurality of solutions each solution of the plurality of solutions based on respective output of the plurality of three-axis sensors,
weighting, by the controller, each of the plurality of solutions based on a relation between a given solution and the other solutions of the plurality of solutions, and
reporting, by the controller, the roll, pitch, and heading of the device.
12 . The method of claim 11 , further comprising:
obtaining a median of the plurality of solutions, wherein the relation comprises a relation to the median.
13 . The method of claim 12 , wherein the weighting comprises weighting a given solution of the plurality of solutions with a weight of 1 when the given solution is within a first predetermined threshold of the median.
14 . The method of claim 13 , wherein the weighting comprises weighting the given solution of the plurality of solutions with a weight that scales from 1 to 0 when the given solution is beyond the first predetermined threshold of the median but within a second predetermined threshold of the median.
15 . The method of claim 14 , wherein the weighting comprises weighting the given solution of the plurality of solutions with a weight of 0 when the given solution is beyond the second predetermined threshold of the median.
16 . The method of claim 11 , wherein the median of at least one of the roll, the pitch, or the heading is determined by computing a circular median or circular mean.
17 . The method of claim 1 , wherein the weighting comprises weighting separately for heading.
18 . The method of claim 1 , wherein the reporting comprises reporting the roll, pitch, and heading of the device to a navigation system.
19 . The method of claim 1 , wherein the reporting comprises reporting the roll, pitch, and heading of the device to a user interface of an aircraft.
20 . A non-transitory computer-readable medium encoded with instructions that, when executed in hardware, perform a process, the process comprising:
receiving, at a controller, output of a plurality of three-axis sensors configured to measure physical quantities from which can be computed roll, pitch, and heading for a device,
determining, by the controller, a plurality of solutions each solution of the plurality of solutions based on respective output of the plurality of three-axis sensors,
weighting, by the controller, each of the plurality of solutions based on a relation between a given solution and the other solutions of the plurality of solutions, and
reporting, by the controller, the roll, pitch, and heading of the device.