void saradc_enable(void)
{
int i;
enable_bandgap();
set_clock_src(0); //0-xtal, 1-clk81
//set adc clock as 1.28Mhz @sys=27MHz
set_clock_divider(20);
enable_clock();
enable_adc();
set_sample_mode(DIFF_MODE);
set_tempsen(0);
disable_fifo_irq();
disable_continuous_sample();
disable_chan0_delta();
disable_chan1_delta();
set_input_delay(10, INPUT_DELAY_TB_1US);
set_sample_delay(10, SAMPLE_DELAY_TB_1US);
set_block_delay(10, BLOCK_DELAY_TB_1US);
// channels sampling mode setting
for(i=0; i<AML_ADC_SARADC_CHAN_NUM; i++) {
set_sample_sw(i, IDLE_SW);
set_sample_mux(i, g_chan_mux[i]);
}
// idle mode setting
set_idle_sw(IDLE_SW);
set_idle_mux(g_chan_mux[AML_ADC_CHAN_0]);
// detect mode setting
set_detect_sw(DETECT_SW);
set_detect_mux(g_chan_mux[AML_ADC_CHAN_0]);
disable_detect_sw();
disable_detect_pullup();
set_detect_irq_pol(0);
disable_detect_irq();
set_cal_voltage(7);
enable_sample_engine();
#if AML_ADC_SAMPLE_DEBUG
printf("ADCREG reg0 =%x\n", get_reg(PP_SAR_ADC_REG0));
printf("ADCREG ch list =%x\n",get_reg(PP_SAR_ADC_CHAN_LIST));
printf("ADCREG avg =%x\n", get_reg(PP_SAR_ADC_AVG_CNTL));
printf("ADCREG reg3 =%x\n", get_reg(PP_SAR_ADC_REG3));
printf("ADCREG ch72 sw =%x\n",get_reg(PP_SAR_ADC_AUX_SW));
printf("ADCREG ch10 sw =%x\n",get_reg(PP_SAR_ADC_CHAN_10_SW));
printf("ADCREG detect&idle=%x\n",get_reg(PP_SAR_ADC_DETECT_IDLE_SW));
#endif //AML_ADC_SAMPLE_DEBUG
select_temp();
enable_temp();
enable_temp__();
udelay(1000);
}
static void adc_start_sample(int chan)
{
set_chan_list(chan, 1);
set_avg_mode(chan, NO_AVG_MODE, SAMPLE_NUM_1);
set_sample_mux(chan, g_chan_mux[chan]);
set_detect_mux(g_chan_mux[chan]);
set_idle_mux(g_chan_mux[chan]); // for revb
enable_sample_engine();
start_sample();
adc_sample_time = 0;
}
int get_adc_sample(int chan)
{
int count;
int value = -1;
int sum;
set_chan_list(chan, 1);
set_avg_mode(chan, NO_AVG_MODE, SAMPLE_NUM_8);
set_sample_mux(chan, g_chan_mux[chan]);
set_detect_mux(g_chan_mux[chan]);
set_idle_mux(g_chan_mux[chan]); // for revb
enable_sample_engine();
start_sample();
// Read any CBUS register to delay one clock
// cycle after starting the sampling engine
// The bus is really fast and we may miss that it started
{ count = READ_CBUS_REG(ISA_TIMERE); }
count = 0;
while (delta_busy() || sample_busy() || avg_busy()){
if (++count > 10000){
printf("ADC busy error.\n");
goto adc_sample_end;
}
}
stop_sample();
sum = 0;
count = 0;
value = get_fifo_sample();
while (get_fifo_cnt()){
value = get_fifo_sample() & 0x3ff;
if ((value != 0x1fe) && (value != 0x1ff)){
sum += value & 0x3ff;
count++;
}
}
value = (count) ? (sum / count) : (-1);
adc_sample_end:
#if AML_ADC_SAMPLE_DEBUG
printf("ch%d = %d, count=%d\n", chan, value, count);
#endif //AML_ADC_SAMPLE_DEBUG
disable_sample_engine();
set_sc_phase();
return value;
}
static void saradc_reset(void)
{
int i;
#if defined(CONFIG_ARCH_MESONG9TV) || defined(CONFIG_ARCH_MESONG9BB)
set_sar_adc_clk();
#endif
//set adc clock as 1.28Mhz
set_clock_divider(20);
saradc_power_control(1);
set_sample_mode(DIFF_MODE);
set_tempsen(0);
disable_fifo_irq();
disable_continuous_sample();
disable_chan0_delta();
disable_chan1_delta();
set_input_delay(10, INPUT_DELAY_TB_1US);
set_sample_delay(10, SAMPLE_DELAY_TB_1US);
set_block_delay(10, BLOCK_DELAY_TB_1US);
// channels sampling mode setting
for(i=0; i<SARADC_CHAN_NUM; i++) {
set_sample_sw(i, IDLE_SW);
set_sample_mux(i, chan_mux[i]);
}
// idle mode setting
set_idle_sw(IDLE_SW);
set_idle_mux(chan_mux[CHAN_0]);
// detect mode setting
set_detect_sw(DETECT_SW);
set_detect_mux(chan_mux[CHAN_0]);
disable_detect_sw();
disable_detect_pullup();
set_detect_irq_pol(0);
disable_detect_irq();
// set_sc_phase();
enable_sample_engine();
// printk("ADCREG reg0 =%x\n", get_reg(PP_SAR_ADC_REG0));
// printk("ADCREG ch list =%x\n", get_reg(PP_SAR_ADC_CHAN_LIST));
// printk("ADCREG avg =%x\n", get_reg(PP_SAR_ADC_AVG_CNTL));
// printk("ADCREG reg3=%x\n", get_reg(PP_SAR_ADC_REG3));
// printk("ADCREG ch72 sw=%x\n", get_reg(PP_SAR_ADC_AUX_SW));
// printk("ADCREG ch10 sw=%x\n", get_reg(PP_SAR_ADC_CHAN_10_SW));
// printk("ADCREG detect&idle=%x\n", get_reg(PP_SAR_ADC_DETECT_IDLE_SW));
}
int get_adc_sample(int chan)
{
int count;
int value;
int sum;
if (!gp_saradc)
return -1;
spin_lock(&gp_saradc->lock);
set_chan_list(chan, 1);
set_avg_mode(chan, NO_AVG_MODE, SAMPLE_NUM_8);
set_sample_mux(chan, chan_mux[chan]);
set_detect_mux(chan_mux[chan]);
set_idle_mux(chan_mux[chan]); // for revb
enable_sample_engine();
start_sample();
// Read any CBUS register to delay one clock cycle after starting the sampling engine
// The bus is really fast and we may miss that it started
{ count = get_reg(ISA_TIMERE); }
count = 0;
while (delta_busy() || sample_busy() || avg_busy()) {
if (++count > 10000) {
printk(KERN_ERR "ADC busy error.\n");
goto end;
}
}
stop_sample();
sum = 0;
count = 0;
value = get_fifo_sample();
while (get_fifo_cnt()) {
value = get_fifo_sample() & 0x3ff;
if ((value != 0x1fe) && (value != 0x1ff)) {
sum += value & 0x3ff;
count++;
}
}
value = (count) ? (sum / count) : (-1);
end:
//printk("ch%d = %d, count=%d\n", chan, value, count);
disable_sample_engine();
spin_unlock(&gp_saradc->lock);
return value;
}
static void saradc_init(void)
{
int i;
enable_bandgap();
//low speed, set to clk81 without division
set_clock_src(1); //0-xtal, 1-clk81
set_clock_divider(0);
enable_clock();
enable_adc();
set_sample_mode(DIFF_MODE);
set_tempsen(0);
disable_fifo_irq();
disable_continuous_sample();
disable_chan0_delta();
disable_chan1_delta();
set_input_delay(10, INPUT_DELAY_TB_1US);
set_sample_delay(10, SAMPLE_DELAY_TB_1US);
set_block_delay(10, BLOCK_DELAY_TB_1US);
aml_set_reg32_bits(P_AO_SAR_ADC_DELAY, 3, 27, 2);
// channels sampling mode setting
for(i=0; i<AML_ADC_SARADC_CHAN_NUM; i++) {
set_sample_sw(i, IDLE_SW);
set_sample_mux(i, g_chan_mux[i]);
}
// idle mode setting
set_idle_sw(IDLE_SW);
set_idle_mux(g_chan_mux[AML_ADC_CHAN_0]);
// detect mode setting
set_detect_sw(DETECT_SW);
set_detect_mux(g_chan_mux[AML_ADC_CHAN_0]);
disable_detect_sw();
disable_detect_pullup();
set_detect_irq_pol(0);
disable_detect_irq();
set_cal_voltage(7);
set_sc_phase();
enable_sample_engine();
udelay(1000);
while (get_fifo_cnt()) {
i = get_fifo_sample() & 0x3ff;
}
}
