I can do this for u.. I am an experienced arduino programmer. we are direct sparkfun and arduino dealer. We have done arduino projects consisting of various technologies like Touchscreen, Zigbee, All basic ones, Accelerometers, CAN, LCDs, Bluetooth, I2c,SPI, UARt and many more.. i will get u a sample code for your project in the PM