Fault detection pseudo gyro
AssigneeThe Aerospace Corporation
InventorsCraig M. Heatwole, Louis K. Herman, Girard M. Manke, Brian T. Hamada
Life of this patent
Estimating the term…
Abstract
A fault detection pseudo gyro emulates mechanical gyros by processing space system appendage measurement data and reaction wheel tachometer data within reference and control systems of a satellite to compute the vehicular bus angular velocity rate data by accounting for external torques, the momentum transfer between the satellite, the bus, and the appendages for providing accurate relative vehicular position and angular velocity rate data in an attitude reference and control systems now having accurate vehicular angular velocity rate data while enabling fault detection of hardware gyros and momentum sensors.
Claims14
A method of detecting a fault of one or more hardware gyros in a vehicle having momentum sensors, the method comprising the steps of,
- receiving momentum data from the momentum sensors,
- calculating pseudo gyro vehicular angular velocity rate data from the momentum data,
- receiving hardware gyro vehicular angular velocity rate data from the hardware gyro,
- computing a norm of a vector from the hardware gyro vehicular angular velocity rate data and the pseudo gyro vehicular angular velocity rate data, and
- determining when the norm of the vector indicates a faulty one of the hardware gyros.
A method of detecting a fault of one or more hardware gyros in a vehicle having momentum sensors, the method comprising the steps of,
- receiving momentum data from the momentum sensors,
- calculating pseudo gyro vehicular angular velocity rate data from the momentum data,
- receiving hardware gyro vehicular angular velocity rate data from the hardware gyros,
- computing a norm of a parity vector from the hardware gyro vehicular angular velocity rate data and the pseudo gyro vehicular angular velocity rate data,
- determining when the norm of the parity vector is greater than a threshold indicating a fault,
- recomputing the norm of the parity vector with the hardware gyro vehicular angular velocity rate data of one of the gyro is removed from the recomputation of the parity vector, and
- detecting when the norm of the recomputed parity vector is less than the threshold for indicating that the removed hardware gyro is faulty.
A method of detecting a fault of one or more hardware gyros in a vehicle having momentum sensors, the method comprising the steps of,
- receiving momentum data from the momentum sensors,
- calculating pseudo gyro vehicular angular velocity rate data from the momentum data,
- receiving hardware gyro vehicular angular velocity rate data from the hardware gyro,
- computing a norm of a parity vector from the hardware gyro vehicular angular velocity rate data and the pseudo gyro vehicular angular velocity rate data, the computing step comprising the steps of:
- orientation multiplying a gyro orientation matrix C with an pseudo inverse gyro orientation matrix C+ for generating a combined orientation matrix CC+;
- subtracting the combined orientation matrix CC+ from an identity matrix I for generating a correlation matrix (I−CC+);
- data combining the pseudo gyro vehicular angular velocity rate data ωB and the hardware gyro vehicular angular velocity rate data ωBG into an angular velocity rate data vector ωc;
- correlation multiplying the correlation matrix (I−CC30 ) by the angular velocity rate data vector ωc for generating a parity vector (P);
- and norm computing a norm of the parity vector (P),
- determining when the norm of the parity vector is greater than a threshold indicating a fault,
- recomputing the norm of the parity vector with the hardware gyro vehicular angular velocity rate data of one of the gyro is removed from the recomputation of the parity vector, the recomputing step comprising the steps of:
- orientation multiplying a gyro orientation matrix C with an pseudo inverse gyro orientation matrix C+ for generating a combined orientation matrix CC+;
- matrix subtracting the combined orientation matrix from an identity matrix I for generating a correlation matrix (I−CC+);
- data combining the pseudo gyro vehicular angular velocity rate data ωB and the hardware gyro vehicular angular velocity rate data ωBG into an angular velocity rate data vector ωc;
- correlation multiplying the correlation matrix (I−CC+) by the angular velocity rate data vector ωc for generating a correlation vector (I−CC+)ωc;
- parity weighting the correlation vector (I−CC+)ωc by a weighting matrix W for generating the parity vector, and norm computing a norm of the parity vector (P),
- detecting when the norm of the recomputed parity vector is less than the threshold indicating that the removed hardware gyro is faulty,
- adjusting a weighting matrix for successive removal from recomputation steps respective successive gyros, and
- repeating the recomputing and detecting steps for each of the hardware gyros respectively removed from the recomputing step.
Dependencies are inferred from the claim text.