Here is how we implemented auto shifting this year. It seemed to work well but we decided we wanted to be able to manually control our shifting due to interlocking that we implemented between the chassis and other systems.
https://github.com/runnymederobotics...b232a55ebd?w=1