Code improvement (fixed some warnings), Moti can now stabilize & cruise/bump. Ready for HTC