Writing RSSI field not only in servo rail topic
RSSI field init