Segway Controller 

http://www.youtube.com/watch?v=dXdAo7b8_Hs&feature=youtu.be

The md25 motors aren't quite fast enough to get the kind of response I was hoping for, but the controller is working well.

There is also some reorganization of controllib to separate the uorb blocks from the regular control blocks.