Multiple corrections (indexes and variable names mainly) in order to
have the tracking working in the longitudinal plane.
A careful debugging and documentation has to be done...