public static void insertFrameQuaternionIntoEJMLVector(FrameQuaternionReadOnly frameOrientation, DenseMatrix64F matrix, int rowStart) { int index = rowStart; matrix.set(index++, 0, frameOrientation.getX()); matrix.set(index++, 0, frameOrientation.getY()); matrix.set(index++, 0, frameOrientation.getZ()); matrix.set(index++, 0, frameOrientation.getS()); }