A small CNC

Will be glad to post the code after cleaning it up