path: root/bsp/CME_M7/StdPeriph_Driver/src/cmem7_adc.c

/**
    *****************************************************************************
    * @file     cmem7_adc.c
    *
    * @brief    CMEM7 ADC source file
    *
    *
    * @version  V1.0
    * @date     3. September 2013
    *
    * @note
    *
    *****************************************************************************
    * @attention
    *
    * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
    * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
    * TIME. AS A RESULT, CAPITAL-MICRO SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
    * INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
    * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
    * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
    *
    * <h2><center>&copy; COPYRIGHT 2013 Capital-micro </center></h2>
    *****************************************************************************
    */

#include "cmem7_adc.h"
#include "cmem7.h"

#define ADC_SYSTEM_MODE_IDLE       0

static BOOL adc_IsMultiChannel(uint32_t channel) {
    uint32_t i = 0;

    for (i = 0; channel != 0; i++) {
    channel &= (channel - 1);
    }

    return ((i > 1) ? TRUE : FALSE);
}

static uint8_t adc_GetChannel(uint32_t channel) {
    uint32_t i = 0;

    for (i = 0; channel > 1; i++) {
    channel >>= 1;
    }

    return i;
}

static void adc_Reset(uint8_t adc, BOOL enable) {
    if (adc == ADC_PERIPH_1) {
        ADC->POWERDOWN_RESET_b.POWERDOWN_ADC1 = TRUE;
        ADC->POWERDOWN_RESET_b.RESET_ADC1 = TRUE;
        udelay(8000);
        if (enable) {
            ADC->POWERDOWN_RESET_b.POWERDOWN_ADC1 = FALSE;
            ADC->POWERDOWN_RESET_b.RESET_ADC1 = FALSE;
            udelay(8000);
        }
    } else {
        ADC->POWERDOWN_RESET_b.POWERDOWN_ADC2 = TRUE;
        ADC->POWERDOWN_RESET_b.RESET_ADC2 = TRUE;
        udelay(8000);
        if (enable) {
            ADC->POWERDOWN_RESET_b.POWERDOWN_ADC2 = FALSE;
            ADC->POWERDOWN_RESET_b.RESET_ADC2 = FALSE;
            udelay(8000);
        }
    }
}

void ADC_Init(ADC_InitTypeDef* init) {
    assert_param(init);
    assert_param(IS_ADC_PHASE_CTRL(init->ADC_PhaseCtrl));
    assert_param(IS_ADC_VSEN(init->ADC_VsenSelection));

    SOFT_RESET->SOFTRST_b.ADC_n = 0;
    SOFT_RESET->SOFTRST_b.ADC_n = 1;

    ADC->CFG0_b.PHASE_CTRL = init->ADC_PhaseCtrl;
    ADC->CFG0_b.VSEN = init->ADC_VsenSelection;
}

void ADC_Enable(uint8_t adc, BOOL enable) {
    assert_param(IS_ADC_ALL_PERIPH(adc));

    adc_Reset(adc, enable);
}

void ADC_EnableInt(uint32_t Int, BOOL enable) {
    assert_param(IS_ADC_INT(Int));

    if (enable) {
      ADC->INT_MASK &= ~Int;
    } else {
        ADC->INT_MASK |= Int;
    }
}

BOOL ADC_GetIntStatus(uint32_t Int) {
    assert_param(IS_ADC_INT(Int));

    if (0 != (ADC->INT_STATUS & Int)) {
        return TRUE;
    }

    return FALSE;
}

void ADC_ClearInt(uint32_t Int) {
    assert_param(IS_ADC_INT(Int));

    ADC->INT_STATUS = Int;
}

