Add plotCostFunction base method in CBaseOptimization

This function allows to plot cost function for 3 variables (in 3 plots) in a generic way

Some representation options are added to this parent class for inheritance
Add functions, optimization and plotting to CCornerOptimization

Functions are based in 2D distance as Kwak's
The weight is computed as explained in Kwak

Several optimization methods are available:
- NonWeighted: No weights are used
- Weighted: Weights are computed in each step
- ConstWeighted: The weights are constant (computed from NW solution)
- PreWeighted: Weights are computed in each step but optimization used NW solution as initial estimate
Add ; in W
Refactor and add 2D error function in CTrihedronOptimization
Order in LM SE(3) is [rot,trans]
Add resolution properties to CConfigLidar
Change LRF points to 2D in CCorner

Added also some comments about storage order
Commented plotScanFeatures in plotScene
Added property Rt (concatenated R and t) for CSimRig
Update main_Jesus with all changes and added options

TODO: Main options for plotting and RANSAC will go to a .ini file