Can I recommend posting a detailed description of your project in the thread @ogiewon started for Hubduino? I've linked to it below. There are many many examples of him helping folks out in that thread - both with sketches and drivers.