Алгоритм автофокусировки для USB-микроскопа

Я пытаюсь разработать систему автофокусировки для недорогого USB-микроскопа. Я разрабатывал аппаратную часть с прецизионным двигателем PAP, который может регулировать ручку фокусировки в микроскопе , и теперь я нахожусь в самой сложной части.

Я думал о том, как это сделать. внедрить программное обеспечение. Оборудование имеет два порта USB, один для камеры микроскопа и другой для двигателя. Моя первоначальная идея - написать приложение на C #, которое сможет получать изображение с микроскопа и двигать двигатель вперед и назад, пока все хорошо :)

Теперь мне нужна небольшая помощь с автофокусом , как это реализовать? Есть какой-нибудь хороший алгоритм для этого? Или, может быть, библиотека обработки изображений, которая поможет мне в моей задаче?

Я искал в Google, но безуспешно ... Буду признателен за любую помощь / идею / рекомендацию!

Большое спасибо :)

EDIT : Спасибо, ребята, за ваши ответы, я попробую все варианты и вернусь сюда с результатами (или, возможно, другими вопросами).