Split the code into more logical files

Custom functions, help print function and interpreter (it reads serial
input and interprets sent commands).