BOOL ADC_StartConversion(uint8_t adc, uint8_t convMode, uint32_t channel) {
    assert_param(IS_ADC_ALL_PERIPH(adc));
    assert_param(IS_ADC_CONVERSION(convMode));

    if (adc == ADC_PERIPH_1) {
        assert_param(IS_ADC1_CHANNEL(channel));
        if (ADC->BUSY_b.ADC1_BUSY) {
            return FALSE;
        }

        if (adc_IsMultiChannel(channel)) {
            ADC->CFG_ADC1_b.SYSTEM_MODE = ADC_SYSTEM_MODE_SINGLE_CONV;
            ADC->CFG_ADC1_b.MULTI_CHANNEL_BIT = channel;
            ADC->CFG_ADC1_b.MULTI_CHANNEL_CONTINUE_SCAN =
                (convMode == ADC_SYSTEM_MODE_CONTINUOUS_CONV) ? 1 : 0;
        } else {
            ADC->CFG_ADC1_b.SYSTEM_MODE = convMode;

            if (convMode == ADC_SYSTEM_MODE_CONTINUOUS_CONV) {
                ADC->CFG_ADC1_b.CHANNEL_SEL = adc_GetChannel(channel);
            } else {
                ADC->CFG_ADC1_b.MULTI_CHANNEL_BIT = channel;
                ADC->CFG_ADC1_b.MULTI_CHANNEL_CONTINUE_SCAN = 0;
            }
        }

        ADC->ADC1_START_b.EN = TRUE;
    } else {
        assert_param(IS_ADC2_CHANNEL(channel));
        if (ADC->BUSY_b.ADC2_BUSY) {
            return FALSE;
        }

        if (adc_IsMultiChannel(channel)) {
            ADC->CFG_ADC2_b.SYSTEM_MODE = ADC_SYSTEM_MODE_SINGLE_CONV;
            ADC->CFG_ADC2_b.MULTI_CHANNEL_BIT = channel;
            ADC->CFG_ADC2_b.MULTI_CHANNEL_CONTINUE_SCAN =
                (convMode == ADC_SYSTEM_MODE_CONTINUOUS_CONV) ? 1 : 0;
        } else {
            ADC->CFG_ADC2_b.SYSTEM_MODE = convMode;

            if (convMode == ADC_SYSTEM_MODE_CONTINUOUS_CONV) {
                ADC->CFG_ADC2_b.CHANNEL_SEL = adc_GetChannel(channel);
            } else {
                ADC->CFG_ADC2_b.MULTI_CHANNEL_BIT = channel;
                ADC->CFG_ADC2_b.MULTI_CHANNEL_CONTINUE_SCAN = 0;
            }
        }

        ADC->ADC2_START_b.EN = TRUE;
    }

    return TRUE;
}

BOOL ADC_StartCalibration(uint8_t adc, uint8_t calibration) {
    assert_param(IS_ADC_ALL_PERIPH(adc));
    assert_param(IS_ADC_CALIBRATION(calibration));

    if (adc == ADC_PERIPH_1) {
        if (ADC->BUSY_b.ADC1_BUSY) {
            return FALSE;
        }

        ADC->CFG_ADC1_b.SYSTEM_MODE = calibration;
        ADC->ADC1_START_b.EN = TRUE;
    } else {
        if (ADC->BUSY_b.ADC2_BUSY) {
            return FALSE;
        }

        ADC->CFG_ADC2_b.SYSTEM_MODE = calibration;
        ADC->ADC2_START_b.EN = TRUE;
    }

    return TRUE;
}

void ADC_Stop(uint8_t adc) {
    assert_param(IS_ADC_ALL_PERIPH(adc));

    if (adc == ADC_PERIPH_1) {
        if (IS_ADC_CONVERSION(ADC->CFG_ADC1_b.SYSTEM_MODE)) {
            ADC->ADC1_STOP_b.EN = TRUE;
        }
        while (ADC->BUSY_b.ADC1_BUSY) ;

        ADC->ADC1_FIFO_CLEAR_b.CLEAR = TRUE;
        //udelay(1000);
        ADC->ADC1_FIFO_CLEAR_b.CLEAR = FALSE;
    } else {
        if (IS_ADC_CONVERSION(ADC->CFG_ADC2_b.SYSTEM_MODE)) {
            ADC->ADC2_STOP_b.EN = TRUE;
        }
        while (ADC->BUSY_b.ADC2_BUSY) ;

        ADC->ADC2_FIFO_CLEAR_b.CLEAR = TRUE;
        //udelay(1000);
        ADC->ADC2_FIFO_CLEAR_b.CLEAR = FALSE;
    }
}

