А что за алгоритм? Датчик какой используется или же предполагается написание программы?