update staro arms end-coords from contact coords to grasp coords

接触点をend-coordsにしていまいしたが，把持点をend-coordsに変えて，接触点の方はstaro-utils.lでcontact-coordsとして追加するように変更しました．