Code from the segway project. Created in collaboration with Jakob B. N. and Peter R.