A Basic PID controller - Balancing LEGO Robot