Working on position control of segway.