APM:Libraries
Variables
calcH_MAG.cpp File Reference

Go to the source code of this file.

Variables

float t2 = cos(gPhi)
 
float t3 = cos(gTheta)
 
float t4 = sin(gPhi)
 
float t5 = sin(gTheta)
 
float t6 = q0*q0
 
float t7 = q1*q1
 
float t8 = q2*q2
 
float t9 = q3*q3
 
float t10 = t6+t7-t8-t9
 
float t11 = sin(gPsi)
 
float t12 = cos(gPsi)
 
float t13 = q0*q2*2.0f
 
float t14 = q1*q3*2.0f
 
float t15 = t13+t14
 
float t16 = q0*q3*2.0f
 
float t18 = q1*q2*2.0f
 
float t17 = t16-t18
 
float t19 = t3*t11
 
float t20 = t4*t5*t12
 
float t21 = t19+t20
 
float t22 = t16+t18
 
float t23 = t5*t11
 
float t41 = t3*t4*t12
 
float t24 = t23-t41
 
float t25 = q0*q1*2.0f
 
float t31 = q2*q3*2.0f
 
float t26 = t25-t31
 
float t27 = t6-t7+t8-t9
 
float t28 = t5*t12
 
float t29 = t3*t4*t11
 
float t30 = t28+t29
 
float t32 = t3*t12
 
float t46 = t4*t5*t11
 
float t33 = t32-t46
 
float t35 = t4*t17
 
float t36 = t2*t5*t10
 
float t37 = t2*t3*t15
 
float t38 = t35+t36-t37
 
float t39 = magZ*t38
 
float t40 = t10*t21
 
float t42 = t15*t24
 
float t43 = t2*t12*t17
 
float t44 = t40+t42-t43
 
float t45 = magY*t44
 
float t47 = t10*t33
 
float t48 = t15*t30
 
float t49 = t2*t11*t17
 
float t50 = t47+t48+t49
 
float t51 = magX*t50
 
float t52 = -t39+t45+t51
 
float t53 = 1.0/t52
 
float t54 = t4*t27
 
float t55 = t2*t3*t26
 
float t56 = t2*t5*t22
 
float t57 = -t54+t55+t56
 
float t58 = magZ*t57
 
float t59 = t21*t22
 
float t60 = t24*t26
 
float t61 = t2*t12*t27
 
float t62 = t59-t60+t61
 
float t63 = magY*t62
 
float t64 = t26*t30
 
float t65 = t22*t33
 
float t66 = t2*t11*t27
 
float t67 = t64-t65+t66
 
float t68 = magX*t67
 
float t69 = t58-t63+t68
 
float t70 = t53*t69
 
float t34 = tan(t70)
 
float t71 = t34*t34
 
float t72 = t71+1.0
 
float t73 = 1.0/(t52*t52)
 
 A0 [0][0] = -t72*(t53*(magZ*(t4*t26+t2*t3*t27)+magY*(t24*t27+t2*t12*t26)+magX*(t27*t30-t2*t11*t26))-t69*t73*(magZ*(t4*t15+t2*t3*t17)+magY*(t17*t24+t2*t12*t15)+magX*(t17*t30-t2*t11*t15)))
 

Variable Documentation

◆ A0

A0[0][2] = -t72*(t53*(magZ*(t4*t26+t2*t3*t27)+magY*(t24*t27+t2*t12*t26)+magX*(t27*t30-t2*t11*t26))-t69*t73*(magZ*(t4*t15+t2*t3*t17)+magY*(t17*t24+t2*t12*t15)+magX*(t17*t30-t2*t11*t15)))

Definition at line 73 of file calcH_MAG.cpp.

◆ t10

float t10 = t6+t7-t8-t9

Definition at line 9 of file calcH_MAG.cpp.

◆ t11

float t11 = sin(gPsi)

Definition at line 10 of file calcH_MAG.cpp.

◆ t12

float t12 = cos(gPsi)

Definition at line 11 of file calcH_MAG.cpp.

◆ t13

float t13 = q0*q2*2.0f

Definition at line 12 of file calcH_MAG.cpp.

◆ t14

float t14 = q1*q3*2.0f

Definition at line 13 of file calcH_MAG.cpp.

◆ t15

float t15 = t13+t14

Definition at line 14 of file calcH_MAG.cpp.

◆ t16

float t16 = q0*q3*2.0f

Definition at line 15 of file calcH_MAG.cpp.

◆ t17

float t17 = t16-t18

Definition at line 17 of file calcH_MAG.cpp.

◆ t18

float t18 = q1*q2*2.0f

Definition at line 16 of file calcH_MAG.cpp.

◆ t19

float t19 = t3*t11

Definition at line 18 of file calcH_MAG.cpp.

◆ t2

float t2 = cos(gPhi)

Definition at line 1 of file calcH_MAG.cpp.

◆ t20

float t20 = t4*t5*t12

Definition at line 19 of file calcH_MAG.cpp.

◆ t21

float t21 = t19+t20

Definition at line 20 of file calcH_MAG.cpp.

◆ t22

float t22 = t16+t18

Definition at line 21 of file calcH_MAG.cpp.

◆ t23

float t23 = t5*t11

Definition at line 22 of file calcH_MAG.cpp.

◆ t24

float t24 = t23-t41

Definition at line 24 of file calcH_MAG.cpp.

◆ t25

float t25 = q0*q1*2.0f

Definition at line 25 of file calcH_MAG.cpp.

◆ t26

float t26 = t25-t31

Definition at line 27 of file calcH_MAG.cpp.

◆ t27

float t27 = t6-t7+t8-t9

