tvlqr-related speedups
add utraj