Added beginnings of basic Segway control program
Fixed compass tilt compensation