Fix #10
Cleanup
Fixed a couple bugs in FirstPersonControls, more code cleanup and simplification.