calcH_YAW312.c File Reference

Go to the source code of this file.

Variables
	t9 = q0*q3
	t10 = q1*q2
	t2 = t9-t10
	t3 = q0*q0
	t4 = q1*q1
	t5 = q2*q2
	t6 = q3*q3
	t7 = t3-t4+t5-t6
	t8 = 1.0/(t7*t7)
	t11 = t2*t2
	t12 = t8*t11*4.0
	t13 = t12+1.0
	t14 = 1.0/t13
	A0 [0][0] = t8*t14*(q3*t3+q3*t4-q3*t5+q3*t6-q0*q1*q2*2.0)*-2.0

Variable Documentation

A0

A0[0][3] = t8*t14*(q3*t3+q3*t4-q3*t5+q3*t6-q0*q1*q2*2.0)*-2.0

Definition at line 14 of file calcH_YAW312.c.

Referenced by main(), and MatrixTest::pseudoInverseTests().

t10

t10 = q1*q2

Definition at line 2 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t11

t11 = t2*t2

Definition at line 10 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t12

t12 = t8*t11*4.0

Definition at line 11 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t13

t13 = t12+1.0

Definition at line 12 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t14

t14 = 1.0/t13

Definition at line 13 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t2

t2 = t9-t10

Definition at line 3 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), uORB::FastRpcChannel::control_msg_queue_add(), VelocitySmoothing::evaluatePoly(), uORB::KraitFastRpcChannel::fastrpc_recv_thread(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), Ekf::initialiseQuatCovariances(), uORB::FastRpcChannel::send_message(), uORB::KraitFastRpcChannel::send_message(), sPort_send_GPS_FIX(), ListTest::test_range_based_for(), tfmini_parse(), and VelocitySmoothing::updateTraj().

t3

t3 = q0*q0

Definition at line 4 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), VelocitySmoothing::evaluatePoly(), uORB::KraitFastRpcChannel::fastrpc_recv_thread(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), uORB::FastRpcChannel::get_bulk_data(), uORB::FastRpcChannel::get_data(), Ekf::initialiseQuatCovariances(), uORB::KraitFastRpcChannel::send_message(), and VelocitySmoothing::updateTraj().

t4

t4 = q1*q1

Definition at line 5 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), Ekf::initialiseQuatCovariances(), and uORB::KraitFastRpcChannel::send_message().

t5

t5 = q2*q2

Definition at line 6 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t6

t6 = q3*q3

Definition at line 7 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t7

t7 = t3-t4+t5-t6

Definition at line 8 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t8

t8 = 1.0/(t7*t7)

Definition at line 9 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().

t9

t9 = q0*q3

Definition at line 1 of file calcH_YAW312.c.

Referenced by Ekf::calcRotVecVariances(), Ekf::fuseDeclination(), Ekf::fuseGpsAntYaw(), Ekf::fuseHeading(), Ekf::fuseOptFlow(), and Ekf::initialiseQuatCovariances().