Firmware for my small balancing robot. Uses gyros, accelerometers and rotary encoders to maintain balance.