Fixed off-by-one errors.
Code cleanup.
added: isOnGround()
Improved logging.
Code cleanup and falling fix.