git.oblomov.eu Git - linux-2.6/blob - arch/sh/kernel/cpu/adc.c

   1 /*
   2  * linux/arch/sh/kernel/adc.c -- SH3 on-chip ADC support
   3  *
   4  *  Copyright (C) 2004  Andriy Skulysh <askulysh@image.kiev.ua>
   5  */
   6
   7 #include <linux/module.h>
   8 #include <asm/adc.h>
   9 #include <asm/io.h>
  10
  11
  12 int adc_single(unsigned int channel)
  13 {
  14         int off;
  15         unsigned char csr;
  16
  17         if (channel >= 8) return -1;
  18
  19         off = (channel & 0x03) << 2;
  20
  21         csr = ctrl_inb(ADCSR);
  22         csr = channel | ADCSR_ADST | ADCSR_CKS;
  23         ctrl_outb(csr, ADCSR);
  24
  25         do {
  26                 csr = ctrl_inb(ADCSR);
  27         } while ((csr & ADCSR_ADF) == 0);
  28
  29         csr &= ~(ADCSR_ADF | ADCSR_ADST);
  30         ctrl_outb(csr, ADCSR);
  31
  32         return (((ctrl_inb(ADDRAH + off) << 8) |
  33                 ctrl_inb(ADDRAL + off)) >> 6);
  34 }
  35
  36 EXPORT_SYMBOL(adc_single);