Contributions to contact modeling and identification, and optimal robot motion planning door