Improvement/baselink ground removal

Now ground removal is not based on the lidar frame but on base link - easier to swap between lidars. Also, the ground removal has been put into a separate class so that I can easily improve on that standalone module in the future.