Clean old slam sources

There is old slam source code in LidarPlugin/Plugin/LidarCore/Filter/TrajectoryReoptimization, we should maybe remove it.