fixed compilation errors

Compilation errors fixed, including defining data types, changing from
MPU9250 templates and other stupid shit