Update Controller_2.ino

added servo read and write