Humanoid Task and Motion Planning