[filterSfM] multiple improvements

- update parameters and code structure for a clearer understanding of different steps
- fix bug with damping renormalization
- add comments

Author: almarouk