Spacecraft high precision optimized control for free-falling test mass tracking in LISA-Pathfinder mission