I wish to thank you for this. I had been looking at creating something like this for my milling machine X axis.. Now I don't. :)
I've got it to compile and was surprised it actually compiled on a Arduino Pro board. 16mhz, using 98% of memory. I will however end up using possibly my Tau 32bit...