Do the variable zeroing correctly for the delta angle vector
Reset velocity, position and height during filter reset - this will make the filter converge much faster.
Change zero() function call of Vector3f to zero the vector its called on instead of returning a zero vector.
Updated test harness to new zero() interface.
Fix constness on zero() function call.
Merge branch 'master' into optflow-wip