Functions to fit tracked trajectories

Files used in the project with Jeremie and Sam