Segway simulation



Target position
u = *(x-target) + * v + * theta + * omega