Great! - I've just ported the Arduino project for the same problem, so I'm off now to have a look at how you've implemented it.
You'd be interested that I ended up using an adjusted version of your lib for my Netduino based Maker Faire UK project last weekend. Worked great - thanks.
- Michiel likes this