The algorithm for my balancing robot/segway - View it on GitHub