Expand code more, added testing capabilities to test out protoypes using the left joystick throttle and SD data on encoder distance traveled