Added approx. dynamic inversion to segway controller.