Searched refs:quat (Results 1 – 1 of 1) sorted by relevance
397 double [] quat = new double[4]; in loadSensorLog() local413 quat[0] = Double.parseDouble(items[1]); in loadSensorLog()414 quat[1] = Double.parseDouble(items[2]); in loadSensorLog()415 quat[2] = Double.parseDouble(items[3]); in loadSensorLog()416 quat[3] = Double.parseDouble(items[4]); in loadSensorLog()419 quat2rpy(quat, rpy); in loadSensorLog()1285 private static Mat quat2rpy(Mat quat) { in quat2rpy() argument1287 quat.get(0,0,q); in quat2rpy()1300 double [] quat = {Math.cos(t/2), Math.sin(t/2)*r[0]/t,Math.sin(t/2)*r[1]/t, in rodr2quat() local1302 return quat; in rodr2quat()[all …]