| 39 | // Functions |
| 40 | |
| 41 | SF::SF() |
| 42 | { |
| 43 | beta = betaDef; |
| 44 | twoKp = twoKpDef; |
| 45 | twoKi = twoKiDef; |
| 46 | q0 = 1.0f; |
| 47 | q1 = 0.0f; |
| 48 | q2 = 0.0f; |
| 49 | q3 = 0.0f; |
| 50 | integralFBx = 0.0f; |
| 51 | integralFBy = 0.0f; |
| 52 | integralFBz = 0.0f; |
| 53 | anglesComputed = 0; |
| 54 | } |
| 55 | |
| 56 | // See: http://en.wikipedia.org/wiki/Fast_inverse_square_root |
| 57 | float SF::invSqrt(float x) |
nothing calls this directly
no outgoing calls
no test coverage detected