mode 1 working (i think)
mode 1 done, mode 2 maybe
going to test on physical model
mode 2 almost done, timer issue
maybe done
cleaned up
all working, just need to comment