source: class PosemathTest  {
  
      static final private double ASSERT_TOLERANCE_DELTA;
  
      @Test
      public void testToRot_PmRpy() throws Exception {
  
target:         System.out.println("toRot");
          PmRpy rpy = new PmRpy(0.0,0.0,Math.PI/2.0);
          PmRotationVector expResult = new PmRotationVector(Math.PI/2.0,0.0,0.0,1.0);
          PmRotationVector result = Posemath.toRot(rpy);
          checkEquals("yaw",expResult,result);
      }
  
  }