Create arduniocode.cpp

Main code for control system. Work in progress