Finally finished fixing the buggy interpolation system. It was causing the timer and robot to be linked to each other so there was no speed or accurate timing. I now have a bare bones MVP of my tool!