Task and motion planning for mobile manipulators