Self-Balancing Robot Code