Grasp Planning and Force Control