Modular, distributed motion planning, interpolation and execution