Segway simulation

Target position
vmax = thetamax =