Fixed Navigation Issues

The Navigation had some serious errors, like using the cameraTarget as a direction vector at the loopAt function. That among other stuff were fixed

Added a DEBUG flag to control debugging output

Right now Navigation and Controls are 100% done. No glitches detected so far