Remove Vasc and Zhang initialization to speed code and simulation

- Disabled warnings in lsqnonlin
- Improved code in error function reprojectLaserCalib
Corrected generate_random_poses for N=1
Complete the previous commit