BOOL ADC_IsBusy(uint8_t adc) {
    assert_param(IS_ADC_ALL_PERIPH(adc));

    if (adc == ADC_PERIPH_1) {
        if (ADC->BUSY_b.ADC1_BUSY) {
            return TRUE;
        }
    } else {
        if (ADC->BUSY_b.ADC2_BUSY) {
            return TRUE;
        }
    }

    return FALSE;
}

/* return value is actual read data size */
uint8_t ADC_Read(uint8_t adc, uint8_t size, ADC_Data* data) {
    uint8_t count = 0;
    uint8_t sysMode;
    uint32_t tmp = 0;
    assert_param(IS_ADC_ALL_PERIPH(adc));
    assert_param(data);

    if (adc == ADC_PERIPH_1) {
        sysMode = ADC->CFG_ADC1_b.SYSTEM_MODE;
    } else {
        sysMode = ADC->CFG_ADC2_b.SYSTEM_MODE;
    }

    if ((sysMode == ADC_SYSTEM_MODE_SINGLE_CONV) ||
        (sysMode == ADC_SYSTEM_MODE_CONTINUOUS_CONV)) {
        while (count < size) {
            if (adc == ADC_PERIPH_1) {
                if (ADC->STATUS_b.ADC1_READ_EMPTY) {
                    break;
                }

                tmp = ADC->ADC1_FIFO_READ;
                (data + count)->channel = 1 << ((tmp&0xf000) >> 12);
                (data + count++)->data = (tmp & 0xfff);
            } else {
                if (ADC->STATUS_b.ADC2_READ_EMPTY) {
                    break;
                }
                tmp = ADC->ADC2_FIFO_READ;
                (data + count)->channel = 1 << ((tmp&0xf000) >> 12);
                (data + count++)->data = (tmp & 0xfff);
            }
        }
    } else if (sysMode == ADC_CALIBRATION_OFFSET) {
        if (adc == ADC_PERIPH_1) {
            if (!ADC->BUSY_b.ADC1_BUSY) {
                (data + count)->channel = ADC_CHANNEL_CALIBRATION;
                (data + count++)->data = ADC->ADC1_OUT_OFFSET_CALIBRATION;
          }
        } else {
            if (!ADC->BUSY_b.ADC2_BUSY) {
                (data + count)->channel = ADC_CHANNEL_CALIBRATION;
                (data + count++)->data = ADC->ADC2_OUT_OFFSET_CALIBRATION;
          }
        }
    } else if (sysMode == ADC_CALIBRATION_NEGTIVE_GAIN) {
        if (adc == ADC_PERIPH_1) {
            if (!ADC->BUSY_b.ADC1_BUSY) {
                (data + count)->channel = ADC_CHANNEL_CALIBRATION;
                (data + count++)->data = ADC->ADC1_OUT_NEGTIVE_GAIN_CALIBRATION;
            }
        } else {
            if (!ADC->BUSY_b.ADC2_BUSY) {
              (data + count)->channel = ADC_CHANNEL_CALIBRATION;
                (data + count++)->data = ADC->ADC2_OUT_NEGTIVE_GAIN_CALIBRATION;
          }
        }
    } else {
        if (adc == ADC_PERIPH_1) {
            if (!ADC->BUSY_b.ADC1_BUSY) {
                (data + count)->channel = ADC_CHANNEL_CALIBRATION;
                (data + count++)->data = ADC->ADC1_OUT_POSITIVE_GAIN_CALIBRATION;
            }
        } else {
            if (!ADC->BUSY_b.ADC2_BUSY) {
              (data + count)->channel = ADC_CHANNEL_CALIBRATION;
                (data + count++)->data = ADC->ADC2_OUT_POSITIVE_GAIN_CALIBRATION;
          }
        }
    }

    return count;
}