Sounds like a nice design. I am a big fan of Trinamic chips, I have used them with Teensy boards on many projects.
Your whole system sounds very similar to H-ROS, which I still think was a fantastic idea even though it is no longer being developed.