I did that...it's SUPER easy. Someone has already done all the heavy lifting too.
Works with all the Hubduino drivers. (Hubduino = ST_Anything)