Code cleaned up, added SensorManager, implemented basic ground adaption, implemented basic obstacle recognition, minor changes