OK, done already. And it works.
You might consider to include it in future version of your firmware.