Integration of vision and force for robotic servoing door