Change internal data type from float to int16_t and cast accel data as int16_t for shift to work properly