Definition at line 28 of file calcH_MAG.cpp.

◆ t28

float t28 = t5*t12

Definition at line 29 of file calcH_MAG.cpp.

◆ t29

float t29 = t3*t4*t11

Definition at line 30 of file calcH_MAG.cpp.

◆ t3

float t3 = cos(gTheta)

Definition at line 2 of file calcH_MAG.cpp.

◆ t30

float t30 = t28+t29

Definition at line 31 of file calcH_MAG.cpp.

◆ t31

float t31 = q2*q3*2.0f

Definition at line 26 of file calcH_MAG.cpp.

◆ t32

float t32 = t3*t12

Definition at line 32 of file calcH_MAG.cpp.

◆ t33

float t33 = t32-t46

Definition at line 34 of file calcH_MAG.cpp.

◆ t34

float t34 = tan(t70)

Definition at line 69 of file calcH_MAG.cpp.

◆ t35

float t35 = t4*t17

Definition at line 35 of file calcH_MAG.cpp.

◆ t36

float t36 = t2*t5*t10

Definition at line 36 of file calcH_MAG.cpp.

◆ t37

float t37 = t2*t3*t15

Definition at line 37 of file calcH_MAG.cpp.

◆ t38

float t38 = t35+t36-t37

Definition at line 38 of file calcH_MAG.cpp.

◆ t39

float t39 = magZ*t38

Definition at line 39 of file calcH_MAG.cpp.

◆ t4

float t4 = sin(gPhi)

Definition at line 3 of file calcH_MAG.cpp.

◆ t40

float t40 = t10*t21

Definition at line 40 of file calcH_MAG.cpp.

◆ t41

float t41 = t3*t4*t12

Definition at line 23 of file calcH_MAG.cpp.

◆ t42

float t42 = t15*t24

Definition at line 41 of file calcH_MAG.cpp.

◆ t43

float t43 = t2*t12*t17

Definition at line 42 of file calcH_MAG.cpp.

◆ t44

float t44 = t40+t42-t43

Definition at line 43 of file calcH_MAG.cpp.

◆ t45

float t45 = magY*t44

Definition at line 44 of file calcH_MAG.cpp.

◆ t46

float t46 = t4*t5*t11

Definition at line 33 of file calcH_MAG.cpp.

◆ t47

float t47 = t10*t33

Definition at line 45 of file calcH_MAG.cpp.

◆ t48

float t48 = t15*t30

Definition at line 46 of file calcH_MAG.cpp.

◆ t49

float t49 = t2*t11*t17

Definition at line 47 of file calcH_MAG.cpp.

◆ t5

float t5 = sin(gTheta)

Definition at line 4 of file calcH_MAG.cpp.

◆ t50

float t50 = t47+t48+t49

Definition at line 48 of file calcH_MAG.cpp.

◆ t51

float t51 = magX*t50

Definition at line 49 of file calcH_MAG.cpp.

◆ t52

float t52 = -t39+t45+t51

Definition at line 50 of file calcH_MAG.cpp.

◆ t53

float t53 = 1.0/t52

Definition at line 51 of file calcH_MAG.cpp.

◆ t54

float t54 = t4*t27

Definition at line 52 of file calcH_MAG.cpp.

◆ t55

float t55 = t2*t3*t26

Definition at line 53 of file calcH_MAG.cpp.

◆ t56

float t56 = t2*t5*t22

Definition at line 54 of file calcH_MAG.cpp.

◆ t57

float t57 = -t54+t55+t56

Definition at line 55 of file calcH_MAG.cpp.

◆ t58

float t58 = magZ*t57

Definition at line 56 of file calcH_MAG.cpp.

◆ t59

float t59 = t21*t22

Definition at line 57 of file calcH_MAG.cpp.

◆ t6

float t6 = q0*q0

Definition at line 5 of file calcH_MAG.cpp.

◆ t60

float t60 = t24*t26

Definition at line 58 of file calcH_MAG.cpp.

◆ t61

float t61 = t2*t12*t27

Definition at line 59 of file calcH_MAG.cpp.

◆ t62

float t62 = t59-t60+t61

Definition at line 60 of file calcH_MAG.cpp.

◆ t63

float t63 = magY*t62

Definition at line 61 of file calcH_MAG.cpp.

◆ t64

float t64 = t26*t30

Definition at line 62 of file calcH_MAG.cpp.

◆ t65

float t65 = t22*t33

Definition at line 63 of file calcH_MAG.cpp.

◆ t66

float t66 = t2*t11*t27

Definition at line 64 of file calcH_MAG.cpp.

◆ t67

float t67 = t64-t65+t66

Definition at line 65 of file calcH_MAG.cpp.

◆ t68

float t68 = magX*t67

Definition at line 66 of file calcH_MAG.cpp.

◆ t69

float t69 = t58-t63+t68

Definition at line 67 of file calcH_MAG.cpp.

◆ t7

float t7 = q1*q1

Definition at line 6 of file calcH_MAG.cpp.

◆ t70

float t70 = t53*t69

Definition at line 68 of file calcH_MAG.cpp.

◆ t71

float t71 = t34*t34

Definition at line 70 of file calcH_MAG.cpp.

◆ t72

float t72 = t71+1.0

Definition at line 71 of file calcH_MAG.cpp.

◆ t73

float t73 = 1.0/(t52*t52)

Definition at line 72 of file calcH_MAG.cpp.

◆ t8

float t8 = q2*q2

Definition at line 7 of file calcH_MAG.cpp.

◆ t9

float t9 = q3*q3

Definition at line 8 of file calcH_MAG.cpp.