INERTIAL NAVIGATION SYSTEM WITH COMPENSATION OF ROLL SCALE FACTOR ERROR

    公开(公告)号:US20170322030A1

    公开(公告)日:2017-11-09

    申请号:US15522360

    申请日:2015-10-27

    摘要: An inertial measurement system (200) for a longitudinal projectile, comprising a first, roll gyro to be oriented substantially parallel to the longitudinal axis of the projectile; a second gyro and a third gyro with axes arranged with respect to the roll gyro such that they define a three dimensional coordinate system. The system further comprises a controller (225, 250), arranged: —to compute a current projectile attitude from the outputs of the first, second and third gyros, the computed attitude comprising a roll angle, a pitch angle and a yaw angle; —for at least two time points, to compare the computed pitch and yaw angles with expected values for the pitch and yaw angles; —for each of said at least two time points, to calculate a roll angle error based on the difference between the computed pitch and yaw angles and the expected pitch and yaw angles; —to calculate a roll angle error difference between said at least two time points; —to calculate the total roll angle subtended between said at least two time points; —to calculate a roll angle scale factor error based on said computed roll angle error difference and said total subtended roll angle and apply the calculated roll angle scale factor error to the output of the roll gyro.

    Inertial navigation system with compensation of roll scale factor error

    公开(公告)号:US10539421B2

    公开(公告)日:2020-01-21

    申请号:US15522360

    申请日:2015-10-27

    摘要: An inertial measurement system (200) for a longitudinal projectile, comprising a first, roll gyro to be oriented substantially parallel to the longitudinal axis of the projectile; a second gyro and a third gyro with axes arranged with respect to the roll gyro such that they define a three dimensional coordinate system. The system further comprises a controller (225, 250), arranged: —to compute a current projectile attitude from the outputs of the first, second and third gyros, the computed attitude comprising a roll angle, a pitch angle and a yaw angle; —for at least two time points, to compare the computed pitch and yaw angles with expected values for the pitch and yaw angles; —for each of said at least two time points, to calculate a roll angle error based on the difference between the computed pitch and yaw angles and the expected pitch and yaw angles; —to calculate a roll angle error difference between said at least two time points; —to calculate the total roll angle subtended between said at least two time points; —to calculate a roll angle scale factor error based on said computed roll angle error difference and said total subtended roll angle and apply the calculated roll angle scale factor error to the output of the roll gyro.

    Inertial navigation system
    3.
    发明授权

    公开(公告)号:US10571271B2

    公开(公告)日:2020-02-25

    申请号:US15964147

    申请日:2018-04-27

    IPC分类号: G01C21/18 G01C25/00 F42B15/01

    摘要: An inertial measurement system comprising: a first, roll gyro with an axis oriented substantially parallel to the spin axis of the projectile; a second gyro and a third gyro with axes arranged with respect to the roll gyro; a controller, arranged to: compute a current projectile attitude from the outputs of the first, second and third gyros; operate a Kalman filter that receives a plurality of measurement inputs including at least roll angle, pitch angle and yaw angle and that outputs at least a roll angle error; initialise the Kalman filter with a roll angle error uncertainty representative of a substantially unknown roll angle; generate at least one pseudo-measurement from stored expected flight data; provide said pseudo-measurement(s) to the corresponding measurement input of the Kalman filter; and apply the roll angle error from the Kalman filter as a correction to the roll angle.

    Inertial navigation system
    4.
    发明授权

    公开(公告)号:US09689684B2

    公开(公告)日:2017-06-27

    申请号:US15121854

    申请日:2015-02-16

    摘要: An inertial measurement system for a longitudinal projectile comprising: a first, roll gyro to be oriented substantially parallel to the longitudinal axis of the projectile; a second gyro and a third gyro with axes arranged with respect to the roll gyro such that they define a three dimensional coordinate system; a controller, arranged to: compute a current projectile attitude from the outputs of the first, second and third gyros, the computed attitude comprising a roll angle, a pitch angle and a yaw angle; compare the computed pitch and yaw angles with expected values for the pitch and yaw angles; calculate a roll angle error and a roll scale factor error based on the difference between the computed pitch and yaw angles and the expected pitch and yaw angles; and apply the calculated roll angle error and roll scale factor error to the output of the roll gyro.

    Gyroscope
    5.
    发明授权

    公开(公告)号:US11243077B2

    公开(公告)日:2022-02-08

    申请号:US16679521

    申请日:2019-11-11

    摘要: A vibrating structure gyroscope includes a permanent magnet, a structure arranged in a magnetic field of the permanent magnet and arranged to vibrate under stimulation from at least one primary drive electrode and a drive system that includes: one primary drive electrode arranged at least one primary sense electrode arranged to sense motion in the vibrating structure and a drive control loop controlling the primary drive electrode dependent on the primary sense electrode. The structure also includes a compensation unit arranged to receive a signal from the drive system representative of a gain in the drive control loop and arranged to output a scale factor correction based on that signal. As the magnet degrades (e.g. naturally over time as the material ages), the magnetic field weakens. To compensate for this, the primary drive control loop will automatically increase the gain.

    Inertial navigation system
    6.
    发明授权

    公开(公告)号:US10563987B2

    公开(公告)日:2020-02-18

    申请号:US15604745

    申请日:2017-05-25

    IPC分类号: G01C21/18 G01C21/16 G01S19/49

    摘要: An inertial measurement system for a spinning projectile comprising: first (roll), second and third gyros with axes arranged such that they define a three dimensional coordinate system; at least a first linear accelerometer; a controller, arranged to: compute a current projectile attitude comprising a roll angle, a pitch angle and a yaw angle; compute a current velocity vector from the accelerometer; combine a magnitude of said velocity vector with an expected direction for said vector to form a pseudo-velocity vector; provide the velocity vector and the pseudo-velocity vector to a Kalman filter that outputs a roll gyro scale factor error calculated as a function of the difference between the velocity vector and the pseudo-velocity vector; and apply the roll gyro scale factor error from the Kalman filter as a correction to the output of the roll gyro.

    INERTIAL NAVIGATION SYSTEM
    7.
    发明申请

    公开(公告)号:US20170160306A1

    公开(公告)日:2017-06-08

    申请号:US15371711

    申请日:2016-12-07

    IPC分类号: G01P13/02 F42B15/01 G01C21/16

    摘要: An inertial measurement system for a spinning projectile comprising: a first, roll gyro to be oriented substantially parallel to the spin axis of the projectile; a second gyro and a third gyro with axes arranged with respect to the roll gyro such that they define a three dimensional coordinate system; a controller, arranged to: compute a current projectile attitude from the outputs of the first, second and third gyros, the computed attitude comprising a roll angle, a pitch angle and a yaw angle; calculate a roll angle error based on the difference between the computed pitch and yaw angles and expected pitch and yaw angles; provide the roll angle error as an input to a Kalman filter that outputs a roll angle correction and a roll rate scale factor correction; and apply the calculated roll angle correction and roll rate scale factor correction to the output of the roll gyro; wherein the Kalman filter models roll angle error as a function of roll rate and one or more wind variables. The system provides improved calibration of the roll axis rate gyro scale factor, e.g. of an IMU fitted to a rolling projectile. A separate process (an Euler angle filter) is used to calculate an estimate of the roll angle error without the use of the Kalman filter and is then provided as an input to the Kalman filter which can then operate in a stable manner. The filter can be configured to estimate and correct for crosswind effects which would otherwise significantly degrade performance.

    Gyroscope
    9.
    发明授权

    公开(公告)号:US11561096B2

    公开(公告)日:2023-01-24

    申请号:US17402817

    申请日:2021-08-16

    IPC分类号: G01C25/00 G01C19/5712

    摘要: A vibrating structure gyroscope comprises a resonant structure arranged to vibrate under stimulation from a primary drive electrode. A drive system is arranged to vibrate the vibrating structure at a resonance frequency. An automatic gain control unit varies an amplitude of a primary drive signal (PD). A controller operates the gyroscope such that in a first mode of operation, the automatic gain control unit varies an amplitude of the drive signal (PD) between an operating range defined by upper and lower bounds and in a second mode operation, in which the automatic gain control unit sets the amplitude of the drive signal (PD) to a predetermined level outside of the operating range. In the second mode of operation an amplitude of a primary sense signal (PP) is measured after a predetermined time period to determine an oscillation cycle count during said predetermined time period.

    Signal processing
    10.
    发明授权

    公开(公告)号:US11248910B2

    公开(公告)日:2022-02-15

    申请号:US16713427

    申请日:2019-12-13

    摘要: A method of demodulating a MEMS sensor pickoff signal from a vibrating resonator of said sensor, the method comprising: sampling the pickoff signal with an asynchronous ADC at a sampling rate of at least 50 times the resonant frequency of the resonator to generate a stream of samples; generating a first value by combining samples from said stream of samples according to a selected operation, said operation being selected in dependence on a synchronous clock signal that is synchronous to the resonant frequency of the resonator, said synchronous clock signal having a frequency at least twice the resonant frequency of the resonator; and counting the number of samples contributing to the first value. The increased sampling rate of the pickoff signal allows a much higher number of samples to be taken into account, thereby reducing noise. However, the ADC asynchronously from the resonator of the MEMS sensor.