Searched refs:quatXYZW (Results 1 – 2 of 2) sorted by relevance
1863 double quatXYZW[4]; in convertPose() local1864 quatXYZW[0] = jointPositionsQ[dofsrc++]; in convertPose()1869 pose[3] = quatXYZW[3]; in convertPose()1870 pose[4] = quatXYZW[0]; in convertPose()1871 pose[5] = quatXYZW[1]; in convertPose()1872 pose[6] = quatXYZW[2]; in convertPose()1921 double quatXYZW[4]; in convertPose() local1927 pose[dof++] = quatXYZW[3]; in convertPose()1928 pose[dof++] = quatXYZW[0]; in convertPose()1929 pose[dof++] = quatXYZW[1]; in convertPose()[all …]