Lines Matching refs:rpy
352 AttitudeRec(double atime, double [] rpy) {
354 roll = rpy[0];
355 pitch = rpy[1];
356 yaw = rpy[2];
398 double [] rpy = new double[3];
419 quat2rpy(quat, rpy);
424 recs.add(new AttitudeRec(Long.parseLong(items[0])/1e9-t0, rpy));
514 double [] rpy = new double[3];
528 rpy[0] = Double.parseDouble(items[1]);
529 rpy[1] = Double.parseDouble(items[2]);
530 rpy[2] = Double.parseDouble(items[3]);
532 recs.add(new AttitudeRec(time, rpy));
1273 double [] rpy = {Math.atan2(2*(q[0]*q[1]+q[2]*q[3]), 1-2*(q[1]*q[1]+q[2]*q[2])),
1276 return rpy;
1279 private static void quat2rpy( double [] q, double[] rpy) {
1280 rpy[0] = Math.atan2(2*(q[0]*q[1]+q[2]*q[3]), 1-2*(q[1]*q[1]+q[2]*q[2]));
1281 rpy[1] = Math.asin(2*(q[0]*q[2] - q[3]*q[1]));
1282 rpy[2] = Math.atan2(2*(q[0]*q[3]+q[1]*q[2]), 1-2*(q[2]*q[2]+q[3]*q[3]));
1289 double [] rpy = {Math.atan2(2*(q[0]*q[1]+q[2]*q[3]), 1-2*(q[1]*q[1]+q[2]*q[2])),
1294 rpym.put(0,0, rpy);