Door Opening and Closing for Nonholonomic Non-Redundant Service Robots