Fixed issues

moved gear shifting to chasis, cleaned up various code