rt-thread/bsp/CME_M7/StdPeriph_Driver/src/cmem7_adc.c

310 lines
8.9 KiB
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;
}