Merged and updated PID and CmdArduino code