Use normalized u throughout trajectory setup