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);
}
int saradc_ts_service(int cmd)
{
int value = -1;
switch (cmd) {
case CMD_GET_X:
//set_sample_sw(CHAN_YP, X_SW);
value = get_adc_sample(CHAN_YP);
set_sample_sw(CHAN_XP, Y_SW); // preset for y
break;
case CMD_GET_Y:
//set_sample_sw(CHAN_XP, Y_SW);
value = get_adc_sample(CHAN_XP);
break;
case CMD_GET_Z1:
set_sample_sw(CHAN_XP, Z1_SW);
value = get_adc_sample(CHAN_XP);
break;
case CMD_GET_Z2:
set_sample_sw(CHAN_YN, Z2_SW);
value = get_adc_sample(CHAN_YN);
break;
case CMD_GET_PENDOWN:
value = !detect_level();
set_sample_sw(CHAN_YP, X_SW); // preset for x
break;
case CMD_INIT_PENIRQ:
enable_detect_pullup();
enable_detect_sw();
value = 0;
printk(KERN_INFO "init penirq ok\n");
break;
case CMD_SET_PENIRQ:
enable_detect_pullup();
enable_detect_sw();
value = 0;
break;
case CMD_CLEAR_PENIRQ:
disable_detect_pullup();
disable_detect_sw();
value = 0;
break;
default:
break;
}
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));
}
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;
}
}