Sim: Create lidar class

TODO: Make it more generic (Easy)