Time optimal position control