Уже все давно реализовано на ардуине
аналог MTR http://uarl.info/forum/index.php?topic=162.0
аналог PFR http://uarl.info/forum/index.php?topic=131.0
описание, печатки и скетчи в темах