Test branch

Please review the change made to gestureFilter. All other changes are just tests that can only help! 
Because pose is only updated on transitions, lastTime is ALWYAS updated before this line is hit, so clock() - lastTime is really like "clock() - clock()"