TRL5 prototype of motion planner for flock of ropods

Summary
TRL5 prototype and documentation of motion planner for flock of ropods moving in time-varying environment