Adds robotiq hand model and a few important bug fixes