[perf][refactor] Clean and improve CerestCostFunctions

This file has been massively improved in SLAM MR 28.

These changes clean, simplify and greatly accelerate Ceres Residuals (~40%).

This MR aims at reporting these changes in LVCore.

@nick.laurenson @julia.sanchez @lea.vauchier @jerome.dias @melanie.carriere PTAL