Whole-body motion planning module for mobile manipulation