Added int16_t cast to mag reads as well