[fix] Fix some issues from !315
Bug explanation
The config files were specialized for Velodyne and did not work plug and play for other models (with other frame_id)
Solution
Create the special 1 Lidar case which always get the device ID : mainLidar
Other
This MR contains some refact for style/alignement and adds missing const/ref