Modularize Sensor_Testbed. Upgrade controller plugin for Sensor_Testbed. Change gztopic name for LIDAR