Shifting, jogging, smart dashboard, cleanup

Added shift counting, updated arm jogging logic, added outputs to smart dashboard, removed dead code