Changed Joystick Controls, added debug stuff, made some math calculations, and enhanced readability slightly