Good ole feed forward, as supposed to op’s feedback-only implementation.
Follows tightly with how the rest of FRC controls have been done.
It’s like poetry.
To be clear, OP, You have learned by solving a problem that no one had. And for that, you should be proud!