star: mpu: Fix the detection of mpu + add the right mpu

Fixes one null-pointer, adds some code for debugging and adds the richt accel + the right detection

Change-Id: Ibf3a14e43e996f9678b112ef2ed27695c9b3052e