[whytheheckme]

This looks pretty feasible.

I like the idea of outsourcing all of the heavy math to a co-processor. The flow chart makes it very clear.

If we hadn't vowed not to use mecanum this year, I think I'd give this a try

Jacob