Adding new Sensors, improved waiting-tasks and fixed Bugs. MPU9150DMP still not functional. Working on that.