Searched refs:quat (Results 1 – 1 of 1) sorted by relevance
401 double [] quat = new double[4]; in loadSensorLog() local418 quat[0] = Double.parseDouble(items[1]); in loadSensorLog()419 quat[1] = Double.parseDouble(items[2]); in loadSensorLog()420 quat[2] = Double.parseDouble(items[3]); in loadSensorLog()421 quat[3] = Double.parseDouble(items[4]); in loadSensorLog()424 quat2rpy(quat, rpy); in loadSensorLog()1324 private static Mat quat2rpy(Mat quat) { in quat2rpy() argument1326 quat.get(0,0,q); in quat2rpy()1339 double [] quat = {Math.cos(t/2), Math.sin(t/2)*r[0]/t,Math.sin(t/2)*r[1]/t, in rodr2quat() local1341 return quat; in rodr2quat()[all …]