Fixed some errors on controller Arduino code