[zmp/choreonoid] Fix computation when attitude is (0,0,0)