#include <stdio.h>
#include <asm/io.h>
#include "adc.h"

int init_adc()
{
	int i;
	unsigned int Clock_Data = SAMPLING_CLOCK / 250 - 1;

	outb_p(0x0, ADC_BASE_ADDR + 0x08);  /* AD initialization */
	outb_p(0x01, ADC_BASE_ADDR + 0x08);  /* mode set command */
	outb_p(SINGLE_END | MULTI | INTERNAL_CLOCK | SOFTWARE_COMMAND, ADC_BASE_ADDR + 0x0c);

	/* input range setting */
	outb_p(0x02, ADC_BASE_ADDR + 0x08);

	for(i = 0; i <= CH; i++){
		outb_p(i, ADC_BASE_ADDR + 0x0c);  /* channel i */
		outb_p(0x01, ADC_BASE_ADDR + 0x0d);  /* +- 5V */
	}
	
	/* internal sampling clock setting */
	outb_p(0x03, ADC_BASE_ADDR + 0x08);
	outb_p(Clock_Data & 0x000000ff, ADC_BASE_ADDR + 0x0c);
	outb_p(Clock_Data >> 8 & 0x000000ff, ADC_BASE_ADDR + 0x0d);
	outb_p(Clock_Data >> 16 & 0x000000ff, ADC_BASE_ADDR + 0x0e);
	outb_p(Clock_Data >> 24 & 0x000000ff, ADC_BASE_ADDR + 0x0f);

	return 0;
}

void cleanup_adc(void)
{
  //	outb_p(0x04, ADC_BASE_ADDR + 0x06);  /* sampling stop */
}


int ad_conv(double *y)
{
        int i = 0;
	unsigned short Status;
	int AiData;
	int WaitTime = 0;

	outb_p(CH, ADC_BASE_ADDR + 0x04);  /* Conversion Start */

	do{
		Status = inb_p(ADC_BASE_ADDR + 0x06);
		if(++WaitTime >= 0xf5000)
			return -1;
	}while((Status & DRE) == 0);  /* Data in Buffer ? */

	for(i = 0; i <= CH; i++){
		AiData = inw_p(ADC_BASE_ADDR);
		y[i] = (double)(AiData & 0x0fff)*10./4096. - 5.;
	}

	return 0;
}

int init_dac(void)
{
	outb_p(0x0, DAC_BASE_ADDR + 0x08);  /* DA initialization */
	outb_p(0x01, DAC_BASE_ADDR + 0x08);  /* sampling cond. */
	outb_p(0x0, DAC_BASE_ADDR + 0x0c);

	/* output range setting */
	outb_p(0x02, DAC_BASE_ADDR + 0x08);
	outb_p(0x00, DAC_BASE_ADDR + 0x0c);  /* channel 0 */
	outb_p(0x01, DAC_BASE_ADDR + 0x0d);  /* +- 5V */

	outb_p(0x01, DAC_BASE_ADDR + 0x0c);  /* channel 1 */
	outb_p(0x01, DAC_BASE_ADDR + 0x0d);  /* +- 5V */

	outb_p(0x02, DAC_BASE_ADDR + 0x0c);  /* channel 2 */
	outb_p(0x01, DAC_BASE_ADDR + 0x0d);  /* +- 5V */

	return 0;
}

void cleanup_dac(void)
{
  //	outb_p(0x04, DAC_BASE_ADDR + 0x06);  /* sampling stop */
}


int da_conv(double v, unsigned char ch)
{
	unsigned short val;

	if(ch != 0 && ch != 1 && ch != 2){
		return -1;
	}

	if(v > V_MAX) v = V_MAX;
	else if(v < V_MIN) v = V_MIN;

	val = (v + 5.) * 4096 / 10.;

	outb_p(ch, DAC_BASE_ADDR + 0x04);  /* conversion start */
	outw_p(val & 0x0fff, DAC_BASE_ADDR);  /* 12 bits */

	return 0;
}