Add function to convert trajectory from field absolute to robot relative
Add function to convert trajectory from field absolute to robot relative