Kirill912 2007, рад помочь. А у вас интересный проект. Сам я настолько далек от ЧПУ и арудино что задача кажется крайне сложной в реализации. В любом случае желаю удачи :-)
Разбейте задачу на подзадачи. Разберите каждую из них на листочке до тех пор пока не будет полного понимания как работает та или иная часть. Только не все скопом, а последовательно, одну за другой.
Переведите мысли в код, потестируйте, отловите ошибки, исправьте. Цикл повторить до тех пор пока не будет работать как надо.
