Formatting
Improve demo plans, enhance all settings for demo, add more failure handling, add grasp stability components
Fix margins for manipulation
Fix location costmap generation functionality (margins, min/max values, general distribution)