htrans.zrot(-dh); // this transform method takes degrees, not radians
Vect[] vects = Vect.toVectors(newHeading, oldPitch, 0);
ptrans.vrot(0, 0, 0,
vects[1].x(), vects[1].y(), vects[1].z(), StrictMath.toRadians(dp));
vects = Vect.toVectors(newHeading, newPitch, oldRoll);
rtrans.vrot(0, 0, 0,
vects[0].x(), vects[0].y(), vects[0].z(), StrictMath.toRadians(dr));
double[] out = new double[3];
for (Turtle t1 : myTies) {