feat(manipulation): add RoboPlan shortcutting and split planner (#3325)