Add restrict keyword to a number of function in TrkExUtils

Adding the restrict keyword to a number of functions in used track extrapolation to see if it helps the compiler optimise things a little better.

Tagging @christos