Heck, i'm a scrub when it comes to math, i'm not even going to compare
Well, i can say the exact same thing about your system
It seems like it fits more for a game, where units can move to whatever point player wants them to. Tho i like how it saves the path the unit will follow, i'll probably use it in future.
Regarding the groups, yeah, right now i'm trying to increase efficiency of my system, mainly by getting rid of FirstOfGroup-type of loops, as i heard they are damn slow. I've still got to think of an alternate way of doing it...