As this is standard we could add to the firmware. But the best way is to let the firmware do it if there is a good way.
@dzwghx @robotluo