[mman1506]

I'm not a programmer but as someone who is familiar with multiwii I would probably avoid it and talk directly to the MPU 6050. There are boards like this that can handle a 5v input. I would probably start by looking at the ADXL_345 i2c class and modify that to read the MPU 6050. There communication protocol is similar.