improved camera first person mode and cleaned up some camera code

To test first person mode in main.cpp, set CameraMode defaultCameraMode = CAMERA_MODE_FIRST_PERSON;