Ball and Plate Balancing System Code