[kostya740]

ээээ, механически реализовать я не могу. Да и подсказать не в силах. Я программист, а не токарь-механик.
Если вам софт какой-то под ось или микроконтроллер, то пишите ТЗ(тех. задание). Времени свободного не много, так что ничего сложного не просить.