Motion Planning of Mobile Manipulator for Navigation Including Door Traversal