The analysis of the observability of system states is very important in the design of an optimal filter estimation algorithm. A relative attitude estimation algorithm is developed based on a stereo vision system and a gyroscope, and the observability of this algorithm is studied. First, we build the error model of the relative attitude determination system. Second, the observability of every state of the filter is studied. Third, by choosing different variables as the states of the error model, the unobservable subspace of the system is confirmed. Furthermore, the system structural decomposition reveals that this type of relative attitude determination system can only determine the relative attitude between the deputy and the chief and that their gyro drift errors are unobservable. In addition, the structural decomposition also tells us that when the feature points measured by the stereo vision system are greater than two, increasing the number of feature points provides little benefit for improving the observability of the gyro drift errors. Considering the incomplete observability of the original system, the star sensor is added into the system to enable it to be completely observable. The final simulation result indicates that after adding the star sensor, the system, which becomes completely observable, can estimate the body attitude, the relative attitude and the gyro error while providing improved accuracy.
Read full abstract