public static void extractFrameTupleFromEJMLVector(FrameTuple3DBasics frameTuple, DenseMatrix64F ejmlVector, ReferenceFrame desiredFrame, int startIndex) { frameTuple.setToZero(desiredFrame); frameTuple.setX(ejmlVector.get(startIndex + 0, 0)); frameTuple.setY(ejmlVector.get(startIndex + 1, 0)); frameTuple.setZ(ejmlVector.get(startIndex + 2, 0)); }