Нашел этот ответ на SO -
https://stackoverflow.com/a/28722407
В кратце, нужно сравнить 2 изображения - с применой фокусировкой и без. Фокусировка реализуется через применения оператора Лапласа
cv::Laplacian(src_gray, dst, CV_64F);
cv::Scalar mu, sigma;
cv::meanStdDev(dst, mu, sigma);
double focusMeasure = sigma.val[0] * sigma.val[0];
Для оптимизации предлагаю следующие варианты:
1. Всегда фокусироваться
2. Через определенные промежутки времени (либо кол-во кадров, не суть), брать сампл изображения и для него вычислять размытость - если изображение размыто, то дальше применяем фокусировку
P.S. под фокусировкой я понял резкость/размытость изображения