I agree with mario, this is really really cool work but it could use some kind of layer between the raw input and the results, as it isn't "gameready" yet, also everyone using this code wont have to code it themselves everytime they use it.
I'd do something like:
if(newPos > oldPos + 0.5meter || newPos < oldPos - 0.5meter ){
newPos = oldPos;
}
And just replace 0.5meter with a fine calibrated value (that doesn't limit the movementspeed of a human. 0.5 meters * 60 frames (if 60fps) = it can record movements up to 30 meters per second before compensating (also instant acceleration). Just keep this level above the limits of a humans capabilities and you're good to go.