Skip to content

Commit e3747af

Browse files
committed
Update documentation
1 parent 0579b50 commit e3747af

File tree

1 file changed

+8
-3
lines changed

1 file changed

+8
-3
lines changed

src/fswAlgorithms/opticalNavigation/cobConverter/cobConverter.rst

+8-3
Original file line numberDiff line numberDiff line change
@@ -75,15 +75,16 @@ where :math:`\mathbf{\bar{u}}_{COB} = [\mathrm{cob}_x, \mathrm{cob}_y, 1]^T` wit
7575
brightmess :math:`\mathrm{cob}_x` and :math:`\mathrm{cob}_y`, :math:`[K]` is the camera calibration matrix and
7676
:math:`\mathbf{r}_{COB}^N` is the unit vector describing the physical heading to the target in the camera frame.
7777

78-
The covariance is found using the number of detected pixels and the camera parameters, given by:
78+
The covariance of the COB error is found using the number of detected pixels and the camera parameters, given by:
7979

8080
.. math::
8181
82-
P = \frac{2 \ pi}{\sqrt{\mathrm{numPixels}}} \left( \begin{bmatrix} d_x^2 & 0 & 0 \\ 0 & d_y^2 & 0
82+
P = \frac{\sqrt{\mathrm{numPixels}}}{2 \pi} \left( \begin{bmatrix} d_x^2 & 0 & 0 \\ 0 & d_y^2 & 0
8383
\\ 0 & 0 & 1 \end{bmatrix}\right)
8484
8585
where :math:`d_x` and :math:`d_y` are the first and second diagonal elements of the camera calibration matrix
86-
:math:`[K]`.
86+
:math:`[K]`. This covariance matrix is then transformed into the body frame and added to the covariance of the attitude
87+
error.
8788

8889
By reading the camera orientation and the current body attitude in the inertial frame, the final step is to rotate
8990
the covariance and heading vector in all the relevant frames for modules downstream. This is done simply by
@@ -142,6 +143,10 @@ This section is to outline the steps needed to setup a center of brightness conv
142143
# module = cobConverter.CobConverter(cobConverter.PhaseAngleCorrectionMethod_Lambertian, R_obj) # Lambertian method
143144
# module = cobConverter.CobConverter(cobConverter.PhaseAngleCorrectionMethod_Binary, R_obj) # Binary method
144145

146+
#. The attitude error covariance matrix is set by::
147+
148+
module.setAttitudeCovariance(covar_att_BN_B)
149+
145150
#. The object radius in units of meters for the phase angle correction can be updated by::
146151

147152
module.setRadius(R_obj)

0 commit comments

Comments
 (0)