Better lights control
Better lights control

Flash green lights when teleoperated goals released
Turn on orange lights when robots are disabled
Turn on red lights when robots are not connected

pioneers/forseti2,pioneers/forseti2,mnuyens/forseti2,mnuyens/forseti2,pioneers/forseti2,pioneers/forseti2,mnuyens/forseti2,mnuyens/forseti2,mnuyens/forseti2