Improved Functionality & Reverse Driving

Fixed multiple menu bugs and implemented reverse driving algorithms