"Finished" but did not test MPU6050 DMP code - heavily based on example code. I have removed some bits and changed the setup procedure slightly. As yet untested.