fixed usr trajectory finding