Updated OpenROV.ino with functionality