Head light control

Control of the head lights on the topic /head/cmd_light_state, message type scitos_msgs/HeadLightState, examples in resources/head_lights_*.yaml