Hi,
I posted this several weeks ago (and it got an ACK), but I never comitted it; I'm reposting again just in case, as I did some improvements on the code.
This is verified to build and work on real hardware (ASI MB-5BLMP).
It's quite likely that this is needed to fix one or two other targets (one in the repo and one still in development).
Uwe.