- dynamic configuration added
- cleaning planner improved for testing
- threshold added (send next goal before reaching current)