status_t LIS3MDL_MAG_R_DataXYZOverrun(void *handle, LIS3MDL_MAG_ZYXOR_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_STATUS_REG, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_ZYXOR_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_LatchInterruptRq(void *handle, LIS3MDL_MAG_LIR_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_INT_CFG, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_LIR_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_BlockDataUpdate(void *handle, LIS3MDL_MAG_BDU_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG5, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_BDU_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_NewXYZData(void *handle, LIS3MDL_MAG_ZYXDA_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_STATUS_REG, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_ZYXDA_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_LittleBigEndianInversion(void *handle, LIS3MDL_MAG_BLE_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG4, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_BLE_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_OperatingModeZ(void *handle, LIS3MDL_MAG_OMZ_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG4, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_OMZ_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_SerialInterfaceMode(void *handle, LIS3MDL_MAG_SIM_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG3, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_SIM_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_FastLowPowerXYZ(void *handle, LIS3MDL_MAG_LP_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG3, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_LP_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_SystemOperatingMode(void *handle, LIS3MDL_MAG_MD_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG3, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_MD_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_FullScale(void *handle, LIS3MDL_MAG_FS_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG2, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_FS_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_Reboot(void *handle, LIS3MDL_MAG_REBOOT_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG2, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_REBOOT_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_InterruptActive(void *handle, LIS3MDL_MAG_IEA_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_INT_CFG, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_IEA_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_InterruptFlag(void *handle, LIS3MDL_MAG_INT_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_INT_SRC, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_INT_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_OutputDataRate(void *handle, LIS3MDL_MAG_DO_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG1, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_DO_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_PositiveThresholdFlagX(void *handle, LIS3MDL_MAG_PTH_X_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_INT_SRC, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_PTH_X_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_MagneticFieldOverflow(void *handle, LIS3MDL_MAG_MROI_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_INT_SRC, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_MROI_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_TemperatureSensor(void *handle, LIS3MDL_MAG_TEMP_EN_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG1, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_TEMP_EN_MASK; //mask
  
  return MEMS_SUCCESS;
}

status_t LIS3MDL_MAG_R_WHO_AM_I_(void *handle, u8_t *value)
{
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_WHO_AM_I_REG, (u8_t *)value) )
    return MEMS_ERROR;
    
  *value &= LIS3MDL_MAG_WHO_AM_I_BIT_MASK; //coerce
  *value = *value >> LIS3MDL_MAG_WHO_AM_I_BIT_POSITION; //mask
  
  return MEMS_SUCCESS;
}

/*******************************************************************************
* Function Name  : LIS3MDL_MAG_W_InterruptOnX
* Description    : Write XIEN
* Input          : LIS3MDL_MAG_XIEN_t
* Output         : None
* Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t  LIS3MDL_MAG_W_InterruptOnX(void *handle, LIS3MDL_MAG_XIEN_t newValue)
{
  u8_t value;
  
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_INT_CFG, &value) )
    return MEMS_ERROR;
    
  value &= ~LIS3MDL_MAG_XIEN_MASK;
  value |= newValue;
  
  if( !LIS3MDL_MAG_WriteReg(handle, LIS3MDL_MAG_INT_CFG, value) )
    return MEMS_ERROR;
    
  return MEMS_SUCCESS;
}

/*******************************************************************************
* Function Name  : LIS3MDL_MAG_W_BlockDataUpdate
* Description    : Write BDU
* Input          : LIS3MDL_MAG_BDU_t
* Output         : None
* Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
*******************************************************************************/
status_t  LIS3MDL_MAG_W_BlockDataUpdate(void *handle, LIS3MDL_MAG_BDU_t newValue)
{
  u8_t value;
  
  if( !LIS3MDL_MAG_ReadReg(handle, LIS3MDL_MAG_CTRL_REG5, &value) )
    return MEMS_ERROR;
    
  value &= ~LIS3MDL_MAG_BDU_MASK;
  value |= newValue;
  
  if( !LIS3MDL_MAG_WriteReg(handle, LIS3MDL_MAG_CTRL_REG5, value) )
    return MEMS_ERROR;
    
  return MEMS_SUCCESS;
}