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;
}
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;
}
}
