sound/sparc/cs4231.c

   1 /*
   2  * Driver for CS4231 sound chips found on Sparcs.
   3  * Copyright (C) 2002 David S. Miller <davem@redhat.com>
   4  *
   5  * Based entirely upon drivers/sbus/audio/cs4231.c which is:
   6  * Copyright (C) 1996, 1997, 1998 Derrick J Brashear (shadow@andrew.cmu.edu)
   7  * and also sound/isa/cs423x/cs4231_lib.c which is:
   8  * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/kernel.h>
  13 #include <linux/slab.h>
  14 #include <linux/delay.h>
  15 #include <linux/init.h>
  16 #include <linux/interrupt.h>
  17 #include <linux/moduleparam.h>
  18 #include <linux/irq.h>
  19 #include <linux/io.h>
  20
  21
  22 #include <sound/driver.h>
  23 #include <sound/core.h>
  24 #include <sound/pcm.h>
  25 #include <sound/info.h>
  26 #include <sound/control.h>
  27 #include <sound/timer.h>
  28 #include <sound/initval.h>
  29 #include <sound/pcm_params.h>
  30
  31 #ifdef CONFIG_SBUS
  32 #define SBUS_SUPPORT
  33 #include <asm/sbus.h>
  34 #endif
  35
  36 #if defined(CONFIG_PCI) && defined(CONFIG_SPARC64)
  37 #define EBUS_SUPPORT
  38 #include <linux/pci.h>
  39 #include <asm/ebus.h>
  40 #endif
  41
  42 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;      /* Index 0-MAX */
  43 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;       /* ID for this card */
  44 /* Enable this card */
  45 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
  46
  47 module_param_array(index, int, NULL, 0444);
  48 MODULE_PARM_DESC(index, "Index value for Sun CS4231 soundcard.");
  49 module_param_array(id, charp, NULL, 0444);
  50 MODULE_PARM_DESC(id, "ID string for Sun CS4231 soundcard.");
  51 module_param_array(enable, bool, NULL, 0444);
  52 MODULE_PARM_DESC(enable, "Enable Sun CS4231 soundcard.");
  53 MODULE_AUTHOR("Jaroslav Kysela, Derrick J. Brashear and David S. Miller");
  54 MODULE_DESCRIPTION("Sun CS4231");
  55 MODULE_LICENSE("GPL");
  56 MODULE_SUPPORTED_DEVICE("{{Sun,CS4231}}");
  57
  58 #ifdef SBUS_SUPPORT
  59 struct sbus_dma_info {
  60        spinlock_t       lock;   /* DMA access lock */
  61        int              dir;
  62        void __iomem     *regs;
  63 };
  64 #endif
  65
  66 struct snd_cs4231;
  67 struct cs4231_dma_control {
  68         void            (*prepare)(struct cs4231_dma_control *dma_cont,
  69                                    int dir);
  70         void            (*enable)(struct cs4231_dma_control *dma_cont, int on);
  71         int             (*request)(struct cs4231_dma_control *dma_cont,
  72                                    dma_addr_t bus_addr, size_t len);
  73         unsigned int    (*address)(struct cs4231_dma_control *dma_cont);
  74         void            (*preallocate)(struct snd_cs4231 *chip,
  75                                        struct snd_pcm *pcm);
  76 #ifdef EBUS_SUPPORT
  77         struct          ebus_dma_info   ebus_info;
  78 #endif
  79 #ifdef SBUS_SUPPORT
  80         struct          sbus_dma_info   sbus_info;
  81 #endif
  82 };
  83
  84 struct snd_cs4231 {
  85         spinlock_t              lock;   /* registers access lock */
  86         void __iomem            *port;
  87
  88         struct cs4231_dma_control       p_dma;
  89         struct cs4231_dma_control       c_dma;
  90
  91         u32                     flags;
  92 #define CS4231_FLAG_EBUS        0x00000001
  93 #define CS4231_FLAG_PLAYBACK    0x00000002
  94 #define CS4231_FLAG_CAPTURE     0x00000004
  95
  96         struct snd_card         *card;
  97         struct snd_pcm          *pcm;
  98         struct snd_pcm_substream        *playback_substream;
  99         unsigned int            p_periods_sent;
 100         struct snd_pcm_substream        *capture_substream;
 101         unsigned int            c_periods_sent;
 102         struct snd_timer        *timer;
 103
 104         unsigned short mode;
 105 #define CS4231_MODE_NONE        0x0000
 106 #define CS4231_MODE_PLAY        0x0001
 107 #define CS4231_MODE_RECORD      0x0002
 108 #define CS4231_MODE_TIMER       0x0004
 109 #define CS4231_MODE_OPEN        (CS4231_MODE_PLAY | CS4231_MODE_RECORD | \
 110                                  CS4231_MODE_TIMER)
 111
 112         unsigned char           image[32];      /* registers image */
 113         int                     mce_bit;
 114         int                     calibrate_mute;
 115         struct mutex            mce_mutex;      /* mutex for mce register */
 116         struct mutex            open_mutex;     /* mutex for ALSA open/close */
 117
 118         union {
 119 #ifdef SBUS_SUPPORT
 120                 struct sbus_dev         *sdev;
 121 #endif
 122 #ifdef EBUS_SUPPORT
 123                 struct pci_dev          *pdev;
 124 #endif
 125         } dev_u;
 126         unsigned int            irq[2];
 127         unsigned int            regs_size;
 128         struct snd_cs4231       *next;
 129 };
 130
 131 static struct snd_cs4231 *cs4231_list;
 132
 133 /* Eventually we can use sound/isa/cs423x/cs4231_lib.c directly, but for
 134  * now....  -DaveM
 135  */
 136
 137 /* IO ports */
 138 #include <sound/cs4231-regs.h>
 139
 140 /* XXX offsets are different than PC ISA chips... */
 141 #define CS4231U(chip, x)        ((chip)->port + ((c_d_c_CS4231##x) << 2))
 142
 143 /* SBUS DMA register defines.  */
 144
 145 #define APCCSR  0x10UL  /* APC DMA CSR */
 146 #define APCCVA  0x20UL  /* APC Capture DMA Address */
 147 #define APCCC   0x24UL  /* APC Capture Count */
 148 #define APCCNVA 0x28UL  /* APC Capture DMA Next Address */
 149 #define APCCNC  0x2cUL  /* APC Capture Next Count */
 150 #define APCPVA  0x30UL  /* APC Play DMA Address */
 151 #define APCPC   0x34UL  /* APC Play Count */
 152 #define APCPNVA 0x38UL  /* APC Play DMA Next Address */
 153 #define APCPNC  0x3cUL  /* APC Play Next Count */
 154
 155 /* Defines for SBUS DMA-routines */
 156
 157 #define APCVA  0x0UL    /* APC DMA Address */
 158 #define APCC   0x4UL    /* APC Count */
 159 #define APCNVA 0x8UL    /* APC DMA Next Address */
 160 #define APCNC  0xcUL    /* APC Next Count */
 161 #define APC_PLAY 0x30UL /* Play registers start at 0x30 */
 162 #define APC_RECORD 0x20UL /* Record registers start at 0x20 */
 163
 164 /* APCCSR bits */
 165
 166 #define APC_INT_PENDING 0x800000 /* Interrupt Pending */
 167 #define APC_PLAY_INT    0x400000 /* Playback interrupt */
 168 #define APC_CAPT_INT    0x200000 /* Capture interrupt */
 169 #define APC_GENL_INT    0x100000 /* General interrupt */
 170 #define APC_XINT_ENA    0x80000  /* General ext int. enable */
 171 #define APC_XINT_PLAY   0x40000  /* Playback ext intr */
 172 #define APC_XINT_CAPT   0x20000  /* Capture ext intr */
 173 #define APC_XINT_GENL   0x10000  /* Error ext intr */
 174 #define APC_XINT_EMPT   0x8000   /* Pipe empty interrupt (0 write to pva) */
 175 #define APC_XINT_PEMP   0x4000   /* Play pipe empty (pva and pnva not set) */
 176 #define APC_XINT_PNVA   0x2000   /* Playback NVA dirty */
 177 #define APC_XINT_PENA   0x1000   /* play pipe empty Int enable */
 178 #define APC_XINT_COVF   0x800    /* Cap data dropped on floor */
 179 #define APC_XINT_CNVA   0x400    /* Capture NVA dirty */
 180 #define APC_XINT_CEMP   0x200    /* Capture pipe empty (cva and cnva not set) */
 181 #define APC_XINT_CENA   0x100    /* Cap. pipe empty int enable */
 182 #define APC_PPAUSE      0x80     /* Pause the play DMA */
 183 #define APC_CPAUSE      0x40     /* Pause the capture DMA */
 184 #define APC_CDC_RESET   0x20     /* CODEC RESET */
 185 #define APC_PDMA_READY  0x08     /* Play DMA Go */
 186 #define APC_CDMA_READY  0x04     /* Capture DMA Go */
 187 #define APC_CHIP_RESET  0x01     /* Reset the chip */
 188
 189 /* EBUS DMA register offsets  */
 190
 191 #define EBDMA_CSR       0x00UL  /* Control/Status */
 192 #define EBDMA_ADDR      0x04UL  /* DMA Address */
 193 #define EBDMA_COUNT     0x08UL  /* DMA Count */
 194
 195 /*
 196  *  Some variables
 197  */
 198
 199 static unsigned char freq_bits[14] = {
 200         /* 5510 */      0x00 | CS4231_XTAL2,
 201         /* 6620 */      0x0E | CS4231_XTAL2,
 202         /* 8000 */      0x00 | CS4231_XTAL1,
 203         /* 9600 */      0x0E | CS4231_XTAL1,
 204         /* 11025 */     0x02 | CS4231_XTAL2,
 205         /* 16000 */     0x02 | CS4231_XTAL1,
 206         /* 18900 */     0x04 | CS4231_XTAL2,
 207         /* 22050 */     0x06 | CS4231_XTAL2,
 208         /* 27042 */     0x04 | CS4231_XTAL1,
 209         /* 32000 */     0x06 | CS4231_XTAL1,
 210         /* 33075 */     0x0C | CS4231_XTAL2,
 211         /* 37800 */     0x08 | CS4231_XTAL2,
 212         /* 44100 */     0x0A | CS4231_XTAL2,
 213         /* 48000 */     0x0C | CS4231_XTAL1
 214 };
 215
 216 static unsigned int rates[14] = {
 217         5510, 6620, 8000, 9600, 11025, 16000, 18900, 22050,
 218         27042, 32000, 33075, 37800, 44100, 48000
 219 };
 220
 221 static struct snd_pcm_hw_constraint_list hw_constraints_rates = {
 222         .count  = ARRAY_SIZE(rates),
 223         .list   = rates,
 224 };
 225
 226 static int snd_cs4231_xrate(struct snd_pcm_runtime *runtime)
 227 {
 228         return snd_pcm_hw_constraint_list(runtime, 0,
 229                                           SNDRV_PCM_HW_PARAM_RATE,
 230                                           &hw_constraints_rates);
 231 }
 232
 233 static unsigned char snd_cs4231_original_image[32] =
 234 {
 235         0x00,                   /* 00/00 - lic */
 236         0x00,                   /* 01/01 - ric */
 237         0x9f,                   /* 02/02 - la1ic */
 238         0x9f,                   /* 03/03 - ra1ic */
 239         0x9f,                   /* 04/04 - la2ic */
 240         0x9f,                   /* 05/05 - ra2ic */
 241         0xbf,                   /* 06/06 - loc */
 242         0xbf,                   /* 07/07 - roc */
 243         0x20,                   /* 08/08 - pdfr */
 244         CS4231_AUTOCALIB,       /* 09/09 - ic */
 245         0x00,                   /* 0a/10 - pc */
 246         0x00,                   /* 0b/11 - ti */
 247         CS4231_MODE2,           /* 0c/12 - mi */
 248         0x00,                   /* 0d/13 - lbc */
 249         0x00,                   /* 0e/14 - pbru */
 250         0x00,                   /* 0f/15 - pbrl */
 251         0x80,                   /* 10/16 - afei */
 252         0x01,                   /* 11/17 - afeii */
 253         0x9f,                   /* 12/18 - llic */
 254         0x9f,                   /* 13/19 - rlic */
 255         0x00,                   /* 14/20 - tlb */
 256         0x00,                   /* 15/21 - thb */
 257         0x00,                   /* 16/22 - la3mic/reserved */
 258         0x00,                   /* 17/23 - ra3mic/reserved */
 259         0x00,                   /* 18/24 - afs */
 260         0x00,                   /* 19/25 - lamoc/version */
 261         0x00,                   /* 1a/26 - mioc */
 262         0x00,                   /* 1b/27 - ramoc/reserved */
 263         0x20,                   /* 1c/28 - cdfr */
 264         0x00,                   /* 1d/29 - res4 */
 265         0x00,                   /* 1e/30 - cbru */
 266         0x00,                   /* 1f/31 - cbrl */
 267 };
 268
 269 static u8 __cs4231_readb(struct snd_cs4231 *cp, void __iomem *reg_addr)
 270 {
 271 #ifdef EBUS_SUPPORT
 272         if (cp->flags & CS4231_FLAG_EBUS)
 273                 return readb(reg_addr);
 274         else
 275 #endif
 276 #ifdef SBUS_SUPPORT
 277                 return sbus_readb(reg_addr);
 278 #endif
 279 }
 280
 281 static void __cs4231_writeb(struct snd_cs4231 *cp, u8 val,
 282                             void __iomem *reg_addr)
 283 {
 284 #ifdef EBUS_SUPPORT
 285         if (cp->flags & CS4231_FLAG_EBUS)
 286                 return writeb(val, reg_addr);
 287         else
 288 #endif
 289 #ifdef SBUS_SUPPORT
 290                 return sbus_writeb(val, reg_addr);
 291 #endif
 292 }
 293
 294 /*
 295  *  Basic I/O functions
 296  */
 297
 298 static void snd_cs4231_ready(struct snd_cs4231 *chip)
 299 {
 300         int timeout;
 301
 302         for (timeout = 250; timeout > 0; timeout--) {
 303                 int val = __cs4231_readb(chip, CS4231U(chip, REGSEL));
 304                 if ((val & CS4231_INIT) == 0)
 305                         break;
 306                 udelay(100);
 307         }
 308 }
 309
 310 static void snd_cs4231_dout(struct snd_cs4231 *chip, unsigned char reg,
 311                             unsigned char value)
 312 {
 313         snd_cs4231_ready(chip);
 314 #ifdef CONFIG_SND_DEBUG
 315         if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
 316                 snd_printdd("out: auto calibration time out - reg = 0x%x, "
 317                             "value = 0x%x\n",
 318                             reg, value);
 319 #endif
 320         __cs4231_writeb(chip, chip->mce_bit | reg, CS4231U(chip, REGSEL));
 321         wmb();
 322         __cs4231_writeb(chip, value, CS4231U(chip, REG));
 323         mb();
 324 }
 325
 326 static inline void snd_cs4231_outm(struct snd_cs4231 *chip, unsigned char reg,
 327                      unsigned char mask, unsigned char value)
 328 {
 329         unsigned char tmp = (chip->image[reg] & mask) | value;
 330
 331         chip->image[reg] = tmp;
 332         if (!chip->calibrate_mute)
 333                 snd_cs4231_dout(chip, reg, tmp);
 334 }
 335
 336 static void snd_cs4231_out(struct snd_cs4231 *chip, unsigned char reg,
 337                            unsigned char value)
 338 {
 339         snd_cs4231_dout(chip, reg, value);
 340         chip->image[reg] = value;
 341         mb();
 342 }
 343
 344 static unsigned char snd_cs4231_in(struct snd_cs4231 *chip, unsigned char reg)
 345 {
 346         snd_cs4231_ready(chip);
 347 #ifdef CONFIG_SND_DEBUG
 348         if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
 349                 snd_printdd("in: auto calibration time out - reg = 0x%x\n",
 350                             reg);
 351 #endif
 352         __cs4231_writeb(chip, chip->mce_bit | reg, CS4231U(chip, REGSEL));
 353         mb();
 354         return __cs4231_readb(chip, CS4231U(chip, REG));
 355 }
 356
 357 /*
 358  *  CS4231 detection / MCE routines
 359  */
 360
 361 static void snd_cs4231_busy_wait(struct snd_cs4231 *chip)
 362 {
 363         int timeout;
 364
 365         /* looks like this sequence is proper for CS4231A chip (GUS MAX) */
 366         for (timeout = 5; timeout > 0; timeout--)
 367                 __cs4231_readb(chip, CS4231U(chip, REGSEL));
 368
 369         /* end of cleanup sequence */
 370         for (timeout = 500; timeout > 0; timeout--) {
 371                 int val = __cs4231_readb(chip, CS4231U(chip, REGSEL));
 372                 if ((val & CS4231_INIT) == 0)
 373                         break;
 374                 msleep(1);
 375         }
 376 }
 377
 378 static void snd_cs4231_mce_up(struct snd_cs4231 *chip)
 379 {
 380         unsigned long flags;
 381         int timeout;
 382
 383         spin_lock_irqsave(&chip->lock, flags);
 384         snd_cs4231_ready(chip);
 385 #ifdef CONFIG_SND_DEBUG
 386         if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
 387                 snd_printdd("mce_up - auto calibration time out (0)\n");
 388 #endif
 389         chip->mce_bit |= CS4231_MCE;
 390         timeout = __cs4231_readb(chip, CS4231U(chip, REGSEL));
 391         if (timeout == 0x80)
 392                 snd_printdd("mce_up [%p]: serious init problem - "
 393                             "codec still busy\n",
 394                             chip->port);
 395         if (!(timeout & CS4231_MCE))
 396                 __cs4231_writeb(chip, chip->mce_bit | (timeout & 0x1f),
 397                                 CS4231U(chip, REGSEL));
 398         spin_unlock_irqrestore(&chip->lock, flags);
 399 }
 400
 401 static void snd_cs4231_mce_down(struct snd_cs4231 *chip)
 402 {
 403         unsigned long flags;
 404         int timeout;
 405
 406         spin_lock_irqsave(&chip->lock, flags);
 407         snd_cs4231_busy_wait(chip);
 408 #ifdef CONFIG_SND_DEBUG
 409         if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
 410                 snd_printdd("mce_down [%p] - auto calibration time out (0)\n",
 411                             CS4231U(chip, REGSEL));
 412 #endif
 413         chip->mce_bit &= ~CS4231_MCE;
 414         timeout = __cs4231_readb(chip, CS4231U(chip, REGSEL));
 415         __cs4231_writeb(chip, chip->mce_bit | (timeout & 0x1f),
 416                         CS4231U(chip, REGSEL));
 417         if (timeout == 0x80)
 418                 snd_printdd("mce_down [%p]: serious init problem - "
 419                             "codec still busy\n",
 420                             chip->port);
 421         if ((timeout & CS4231_MCE) == 0) {
 422                 spin_unlock_irqrestore(&chip->lock, flags);
 423                 return;
 424         }
 425         snd_cs4231_busy_wait(chip);
 426
 427         /* calibration process */
 428
 429         snd_cs4231_ready(chip);
 430         snd_cs4231_ready(chip);
 431         timeout = snd_cs4231_in(chip, CS4231_TEST_INIT);
 432         if ((timeout & CS4231_CALIB_IN_PROGRESS) == 0) {
 433                 snd_printd("cs4231_mce_down - auto calibration time out (1)\n");
 434                 spin_unlock_irqrestore(&chip->lock, flags);
 435                 return;
 436         }
 437
 438         /* in 10ms increments, check condition, up to 250ms */
 439         timeout = 25;
 440         while (snd_cs4231_in(chip, CS4231_TEST_INIT) &
 441                 CS4231_CALIB_IN_PROGRESS) {
 442
 443                 spin_unlock_irqrestore(&chip->lock, flags);
 444                 if (--timeout < 0) {
 445                         snd_printk("mce_down - "
 446                                    "auto calibration time out (2)\n");
 447                         return;
 448                 }
 449                 msleep(10);
 450                 spin_lock_irqsave(&chip->lock, flags);
 451         }
 452
 453         /* in 10ms increments, check condition, up to 100ms */
 454         timeout = 10;
 455         while (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT) {
 456                 spin_unlock_irqrestore(&chip->lock, flags);
 457                 if (--timeout < 0) {
 458                         snd_printk("mce_down - "
 459                                    "auto calibration time out (3)\n");
 460                         return;
 461                 }
 462                 msleep(10);
 463                 spin_lock_irqsave(&chip->lock, flags);
 464         }
 465         spin_unlock_irqrestore(&chip->lock, flags);
 466 }
 467
 468 static void snd_cs4231_advance_dma(struct cs4231_dma_control *dma_cont,
 469                                    struct snd_pcm_substream *substream,
 470                                    unsigned int *periods_sent)
 471 {
 472         struct snd_pcm_runtime *runtime = substream->runtime;
 473
 474         while (1) {
 475                 unsigned int period_size = snd_pcm_lib_period_bytes(substream);
 476                 unsigned int offset = period_size * (*periods_sent);
 477
 478                 BUG_ON(period_size >= (1 << 24));
 479
 480                 if (dma_cont->request(dma_cont,
 481                                       runtime->dma_addr + offset, period_size))
 482                         return;
 483                 (*periods_sent) = ((*periods_sent) + 1) % runtime->periods;
 484         }
 485 }
 486
 487 static void cs4231_dma_trigger(struct snd_pcm_substream *substream,
 488                                unsigned int what, int on)
 489 {
 490         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
 491         struct cs4231_dma_control *dma_cont;
 492
 493         if (what & CS4231_PLAYBACK_ENABLE) {
 494                 dma_cont = &chip->p_dma;
 495                 if (on) {
 496                         dma_cont->prepare(dma_cont, 0);
 497                         dma_cont->enable(dma_cont, 1);
 498                         snd_cs4231_advance_dma(dma_cont,
 499                                 chip->playback_substream,
 500                                 &chip->p_periods_sent);
 501                 } else {
 502                         dma_cont->enable(dma_cont, 0);
 503                 }
 504         }
 505         if (what & CS4231_RECORD_ENABLE) {
 506                 dma_cont = &chip->c_dma;
 507                 if (on) {
 508                         dma_cont->prepare(dma_cont, 1);
 509                         dma_cont->enable(dma_cont, 1);
 510                         snd_cs4231_advance_dma(dma_cont,
 511                                 chip->capture_substream,
 512                                 &chip->c_periods_sent);
 513                 } else {
 514                         dma_cont->enable(dma_cont, 0);
 515                 }
 516         }
 517 }
 518
 519 static int snd_cs4231_trigger(struct snd_pcm_substream *substream, int cmd)
 520 {
 521         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
 522         int result = 0;
 523
 524         switch (cmd) {
 525         case SNDRV_PCM_TRIGGER_START:
 526         case SNDRV_PCM_TRIGGER_STOP:
 527         {
 528                 unsigned int what = 0;
 529                 struct snd_pcm_substream *s;
 530                 unsigned long flags;
 531
 532                 snd_pcm_group_for_each_entry(s, substream) {
 533                         if (s == chip->playback_substream) {
 534                                 what |= CS4231_PLAYBACK_ENABLE;
 535                                 snd_pcm_trigger_done(s, substream);
 536                         } else if (s == chip->capture_substream) {
 537                                 what |= CS4231_RECORD_ENABLE;
 538                                 snd_pcm_trigger_done(s, substream);
 539                         }
 540                 }
 541
 542                 spin_lock_irqsave(&chip->lock, flags);
 543                 if (cmd == SNDRV_PCM_TRIGGER_START) {
 544                         cs4231_dma_trigger(substream, what, 1);
 545                         chip->image[CS4231_IFACE_CTRL] |= what;
 546                 } else {
 547                         cs4231_dma_trigger(substream, what, 0);
 548                         chip->image[CS4231_IFACE_CTRL] &= ~what;
 549                 }
 550                 snd_cs4231_out(chip, CS4231_IFACE_CTRL,
 551                                chip->image[CS4231_IFACE_CTRL]);
 552                 spin_unlock_irqrestore(&chip->lock, flags);
 553                 break;
 554         }
 555         default:
 556                 result = -EINVAL;
 557                 break;
 558         }
 559
 560         return result;
 561 }
 562
 563 /*
 564  *  CODEC I/O
 565  */
 566
 567 static unsigned char snd_cs4231_get_rate(unsigned int rate)
 568 {
 569         int i;
 570
 571         for (i = 0; i < 14; i++)
 572                 if (rate == rates[i])
 573                         return freq_bits[i];
 574
 575         return freq_bits[13];
 576 }
 577
 578 static unsigned char snd_cs4231_get_format(struct snd_cs4231 *chip, int format,
 579                                            int channels)
 580 {
 581         unsigned char rformat;
 582
 583         rformat = CS4231_LINEAR_8;
 584         switch (format) {
 585         case SNDRV_PCM_FORMAT_MU_LAW:
 586                 rformat = CS4231_ULAW_8;
 587                 break;
 588         case SNDRV_PCM_FORMAT_A_LAW:
 589                 rformat = CS4231_ALAW_8;
 590                 break;
 591         case SNDRV_PCM_FORMAT_S16_LE:
 592                 rformat = CS4231_LINEAR_16;
 593                 break;
 594         case SNDRV_PCM_FORMAT_S16_BE:
 595                 rformat = CS4231_LINEAR_16_BIG;
 596                 break;
 597         case SNDRV_PCM_FORMAT_IMA_ADPCM:
 598                 rformat = CS4231_ADPCM_16;
 599                 break;
 600         }
 601         if (channels > 1)
 602                 rformat |= CS4231_STEREO;
 603         return rformat;
 604 }
 605
 606 static void snd_cs4231_calibrate_mute(struct snd_cs4231 *chip, int mute)
 607 {
 608         unsigned long flags;
 609
 610         mute = mute ? 1 : 0;
 611         spin_lock_irqsave(&chip->lock, flags);
 612         if (chip->calibrate_mute == mute) {
 613                 spin_unlock_irqrestore(&chip->lock, flags);
 614                 return;
 615         }
 616         if (!mute) {
 617                 snd_cs4231_dout(chip, CS4231_LEFT_INPUT,
 618                                 chip->image[CS4231_LEFT_INPUT]);
 619                 snd_cs4231_dout(chip, CS4231_RIGHT_INPUT,
 620                                 chip->image[CS4231_RIGHT_INPUT]);
 621                 snd_cs4231_dout(chip, CS4231_LOOPBACK,
 622                                 chip->image[CS4231_LOOPBACK]);
 623         }
 624         snd_cs4231_dout(chip, CS4231_AUX1_LEFT_INPUT,
 625                         mute ? 0x80 : chip->image[CS4231_AUX1_LEFT_INPUT]);
 626         snd_cs4231_dout(chip, CS4231_AUX1_RIGHT_INPUT,
 627                         mute ? 0x80 : chip->image[CS4231_AUX1_RIGHT_INPUT]);
 628         snd_cs4231_dout(chip, CS4231_AUX2_LEFT_INPUT,
 629                         mute ? 0x80 : chip->image[CS4231_AUX2_LEFT_INPUT]);
 630         snd_cs4231_dout(chip, CS4231_AUX2_RIGHT_INPUT,
 631                         mute ? 0x80 : chip->image[CS4231_AUX2_RIGHT_INPUT]);
 632         snd_cs4231_dout(chip, CS4231_LEFT_OUTPUT,
 633                         mute ? 0x80 : chip->image[CS4231_LEFT_OUTPUT]);
 634         snd_cs4231_dout(chip, CS4231_RIGHT_OUTPUT,
 635                         mute ? 0x80 : chip->image[CS4231_RIGHT_OUTPUT]);
 636         snd_cs4231_dout(chip, CS4231_LEFT_LINE_IN,
 637                         mute ? 0x80 : chip->image[CS4231_LEFT_LINE_IN]);
 638         snd_cs4231_dout(chip, CS4231_RIGHT_LINE_IN,
 639                         mute ? 0x80 : chip->image[CS4231_RIGHT_LINE_IN]);
 640         snd_cs4231_dout(chip, CS4231_MONO_CTRL,
 641                         mute ? 0xc0 : chip->image[CS4231_MONO_CTRL]);
 642         chip->calibrate_mute = mute;
 643         spin_unlock_irqrestore(&chip->lock, flags);
 644 }
 645
 646 static void snd_cs4231_playback_format(struct snd_cs4231 *chip,
 647                                        struct snd_pcm_hw_params *params,
 648                                        unsigned char pdfr)
 649 {
 650         unsigned long flags;
 651
 652         mutex_lock(&chip->mce_mutex);
 653         snd_cs4231_calibrate_mute(chip, 1);
 654
 655         snd_cs4231_mce_up(chip);
 656
 657         spin_lock_irqsave(&chip->lock, flags);
 658         snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
 659                        (chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE) ?
 660                        (pdfr & 0xf0) | (chip->image[CS4231_REC_FORMAT] & 0x0f) :
 661                        pdfr);
 662         spin_unlock_irqrestore(&chip->lock, flags);
 663
 664         snd_cs4231_mce_down(chip);
 665
 666         snd_cs4231_calibrate_mute(chip, 0);
 667         mutex_unlock(&chip->mce_mutex);
 668 }
 669
 670 static void snd_cs4231_capture_format(struct snd_cs4231 *chip,
 671                                       struct snd_pcm_hw_params *params,
 672                                       unsigned char cdfr)
 673 {
 674         unsigned long flags;
 675
 676         mutex_lock(&chip->mce_mutex);
 677         snd_cs4231_calibrate_mute(chip, 1);
 678
 679         snd_cs4231_mce_up(chip);
 680
 681         spin_lock_irqsave(&chip->lock, flags);
 682         if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE)) {
 683                 snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
 684                                ((chip->image[CS4231_PLAYBK_FORMAT]) & 0xf0) |
 685                                (cdfr & 0x0f));
 686                 spin_unlock_irqrestore(&chip->lock, flags);
 687                 snd_cs4231_mce_down(chip);
 688                 snd_cs4231_mce_up(chip);
 689                 spin_lock_irqsave(&chip->lock, flags);
 690         }
 691         snd_cs4231_out(chip, CS4231_REC_FORMAT, cdfr);
 692         spin_unlock_irqrestore(&chip->lock, flags);
 693
 694         snd_cs4231_mce_down(chip);
 695
 696         snd_cs4231_calibrate_mute(chip, 0);
 697         mutex_unlock(&chip->mce_mutex);
 698 }
 699
 700 /*
 701  *  Timer interface
 702  */
 703
 704 static unsigned long snd_cs4231_timer_resolution(struct snd_timer *timer)
 705 {
 706         struct snd_cs4231 *chip = snd_timer_chip(timer);
 707
 708         return chip->image[CS4231_PLAYBK_FORMAT] & 1 ? 9969 : 9920;
 709 }
 710
 711 static int snd_cs4231_timer_start(struct snd_timer *timer)
 712 {
 713         unsigned long flags;
 714         unsigned int ticks;
 715         struct snd_cs4231 *chip = snd_timer_chip(timer);
 716
 717         spin_lock_irqsave(&chip->lock, flags);
 718         ticks = timer->sticks;
 719         if ((chip->image[CS4231_ALT_FEATURE_1] & CS4231_TIMER_ENABLE) == 0 ||
 720             (unsigned char)(ticks >> 8) != chip->image[CS4231_TIMER_HIGH] ||
 721             (unsigned char)ticks != chip->image[CS4231_TIMER_LOW]) {
 722                 snd_cs4231_out(chip, CS4231_TIMER_HIGH,
 723                                chip->image[CS4231_TIMER_HIGH] =
 724                                (unsigned char) (ticks >> 8));
 725                 snd_cs4231_out(chip, CS4231_TIMER_LOW,
 726                                chip->image[CS4231_TIMER_LOW] =
 727                                (unsigned char) ticks);
 728                 snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
 729                                chip->image[CS4231_ALT_FEATURE_1] |
 730                                         CS4231_TIMER_ENABLE);
 731         }
 732         spin_unlock_irqrestore(&chip->lock, flags);
 733
 734         return 0;
 735 }
 736
 737 static int snd_cs4231_timer_stop(struct snd_timer *timer)
 738 {
 739         unsigned long flags;
 740         struct snd_cs4231 *chip = snd_timer_chip(timer);
 741
 742         spin_lock_irqsave(&chip->lock, flags);
 743         chip->image[CS4231_ALT_FEATURE_1] &= ~CS4231_TIMER_ENABLE;
 744         snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
 745                        chip->image[CS4231_ALT_FEATURE_1]);
 746         spin_unlock_irqrestore(&chip->lock, flags);
 747
 748         return 0;
 749 }
 750
 751 static void __init snd_cs4231_init(struct snd_cs4231 *chip)
 752 {
 753         unsigned long flags;
 754
 755         snd_cs4231_mce_down(chip);
 756
 757 #ifdef SNDRV_DEBUG_MCE
 758         snd_printdd("init: (1)\n");
 759 #endif
 760         snd_cs4231_mce_up(chip);
 761         spin_lock_irqsave(&chip->lock, flags);
 762         chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_PLAYBACK_ENABLE |
 763                                             CS4231_PLAYBACK_PIO |
 764                                             CS4231_RECORD_ENABLE |
 765                                             CS4231_RECORD_PIO |
 766                                             CS4231_CALIB_MODE);
 767         chip->image[CS4231_IFACE_CTRL] |= CS4231_AUTOCALIB;
 768         snd_cs4231_out(chip, CS4231_IFACE_CTRL, chip->image[CS4231_IFACE_CTRL]);
 769         spin_unlock_irqrestore(&chip->lock, flags);
 770         snd_cs4231_mce_down(chip);
 771
 772 #ifdef SNDRV_DEBUG_MCE
 773         snd_printdd("init: (2)\n");
 774 #endif
 775
 776         snd_cs4231_mce_up(chip);
 777         spin_lock_irqsave(&chip->lock, flags);
 778         snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
 779                         chip->image[CS4231_ALT_FEATURE_1]);
 780         spin_unlock_irqrestore(&chip->lock, flags);
 781         snd_cs4231_mce_down(chip);
 782
 783 #ifdef SNDRV_DEBUG_MCE
 784         snd_printdd("init: (3) - afei = 0x%x\n",
 785                     chip->image[CS4231_ALT_FEATURE_1]);
 786 #endif
 787
 788         spin_lock_irqsave(&chip->lock, flags);
 789         snd_cs4231_out(chip, CS4231_ALT_FEATURE_2,
 790                         chip->image[CS4231_ALT_FEATURE_2]);
 791         spin_unlock_irqrestore(&chip->lock, flags);
 792
 793         snd_cs4231_mce_up(chip);
 794         spin_lock_irqsave(&chip->lock, flags);
 795         snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
 796                         chip->image[CS4231_PLAYBK_FORMAT]);
 797         spin_unlock_irqrestore(&chip->lock, flags);
 798         snd_cs4231_mce_down(chip);
 799
 800 #ifdef SNDRV_DEBUG_MCE
 801         snd_printdd("init: (4)\n");
 802 #endif
 803
 804         snd_cs4231_mce_up(chip);
 805         spin_lock_irqsave(&chip->lock, flags);
 806         snd_cs4231_out(chip, CS4231_REC_FORMAT, chip->image[CS4231_REC_FORMAT]);
 807         spin_unlock_irqrestore(&chip->lock, flags);
 808         snd_cs4231_mce_down(chip);
 809
 810 #ifdef SNDRV_DEBUG_MCE
 811         snd_printdd("init: (5)\n");
 812 #endif
 813 }
 814
 815 static int snd_cs4231_open(struct snd_cs4231 *chip, unsigned int mode)
 816 {
 817         unsigned long flags;
 818
 819         mutex_lock(&chip->open_mutex);
 820         if ((chip->mode & mode)) {
 821                 mutex_unlock(&chip->open_mutex);
 822                 return -EAGAIN;
 823         }
 824         if (chip->mode & CS4231_MODE_OPEN) {
 825                 chip->mode |= mode;
 826                 mutex_unlock(&chip->open_mutex);
 827                 return 0;
 828         }
 829         /* ok. now enable and ack CODEC IRQ */
 830         spin_lock_irqsave(&chip->lock, flags);
 831         snd_cs4231_out(chip, CS4231_IRQ_STATUS, CS4231_PLAYBACK_IRQ |
 832                        CS4231_RECORD_IRQ |
 833                        CS4231_TIMER_IRQ);
 834         snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
 835         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));        /* clear IRQ */
 836         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));        /* clear IRQ */
 837
 838         snd_cs4231_out(chip, CS4231_IRQ_STATUS, CS4231_PLAYBACK_IRQ |
 839                        CS4231_RECORD_IRQ |
 840                        CS4231_TIMER_IRQ);
 841         snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
 842
 843         spin_unlock_irqrestore(&chip->lock, flags);
 844
 845         chip->mode = mode;
 846         mutex_unlock(&chip->open_mutex);
 847         return 0;
 848 }
 849
 850 static void snd_cs4231_close(struct snd_cs4231 *chip, unsigned int mode)
 851 {
 852         unsigned long flags;
 853
 854         mutex_lock(&chip->open_mutex);
 855         chip->mode &= ~mode;
 856         if (chip->mode & CS4231_MODE_OPEN) {
 857                 mutex_unlock(&chip->open_mutex);
 858                 return;
 859         }
 860         snd_cs4231_calibrate_mute(chip, 1);
 861
 862         /* disable IRQ */
 863         spin_lock_irqsave(&chip->lock, flags);
 864         snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
 865         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));        /* clear IRQ */
 866         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));        /* clear IRQ */
 867
 868         /* now disable record & playback */
 869
 870         if (chip->image[CS4231_IFACE_CTRL] &
 871             (CS4231_PLAYBACK_ENABLE | CS4231_PLAYBACK_PIO |
 872              CS4231_RECORD_ENABLE | CS4231_RECORD_PIO)) {
 873                 spin_unlock_irqrestore(&chip->lock, flags);
 874                 snd_cs4231_mce_up(chip);
 875                 spin_lock_irqsave(&chip->lock, flags);
 876                 chip->image[CS4231_IFACE_CTRL] &=
 877                         ~(CS4231_PLAYBACK_ENABLE | CS4231_PLAYBACK_PIO |
 878                           CS4231_RECORD_ENABLE | CS4231_RECORD_PIO);
 879                 snd_cs4231_out(chip, CS4231_IFACE_CTRL,
 880                                 chip->image[CS4231_IFACE_CTRL]);
 881                 spin_unlock_irqrestore(&chip->lock, flags);
 882                 snd_cs4231_mce_down(chip);
 883                 spin_lock_irqsave(&chip->lock, flags);
 884         }
 885
 886         /* clear IRQ again */
 887         snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
 888         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));        /* clear IRQ */
 889         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));        /* clear IRQ */
 890         spin_unlock_irqrestore(&chip->lock, flags);
 891
 892         snd_cs4231_calibrate_mute(chip, 0);
 893
 894         chip->mode = 0;
 895         mutex_unlock(&chip->open_mutex);
 896 }
 897
 898 /*
 899  *  timer open/close
 900  */
 901
 902 static int snd_cs4231_timer_open(struct snd_timer *timer)
 903 {
 904         struct snd_cs4231 *chip = snd_timer_chip(timer);
 905         snd_cs4231_open(chip, CS4231_MODE_TIMER);
 906         return 0;
 907 }
 908
 909 static int snd_cs4231_timer_close(struct snd_timer *timer)
 910 {
 911         struct snd_cs4231 *chip = snd_timer_chip(timer);
 912         snd_cs4231_close(chip, CS4231_MODE_TIMER);
 913         return 0;
 914 }
 915
 916 static struct snd_timer_hardware snd_cs4231_timer_table = {
 917         .flags          =       SNDRV_TIMER_HW_AUTO,
 918         .resolution     =       9945,
 919         .ticks          =       65535,
 920         .open           =       snd_cs4231_timer_open,
 921         .close          =       snd_cs4231_timer_close,
 922         .c_resolution   =       snd_cs4231_timer_resolution,
 923         .start          =       snd_cs4231_timer_start,
 924         .stop           =       snd_cs4231_timer_stop,
 925 };
 926
 927 /*
 928  *  ok.. exported functions..
 929  */
 930
 931 static int snd_cs4231_playback_hw_params(struct snd_pcm_substream *substream,
 932                                          struct snd_pcm_hw_params *hw_params)
 933 {
 934         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
 935         unsigned char new_pdfr;
 936         int err;
 937
 938         err = snd_pcm_lib_malloc_pages(substream,
 939                                         params_buffer_bytes(hw_params));
 940         if (err < 0)
 941                 return err;
 942         new_pdfr = snd_cs4231_get_format(chip, params_format(hw_params),
 943                                          params_channels(hw_params)) |
 944                 snd_cs4231_get_rate(params_rate(hw_params));
 945         snd_cs4231_playback_format(chip, hw_params, new_pdfr);
 946
 947         return 0;
 948 }
 949
 950 static int snd_cs4231_playback_prepare(struct snd_pcm_substream *substream)
 951 {
 952         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
 953         struct snd_pcm_runtime *runtime = substream->runtime;
 954         unsigned long flags;
 955
 956         spin_lock_irqsave(&chip->lock, flags);
 957
 958         chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_PLAYBACK_ENABLE |
 959                                             CS4231_PLAYBACK_PIO);
 960
 961         BUG_ON(runtime->period_size > 0xffff + 1);
 962
 963         chip->p_periods_sent = 0;
 964         spin_unlock_irqrestore(&chip->lock, flags);
 965
 966         return 0;
 967 }
 968
 969 static int snd_cs4231_capture_hw_params(struct snd_pcm_substream *substream,
 970                                         struct snd_pcm_hw_params *hw_params)
 971 {
 972         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
 973         unsigned char new_cdfr;
 974         int err;
 975
 976         err = snd_pcm_lib_malloc_pages(substream,
 977                                         params_buffer_bytes(hw_params));
 978         if (err < 0)
 979                 return err;
 980         new_cdfr = snd_cs4231_get_format(chip, params_format(hw_params),
 981                                          params_channels(hw_params)) |
 982                 snd_cs4231_get_rate(params_rate(hw_params));
 983         snd_cs4231_capture_format(chip, hw_params, new_cdfr);
 984
 985         return 0;
 986 }
 987
 988 static int snd_cs4231_capture_prepare(struct snd_pcm_substream *substream)
 989 {
 990         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
 991         unsigned long flags;
 992
 993         spin_lock_irqsave(&chip->lock, flags);
 994         chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_RECORD_ENABLE |
 995                                             CS4231_RECORD_PIO);
 996
 997
 998         chip->c_periods_sent = 0;
 999         spin_unlock_irqrestore(&chip->lock, flags);
1000
1001         return 0;
1002 }
1003
1004 static void snd_cs4231_overrange(struct snd_cs4231 *chip)
1005 {
1006         unsigned long flags;
1007         unsigned char res;
1008
1009         spin_lock_irqsave(&chip->lock, flags);
1010         res = snd_cs4231_in(chip, CS4231_TEST_INIT);
1011         spin_unlock_irqrestore(&chip->lock, flags);
1012
1013         /* detect overrange only above 0dB; may be user selectable? */
1014         if (res & (0x08 | 0x02))
1015                 chip->capture_substream->runtime->overrange++;
1016 }
1017
1018 static void snd_cs4231_play_callback(struct snd_cs4231 *chip)
1019 {
1020         if (chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE) {
1021                 snd_pcm_period_elapsed(chip->playback_substream);
1022                 snd_cs4231_advance_dma(&chip->p_dma, chip->playback_substream,
1023                                             &chip->p_periods_sent);
1024         }
1025 }
1026
1027 static void snd_cs4231_capture_callback(struct snd_cs4231 *chip)
1028 {
1029         if (chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE) {
1030                 snd_pcm_period_elapsed(chip->capture_substream);
1031                 snd_cs4231_advance_dma(&chip->c_dma, chip->capture_substream,
1032                                             &chip->c_periods_sent);
1033         }
1034 }
1035
1036 static snd_pcm_uframes_t snd_cs4231_playback_pointer(
1037                                         struct snd_pcm_substream *substream)
1038 {
1039         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1040         struct cs4231_dma_control *dma_cont = &chip->p_dma;
1041         size_t ptr;
1042
1043         if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE))
1044                 return 0;
1045         ptr = dma_cont->address(dma_cont);
1046         if (ptr != 0)
1047                 ptr -= substream->runtime->dma_addr;
1048
1049         return bytes_to_frames(substream->runtime, ptr);
1050 }
1051
1052 static snd_pcm_uframes_t snd_cs4231_capture_pointer(
1053                                         struct snd_pcm_substream *substream)
1054 {
1055         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1056         struct cs4231_dma_control *dma_cont = &chip->c_dma;
1057         size_t ptr;
1058
1059         if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE))
1060                 return 0;
1061         ptr = dma_cont->address(dma_cont);
1062         if (ptr != 0)
1063                 ptr -= substream->runtime->dma_addr;
1064
1065         return bytes_to_frames(substream->runtime, ptr);
1066 }
1067
1068 static int __init snd_cs4231_probe(struct snd_cs4231 *chip)
1069 {
1070         unsigned long flags;
1071         int i;
1072         int id = 0;
1073         int vers = 0;
1074         unsigned char *ptr;
1075
1076         for (i = 0; i < 50; i++) {
1077                 mb();
1078                 if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
1079                         msleep(2);
1080                 else {
1081                         spin_lock_irqsave(&chip->lock, flags);
1082                         snd_cs4231_out(chip, CS4231_MISC_INFO, CS4231_MODE2);
1083                         id = snd_cs4231_in(chip, CS4231_MISC_INFO) & 0x0f;
1084                         vers = snd_cs4231_in(chip, CS4231_VERSION);
1085                         spin_unlock_irqrestore(&chip->lock, flags);
1086                         if (id == 0x0a)
1087                                 break;  /* this is valid value */
1088                 }
1089         }
1090         snd_printdd("cs4231: port = %p, id = 0x%x\n", chip->port, id);
1091         if (id != 0x0a)
1092                 return -ENODEV; /* no valid device found */
1093
1094         spin_lock_irqsave(&chip->lock, flags);
1095
1096         /* clear any pendings IRQ */
1097         __cs4231_readb(chip, CS4231U(chip, STATUS));
1098         __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));
1099         mb();
1100
1101         spin_unlock_irqrestore(&chip->lock, flags);
1102
1103         chip->image[CS4231_MISC_INFO] = CS4231_MODE2;
1104         chip->image[CS4231_IFACE_CTRL] =
1105                 chip->image[CS4231_IFACE_CTRL] & ~CS4231_SINGLE_DMA;
1106         chip->image[CS4231_ALT_FEATURE_1] = 0x80;
1107         chip->image[CS4231_ALT_FEATURE_2] = 0x01;
1108         if (vers & 0x20)
1109                 chip->image[CS4231_ALT_FEATURE_2] |= 0x02;
1110
1111         ptr = (unsigned char *) &chip->image;
1112
1113         snd_cs4231_mce_down(chip);
1114
1115         spin_lock_irqsave(&chip->lock, flags);
1116
1117         for (i = 0; i < 32; i++)        /* ok.. fill all CS4231 registers */
1118                 snd_cs4231_out(chip, i, *ptr++);
1119
1120         spin_unlock_irqrestore(&chip->lock, flags);
1121
1122         snd_cs4231_mce_up(chip);
1123
1124         snd_cs4231_mce_down(chip);
1125
1126         mdelay(2);
1127
1128         return 0;               /* all things are ok.. */
1129 }
1130
1131 static struct snd_pcm_hardware snd_cs4231_playback = {
1132         .info                   = SNDRV_PCM_INFO_MMAP |
1133                                   SNDRV_PCM_INFO_INTERLEAVED |
1134                                   SNDRV_PCM_INFO_MMAP_VALID |
1135                                   SNDRV_PCM_INFO_SYNC_START,
1136         .formats                = SNDRV_PCM_FMTBIT_MU_LAW |
1137                                   SNDRV_PCM_FMTBIT_A_LAW |
1138                                   SNDRV_PCM_FMTBIT_IMA_ADPCM |
1139                                   SNDRV_PCM_FMTBIT_U8 |
1140                                   SNDRV_PCM_FMTBIT_S16_LE |
1141                                   SNDRV_PCM_FMTBIT_S16_BE,
1142         .rates                  = SNDRV_PCM_RATE_KNOT |
1143                                   SNDRV_PCM_RATE_8000_48000,
1144         .rate_min               = 5510,
1145         .rate_max               = 48000,
1146         .channels_min           = 1,
1147         .channels_max           = 2,
1148         .buffer_bytes_max       = 32 * 1024,
1149         .period_bytes_min       = 64,
1150         .period_bytes_max       = 32 * 1024,
1151         .periods_min            = 1,
1152         .periods_max            = 1024,
1153 };
1154
1155 static struct snd_pcm_hardware snd_cs4231_capture = {
1156         .info                   = SNDRV_PCM_INFO_MMAP |
1157                                   SNDRV_PCM_INFO_INTERLEAVED |
1158                                   SNDRV_PCM_INFO_MMAP_VALID |
1159                                   SNDRV_PCM_INFO_SYNC_START,
1160         .formats                = SNDRV_PCM_FMTBIT_MU_LAW |
1161                                   SNDRV_PCM_FMTBIT_A_LAW |
1162                                   SNDRV_PCM_FMTBIT_IMA_ADPCM |
1163                                   SNDRV_PCM_FMTBIT_U8 |
1164                                   SNDRV_PCM_FMTBIT_S16_LE |
1165                                   SNDRV_PCM_FMTBIT_S16_BE,
1166         .rates                  = SNDRV_PCM_RATE_KNOT |
1167                                   SNDRV_PCM_RATE_8000_48000,
1168         .rate_min               = 5510,
1169         .rate_max               = 48000,
1170         .channels_min           = 1,
1171         .channels_max           = 2,
1172         .buffer_bytes_max       = 32 * 1024,
1173         .period_bytes_min       = 64,
1174         .period_bytes_max       = 32 * 1024,
1175         .periods_min            = 1,
1176         .periods_max            = 1024,
1177 };
1178
1179 static int snd_cs4231_playback_open(struct snd_pcm_substream *substream)
1180 {
1181         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1182         struct snd_pcm_runtime *runtime = substream->runtime;
1183         int err;
1184
1185         runtime->hw = snd_cs4231_playback;
1186
1187         err = snd_cs4231_open(chip, CS4231_MODE_PLAY);
1188         if (err < 0) {
1189                 snd_free_pages(runtime->dma_area, runtime->dma_bytes);
1190                 return err;
1191         }
1192         chip->playback_substream = substream;
1193         chip->p_periods_sent = 0;
1194         snd_pcm_set_sync(substream);
1195         snd_cs4231_xrate(runtime);
1196
1197         return 0;
1198 }
1199
1200 static int snd_cs4231_capture_open(struct snd_pcm_substream *substream)
1201 {
1202         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1203         struct snd_pcm_runtime *runtime = substream->runtime;
1204         int err;
1205
1206         runtime->hw = snd_cs4231_capture;
1207
1208         err = snd_cs4231_open(chip, CS4231_MODE_RECORD);
1209         if (err < 0) {
1210                 snd_free_pages(runtime->dma_area, runtime->dma_bytes);
1211                 return err;
1212         }
1213         chip->capture_substream = substream;
1214         chip->c_periods_sent = 0;
1215         snd_pcm_set_sync(substream);
1216         snd_cs4231_xrate(runtime);
1217
1218         return 0;
1219 }
1220
1221 static int snd_cs4231_playback_close(struct snd_pcm_substream *substream)
1222 {
1223         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1224
1225         snd_cs4231_close(chip, CS4231_MODE_PLAY);
1226         chip->playback_substream = NULL;
1227
1228         return 0;
1229 }
1230
1231 static int snd_cs4231_capture_close(struct snd_pcm_substream *substream)
1232 {
1233         struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1234
1235         snd_cs4231_close(chip, CS4231_MODE_RECORD);
1236         chip->capture_substream = NULL;
1237
1238         return 0;
1239 }
1240
1241 /* XXX We can do some power-management, in particular on EBUS using
1242  * XXX the audio AUXIO register...
1243  */
1244
1245 static struct snd_pcm_ops snd_cs4231_playback_ops = {
1246         .open           =       snd_cs4231_playback_open,
1247         .close          =       snd_cs4231_playback_close,
1248         .ioctl          =       snd_pcm_lib_ioctl,
1249         .hw_params      =       snd_cs4231_playback_hw_params,
1250         .hw_free        =       snd_pcm_lib_free_pages,
1251         .prepare        =       snd_cs4231_playback_prepare,
1252         .trigger        =       snd_cs4231_trigger,
1253         .pointer        =       snd_cs4231_playback_pointer,
1254 };
1255
1256 static struct snd_pcm_ops snd_cs4231_capture_ops = {
1257         .open           =       snd_cs4231_capture_open,
1258         .close          =       snd_cs4231_capture_close,
1259         .ioctl          =       snd_pcm_lib_ioctl,
1260         .hw_params      =       snd_cs4231_capture_hw_params,
1261         .hw_free        =       snd_pcm_lib_free_pages,
1262         .prepare        =       snd_cs4231_capture_prepare,
1263         .trigger        =       snd_cs4231_trigger,
1264         .pointer        =       snd_cs4231_capture_pointer,
1265 };
1266
1267 static int __init snd_cs4231_pcm(struct snd_card *card)
1268 {
1269         struct snd_cs4231 *chip = card->private_data;
1270         struct snd_pcm *pcm;
1271         int err;
1272
1273         err = snd_pcm_new(card, "CS4231", 0, 1, 1, &pcm);
1274         if (err < 0)
1275                 return err;
1276
1277         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
1278                         &snd_cs4231_playback_ops);
1279         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
1280                         &snd_cs4231_capture_ops);
1281
1282         /* global setup */
1283         pcm->private_data = chip;
1284         pcm->info_flags = SNDRV_PCM_INFO_JOINT_DUPLEX;
1285         strcpy(pcm->name, "CS4231");
1286
1287         chip->p_dma.preallocate(chip, pcm);
1288
1289         chip->pcm = pcm;
1290
1291         return 0;
1292 }
1293
1294 static int __init snd_cs4231_timer(struct snd_card *card)
1295 {
1296         struct snd_cs4231 *chip = card->private_data;
1297         struct snd_timer *timer;
1298         struct snd_timer_id tid;
1299         int err;
1300
1301         /* Timer initialization */
1302         tid.dev_class = SNDRV_TIMER_CLASS_CARD;
1303         tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
1304         tid.card = card->number;
1305         tid.device = 0;
1306         tid.subdevice = 0;
1307         err = snd_timer_new(card, "CS4231", &tid, &timer);
1308         if (err < 0)
1309                 return err;
1310         strcpy(timer->name, "CS4231");
1311         timer->private_data = chip;
1312         timer->hw = snd_cs4231_timer_table;
1313         chip->timer = timer;
1314
1315         return 0;
1316 }
1317
1318 /*
1319  *  MIXER part
1320  */
1321
1322 static int snd_cs4231_info_mux(struct snd_kcontrol *kcontrol,
1323                                struct snd_ctl_elem_info *uinfo)
1324 {
1325         static char *texts[4] = {
1326                 "Line", "CD", "Mic", "Mix"
1327         };
1328
1329         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1330         uinfo->count = 2;
1331         uinfo->value.enumerated.items = 4;
1332         if (uinfo->value.enumerated.item > 3)
1333                 uinfo->value.enumerated.item = 3;
1334         strcpy(uinfo->value.enumerated.name,
1335                 texts[uinfo->value.enumerated.item]);
1336
1337         return 0;
1338 }
1339
1340 static int snd_cs4231_get_mux(struct snd_kcontrol *kcontrol,
1341                               struct snd_ctl_elem_value *ucontrol)
1342 {
1343         struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1344         unsigned long flags;
1345
1346         spin_lock_irqsave(&chip->lock, flags);
1347         ucontrol->value.enumerated.item[0] =
1348                 (chip->image[CS4231_LEFT_INPUT] & CS4231_MIXS_ALL) >> 6;
1349         ucontrol->value.enumerated.item[1] =
1350                 (chip->image[CS4231_RIGHT_INPUT] & CS4231_MIXS_ALL) >> 6;
1351         spin_unlock_irqrestore(&chip->lock, flags);
1352
1353         return 0;
1354 }
1355
1356 static int snd_cs4231_put_mux(struct snd_kcontrol *kcontrol,
1357                               struct snd_ctl_elem_value *ucontrol)
1358 {
1359         struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1360         unsigned long flags;
1361         unsigned short left, right;
1362         int change;
1363
1364         if (ucontrol->value.enumerated.item[0] > 3 ||
1365             ucontrol->value.enumerated.item[1] > 3)
1366                 return -EINVAL;
1367         left = ucontrol->value.enumerated.item[0] << 6;
1368         right = ucontrol->value.enumerated.item[1] << 6;
1369
1370         spin_lock_irqsave(&chip->lock, flags);
1371
1372         left = (chip->image[CS4231_LEFT_INPUT] & ~CS4231_MIXS_ALL) | left;
1373         right = (chip->image[CS4231_RIGHT_INPUT] & ~CS4231_MIXS_ALL) | right;
1374         change = left != chip->image[CS4231_LEFT_INPUT] ||
1375                  right != chip->image[CS4231_RIGHT_INPUT];
1376         snd_cs4231_out(chip, CS4231_LEFT_INPUT, left);
1377         snd_cs4231_out(chip, CS4231_RIGHT_INPUT, right);
1378
1379         spin_unlock_irqrestore(&chip->lock, flags);
1380
1381         return change;
1382 }
1383
1384 static int snd_cs4231_info_single(struct snd_kcontrol *kcontrol,
1385                                   struct snd_ctl_elem_info *uinfo)
1386 {
1387         int mask = (kcontrol->private_value >> 16) & 0xff;
1388
1389         uinfo->type = (mask == 1) ?
1390                 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
1391         uinfo->count = 1;
1392         uinfo->value.integer.min = 0;
1393         uinfo->value.integer.max = mask;
1394
1395         return 0;
1396 }
1397
1398 static int snd_cs4231_get_single(struct snd_kcontrol *kcontrol,
1399                                  struct snd_ctl_elem_value *ucontrol)
1400 {
1401         struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1402         unsigned long flags;
1403         int reg = kcontrol->private_value & 0xff;
1404         int shift = (kcontrol->private_value >> 8) & 0xff;
1405         int mask = (kcontrol->private_value >> 16) & 0xff;
1406         int invert = (kcontrol->private_value >> 24) & 0xff;
1407
1408         spin_lock_irqsave(&chip->lock, flags);
1409
1410         ucontrol->value.integer.value[0] = (chip->image[reg] >> shift) & mask;
1411
1412         spin_unlock_irqrestore(&chip->lock, flags);
1413
1414         if (invert)
1415                 ucontrol->value.integer.value[0] =
1416                         (mask - ucontrol->value.integer.value[0]);
1417
1418         return 0;
1419 }
1420
1421 static int snd_cs4231_put_single(struct snd_kcontrol *kcontrol,
1422                                  struct snd_ctl_elem_value *ucontrol)
1423 {
1424         struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1425         unsigned long flags;
1426         int reg = kcontrol->private_value & 0xff;
1427         int shift = (kcontrol->private_value >> 8) & 0xff;
1428         int mask = (kcontrol->private_value >> 16) & 0xff;
1429         int invert = (kcontrol->private_value >> 24) & 0xff;
1430         int change;
1431         unsigned short val;
1432
1433         val = (ucontrol->value.integer.value[0] & mask);
1434         if (invert)
1435                 val = mask - val;
1436         val <<= shift;
1437
1438         spin_lock_irqsave(&chip->lock, flags);
1439
1440         val = (chip->image[reg] & ~(mask << shift)) | val;
1441         change = val != chip->image[reg];
1442         snd_cs4231_out(chip, reg, val);
1443
1444         spin_unlock_irqrestore(&chip->lock, flags);
1445
1446         return change;
1447 }
1448
1449 static int snd_cs4231_info_double(struct snd_kcontrol *kcontrol,
1450                                   struct snd_ctl_elem_info *uinfo)
1451 {
1452         int mask = (kcontrol->private_value >> 24) & 0xff;
1453
1454         uinfo->type = mask == 1 ?
1455                 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
1456         uinfo->count = 2;
1457         uinfo->value.integer.min = 0;
1458         uinfo->value.integer.max = mask;
1459
1460         return 0;
1461 }
1462
1463 static int snd_cs4231_get_double(struct snd_kcontrol *kcontrol,
1464                                  struct snd_ctl_elem_value *ucontrol)
1465 {
1466         struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1467         unsigned long flags;
1468         int left_reg = kcontrol->private_value & 0xff;
1469         int right_reg = (kcontrol->private_value >> 8) & 0xff;
1470         int shift_left = (kcontrol->private_value >> 16) & 0x07;
1471         int shift_right = (kcontrol->private_value >> 19) & 0x07;
1472         int mask = (kcontrol->private_value >> 24) & 0xff;
1473         int invert = (kcontrol->private_value >> 22) & 1;
1474
1475         spin_lock_irqsave(&chip->lock, flags);
1476
1477         ucontrol->value.integer.value[0] =
1478                 (chip->image[left_reg] >> shift_left) & mask;
1479         ucontrol->value.integer.value[1] =
1480                 (chip->image[right_reg] >> shift_right) & mask;
1481
1482         spin_unlock_irqrestore(&chip->lock, flags);
1483
1484         if (invert) {
1485                 ucontrol->value.integer.value[0] =
1486                         (mask - ucontrol->value.integer.value[0]);
1487                 ucontrol->value.integer.value[1] =
1488                         (mask - ucontrol->value.integer.value[1]);
1489         }
1490
1491         return 0;
1492 }
1493
1494 static int snd_cs4231_put_double(struct snd_kcontrol *kcontrol,
1495                                  struct snd_ctl_elem_value *ucontrol)
1496 {
1497         struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1498         unsigned long flags;
1499         int left_reg = kcontrol->private_value & 0xff;
1500         int right_reg = (kcontrol->private_value >> 8) & 0xff;
1501         int shift_left = (kcontrol->private_value >> 16) & 0x07;
1502         int shift_right = (kcontrol->private_value >> 19) & 0x07;
1503         int mask = (kcontrol->private_value >> 24) & 0xff;
1504         int invert = (kcontrol->private_value >> 22) & 1;
1505         int change;
1506         unsigned short val1, val2;
1507
1508         val1 = ucontrol->value.integer.value[0] & mask;
1509         val2 = ucontrol->value.integer.value[1] & mask;
1510         if (invert) {
1511                 val1 = mask - val1;
1512                 val2 = mask - val2;
1513         }
1514         val1 <<= shift_left;
1515         val2 <<= shift_right;
1516
1517         spin_lock_irqsave(&chip->lock, flags);
1518
1519         val1 = (chip->image[left_reg] & ~(mask << shift_left)) | val1;
1520         val2 = (chip->image[right_reg] & ~(mask << shift_right)) | val2;
1521         change = val1 != chip->image[left_reg];
1522         change |= val2 != chip->image[right_reg];
1523         snd_cs4231_out(chip, left_reg, val1);
1524         snd_cs4231_out(chip, right_reg, val2);
1525
1526         spin_unlock_irqrestore(&chip->lock, flags);
1527
1528         return change;
1529 }
1530
1531 #define CS4231_SINGLE(xname, xindex, reg, shift, mask, invert) \
1532 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), .index = (xindex), \
1533   .info = snd_cs4231_info_single,       \
1534   .get = snd_cs4231_get_single, .put = snd_cs4231_put_single,   \
1535   .private_value = (reg) | ((shift) << 8) | ((mask) << 16) | ((invert) << 24) }
1536
1537 #define CS4231_DOUBLE(xname, xindex, left_reg, right_reg, shift_left, \
1538                         shift_right, mask, invert) \
1539 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), .index = (xindex), \
1540   .info = snd_cs4231_info_double,       \
1541   .get = snd_cs4231_get_double, .put = snd_cs4231_put_double,   \
1542   .private_value = (left_reg) | ((right_reg) << 8) | ((shift_left) << 16) | \
1543                    ((shift_right) << 19) | ((mask) << 24) | ((invert) << 22) }
1544
1545 static struct snd_kcontrol_new snd_cs4231_controls[] __initdata = {
1546 CS4231_DOUBLE("PCM Playback Switch", 0, CS4231_LEFT_OUTPUT,
1547                 CS4231_RIGHT_OUTPUT, 7, 7, 1, 1),
1548 CS4231_DOUBLE("PCM Playback Volume", 0, CS4231_LEFT_OUTPUT,
1549                 CS4231_RIGHT_OUTPUT, 0, 0, 63, 1),
1550 CS4231_DOUBLE("Line Playback Switch", 0, CS4231_LEFT_LINE_IN,
1551                 CS4231_RIGHT_LINE_IN, 7, 7, 1, 1),
1552 CS4231_DOUBLE("Line Playback Volume", 0, CS4231_LEFT_LINE_IN,
1553                 CS4231_RIGHT_LINE_IN, 0, 0, 31, 1),
1554 CS4231_DOUBLE("Aux Playback Switch", 0, CS4231_AUX1_LEFT_INPUT,
1555                 CS4231_AUX1_RIGHT_INPUT, 7, 7, 1, 1),
1556 CS4231_DOUBLE("Aux Playback Volume", 0, CS4231_AUX1_LEFT_INPUT,
1557                 CS4231_AUX1_RIGHT_INPUT, 0, 0, 31, 1),
1558 CS4231_DOUBLE("Aux Playback Switch", 1, CS4231_AUX2_LEFT_INPUT,
1559                 CS4231_AUX2_RIGHT_INPUT, 7, 7, 1, 1),
1560 CS4231_DOUBLE("Aux Playback Volume", 1, CS4231_AUX2_LEFT_INPUT,
1561                 CS4231_AUX2_RIGHT_INPUT, 0, 0, 31, 1),
1562 CS4231_SINGLE("Mono Playback Switch", 0, CS4231_MONO_CTRL, 7, 1, 1),
1563 CS4231_SINGLE("Mono Playback Volume", 0, CS4231_MONO_CTRL, 0, 15, 1),
1564 CS4231_SINGLE("Mono Output Playback Switch", 0, CS4231_MONO_CTRL, 6, 1, 1),
1565 CS4231_SINGLE("Mono Output Playback Bypass", 0, CS4231_MONO_CTRL, 5, 1, 0),
1566 CS4231_DOUBLE("Capture Volume", 0, CS4231_LEFT_INPUT, CS4231_RIGHT_INPUT, 0, 0,
1567                 15, 0),
1568 {
1569         .iface  = SNDRV_CTL_ELEM_IFACE_MIXER,
1570         .name   = "Capture Source",
1571         .info   = snd_cs4231_info_mux,
1572         .get    = snd_cs4231_get_mux,
1573         .put    = snd_cs4231_put_mux,
1574 },
1575 CS4231_DOUBLE("Mic Boost", 0, CS4231_LEFT_INPUT, CS4231_RIGHT_INPUT, 5, 5,
1576                 1, 0),
1577 CS4231_SINGLE("Loopback Capture Switch", 0, CS4231_LOOPBACK, 0, 1, 0),
1578 CS4231_SINGLE("Loopback Capture Volume", 0, CS4231_LOOPBACK, 2, 63, 1),
1579 /* SPARC specific uses of XCTL{0,1} general purpose outputs.  */
1580 CS4231_SINGLE("Line Out Switch", 0, CS4231_PIN_CTRL, 6, 1, 1),
1581 CS4231_SINGLE("Headphone Out Switch", 0, CS4231_PIN_CTRL, 7, 1, 1)
1582 };
1583
1584 static int __init snd_cs4231_mixer(struct snd_card *card)
1585 {
1586         struct snd_cs4231 *chip = card->private_data;
1587         int err, idx;
1588
1589         snd_assert(chip != NULL && chip->pcm != NULL, return -EINVAL);
1590
1591         strcpy(card->mixername, chip->pcm->name);
1592
1593         for (idx = 0; idx < ARRAY_SIZE(snd_cs4231_controls); idx++) {
1594                 err = snd_ctl_add(card,
1595                                  snd_ctl_new1(&snd_cs4231_controls[idx], chip));
1596                 if (err < 0)
1597                         return err;
1598         }
1599         return 0;
1600 }
1601
1602 static int dev;
1603
1604 static int __init cs4231_attach_begin(struct snd_card **rcard)
1605 {
1606         struct snd_card *card;
1607         struct snd_cs4231 *chip;
1608
1609         *rcard = NULL;
1610
1611         if (dev >= SNDRV_CARDS)
1612                 return -ENODEV;
1613
1614         if (!enable[dev]) {
1615                 dev++;
1616                 return -ENOENT;
1617         }
1618
1619         card = snd_card_new(index[dev], id[dev], THIS_MODULE,
1620                             sizeof(struct snd_cs4231));
1621         if (card == NULL)
1622                 return -ENOMEM;
1623
1624         strcpy(card->driver, "CS4231");
1625         strcpy(card->shortname, "Sun CS4231");
1626
1627         chip = card->private_data;
1628         chip->card = card;
1629
1630         *rcard = card;
1631         return 0;
1632 }
1633
1634 static int __init cs4231_attach_finish(struct snd_card *card)
1635 {
1636         struct snd_cs4231 *chip = card->private_data;
1637         int err;
1638
1639         err = snd_cs4231_pcm(card);
1640         if (err < 0)
1641                 goto out_err;
1642
1643         err = snd_cs4231_mixer(card);
1644         if (err < 0)
1645                 goto out_err;
1646
1647         err = snd_cs4231_timer(card);
1648         if (err < 0)
1649                 goto out_err;
1650
1651         err = snd_card_register(card);
1652         if (err < 0)
1653                 goto out_err;
1654
1655         chip->next = cs4231_list;
1656         cs4231_list = chip;
1657
1658         dev++;
1659         return 0;
1660
1661 out_err:
1662         snd_card_free(card);
1663         return err;
1664 }
1665
1666 #ifdef SBUS_SUPPORT
1667
1668 static irqreturn_t snd_cs4231_sbus_interrupt(int irq, void *dev_id)
1669 {
1670         unsigned long flags;
1671         unsigned char status;
1672         u32 csr;
1673         struct snd_cs4231 *chip = dev_id;
1674
1675         /*This is IRQ is not raised by the cs4231*/
1676         if (!(__cs4231_readb(chip, CS4231U(chip, STATUS)) & CS4231_GLOBALIRQ))
1677                 return IRQ_NONE;
1678
1679         /* ACK the APC interrupt. */
1680         csr = sbus_readl(chip->port + APCCSR);
1681
1682         sbus_writel(csr, chip->port + APCCSR);
1683
1684         if ((csr & APC_PDMA_READY) &&
1685             (csr & APC_PLAY_INT) &&
1686             (csr & APC_XINT_PNVA) &&
1687             !(csr & APC_XINT_EMPT))
1688                         snd_cs4231_play_callback(chip);
1689
1690         if ((csr & APC_CDMA_READY) &&
1691             (csr & APC_CAPT_INT) &&
1692             (csr & APC_XINT_CNVA) &&
1693             !(csr & APC_XINT_EMPT))
1694                         snd_cs4231_capture_callback(chip);
1695
1696         status = snd_cs4231_in(chip, CS4231_IRQ_STATUS);
1697
1698         if (status & CS4231_TIMER_IRQ) {
1699                 if (chip->timer)
1700                         snd_timer_interrupt(chip->timer, chip->timer->sticks);
1701         }
1702
1703         if ((status & CS4231_RECORD_IRQ) && (csr & APC_CDMA_READY))
1704                 snd_cs4231_overrange(chip);
1705
1706         /* ACK the CS4231 interrupt. */
1707         spin_lock_irqsave(&chip->lock, flags);
1708         snd_cs4231_outm(chip, CS4231_IRQ_STATUS, ~CS4231_ALL_IRQS | ~status, 0);
1709         spin_unlock_irqrestore(&chip->lock, flags);
1710
1711         return IRQ_HANDLED;
1712 }
1713
1714 /*
1715  * SBUS DMA routines
1716  */
1717
1718 static int sbus_dma_request(struct cs4231_dma_control *dma_cont,
1719                             dma_addr_t bus_addr, size_t len)
1720 {
1721         unsigned long flags;
1722         u32 test, csr;
1723         int err;
1724         struct sbus_dma_info *base = &dma_cont->sbus_info;
1725
1726         if (len >= (1 << 24))
1727                 return -EINVAL;
1728         spin_lock_irqsave(&base->lock, flags);
1729         csr = sbus_readl(base->regs + APCCSR);
1730         err = -EINVAL;
1731         test = APC_CDMA_READY;
1732         if (base->dir == APC_PLAY)
1733                 test = APC_PDMA_READY;
1734         if (!(csr & test))
1735                 goto out;
1736         err = -EBUSY;
1737         test = APC_XINT_CNVA;
1738         if (base->dir == APC_PLAY)
1739                 test = APC_XINT_PNVA;
1740         if (!(csr & test))
1741                 goto out;
1742         err = 0;
1743         sbus_writel(bus_addr, base->regs + base->dir + APCNVA);
1744         sbus_writel(len, base->regs + base->dir + APCNC);
1745 out:
1746         spin_unlock_irqrestore(&base->lock, flags);
1747         return err;
1748 }
1749
1750 static void sbus_dma_prepare(struct cs4231_dma_control *dma_cont, int d)
1751 {
1752         unsigned long flags;
1753         u32 csr, test;
1754         struct sbus_dma_info *base = &dma_cont->sbus_info;
1755
1756         spin_lock_irqsave(&base->lock, flags);
1757         csr = sbus_readl(base->regs + APCCSR);
1758         test =  APC_GENL_INT | APC_PLAY_INT | APC_XINT_ENA |
1759                 APC_XINT_PLAY | APC_XINT_PEMP | APC_XINT_GENL |
1760                  APC_XINT_PENA;
1761         if (base->dir == APC_RECORD)
1762                 test = APC_GENL_INT | APC_CAPT_INT | APC_XINT_ENA |
1763                         APC_XINT_CAPT | APC_XINT_CEMP | APC_XINT_GENL;
1764         csr |= test;
1765         sbus_writel(csr, base->regs + APCCSR);
1766         spin_unlock_irqrestore(&base->lock, flags);
1767 }
1768
1769 static void sbus_dma_enable(struct cs4231_dma_control *dma_cont, int on)
1770 {
1771         unsigned long flags;
1772         u32 csr, shift;
1773         struct sbus_dma_info *base = &dma_cont->sbus_info;
1774
1775         spin_lock_irqsave(&base->lock, flags);
1776         if (!on) {
1777                 sbus_writel(0, base->regs + base->dir + APCNC);
1778                 sbus_writel(0, base->regs + base->dir + APCNVA);
1779                 if (base->dir == APC_PLAY) {
1780                         sbus_writel(0, base->regs + base->dir + APCC);
1781                         sbus_writel(0, base->regs + base->dir + APCVA);
1782                 }
1783
1784                 udelay(1200);
1785         }
1786         csr = sbus_readl(base->regs + APCCSR);
1787         shift = 0;
1788         if (base->dir == APC_PLAY)
1789                 shift = 1;
1790         if (on)
1791                 csr &= ~(APC_CPAUSE << shift);
1792         else
1793                 csr |= (APC_CPAUSE << shift);
1794         sbus_writel(csr, base->regs + APCCSR);
1795         if (on)
1796                 csr |= (APC_CDMA_READY << shift);
1797         else
1798                 csr &= ~(APC_CDMA_READY << shift);
1799         sbus_writel(csr, base->regs + APCCSR);
1800
1801         spin_unlock_irqrestore(&base->lock, flags);
1802 }
1803
1804 static unsigned int sbus_dma_addr(struct cs4231_dma_control *dma_cont)
1805 {
1806         struct sbus_dma_info *base = &dma_cont->sbus_info;
1807
1808         return sbus_readl(base->regs + base->dir + APCVA);
1809 }
1810
1811 static void sbus_dma_preallocate(struct snd_cs4231 *chip, struct snd_pcm *pcm)
1812 {
1813         snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_SBUS,
1814                                         snd_dma_sbus_data(chip->dev_u.sdev),
1815                                         64 * 1024, 128 * 1024);
1816 }
1817
1818 /*
1819  * Init and exit routines
1820  */
1821
1822 static int snd_cs4231_sbus_free(struct snd_cs4231 *chip)
1823 {
1824         if (chip->irq[0])
1825                 free_irq(chip->irq[0], chip);
1826
1827         if (chip->port)
1828                 sbus_iounmap(chip->port, chip->regs_size);
1829
1830         return 0;
1831 }
1832
1833 static int snd_cs4231_sbus_dev_free(struct snd_device *device)
1834 {
1835         struct snd_cs4231 *cp = device->device_data;
1836
1837         return snd_cs4231_sbus_free(cp);
1838 }
1839
1840 static struct snd_device_ops snd_cs4231_sbus_dev_ops = {
1841         .dev_free       =       snd_cs4231_sbus_dev_free,
1842 };
1843
1844 static int __init snd_cs4231_sbus_create(struct snd_card *card,
1845                                          struct sbus_dev *sdev,
1846                                          int dev)
1847 {
1848         struct snd_cs4231 *chip = card->private_data;
1849         int err;
1850
1851         spin_lock_init(&chip->lock);
1852         spin_lock_init(&chip->c_dma.sbus_info.lock);
1853         spin_lock_init(&chip->p_dma.sbus_info.lock);
1854         mutex_init(&chip->mce_mutex);
1855         mutex_init(&chip->open_mutex);
1856         chip->dev_u.sdev = sdev;
1857         chip->regs_size = sdev->reg_addrs[0].reg_size;
1858         memcpy(&chip->image, &snd_cs4231_original_image,
1859                sizeof(snd_cs4231_original_image));
1860
1861         chip->port = sbus_ioremap(&sdev->resource[0], 0,
1862                                   chip->regs_size, "cs4231");
1863         if (!chip->port) {
1864                 snd_printdd("cs4231-%d: Unable to map chip registers.\n", dev);
1865                 return -EIO;
1866         }
1867
1868         chip->c_dma.sbus_info.regs = chip->port;
1869         chip->p_dma.sbus_info.regs = chip->port;
1870         chip->c_dma.sbus_info.dir = APC_RECORD;
1871         chip->p_dma.sbus_info.dir = APC_PLAY;
1872
1873         chip->p_dma.prepare = sbus_dma_prepare;
1874         chip->p_dma.enable = sbus_dma_enable;
1875         chip->p_dma.request = sbus_dma_request;
1876         chip->p_dma.address = sbus_dma_addr;
1877         chip->p_dma.preallocate = sbus_dma_preallocate;
1878
1879         chip->c_dma.prepare = sbus_dma_prepare;
1880         chip->c_dma.enable = sbus_dma_enable;
1881         chip->c_dma.request = sbus_dma_request;
1882         chip->c_dma.address = sbus_dma_addr;
1883         chip->c_dma.preallocate = sbus_dma_preallocate;
1884
1885         if (request_irq(sdev->irqs[0], snd_cs4231_sbus_interrupt,
1886                         IRQF_SHARED, "cs4231", chip)) {
1887                 snd_printdd("cs4231-%d: Unable to grab SBUS IRQ %d\n",
1888                             dev, sdev->irqs[0]);
1889                 snd_cs4231_sbus_free(chip);
1890                 return -EBUSY;
1891         }
1892         chip->irq[0] = sdev->irqs[0];
1893
1894         if (snd_cs4231_probe(chip) < 0) {
1895                 snd_cs4231_sbus_free(chip);
1896                 return -ENODEV;
1897         }
1898         snd_cs4231_init(chip);
1899
1900         if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
1901                                   chip, &snd_cs4231_sbus_dev_ops)) < 0) {
1902                 snd_cs4231_sbus_free(chip);
1903                 return err;
1904         }
1905
1906         return 0;
1907 }
1908
1909 static int __init cs4231_sbus_attach(struct sbus_dev *sdev)
1910 {
1911         struct resource *rp = &sdev->resource[0];
1912         struct snd_card *card;
1913         int err;
1914
1915         err = cs4231_attach_begin(&card);
1916         if (err)
1917                 return err;
1918
1919         sprintf(card->longname, "%s at 0x%02lx:0x%016Lx, irq %d",
1920                 card->shortname,
1921                 rp->flags & 0xffL,
1922                 (unsigned long long)rp->start,
1923                 sdev->irqs[0]);
1924
1925         err = snd_cs4231_sbus_create(card, sdev, dev);
1926         if (err < 0) {
1927                 snd_card_free(card);
1928                 return err;
1929         }
1930
1931         return cs4231_attach_finish(card);
1932 }
1933 #endif
1934
1935 #ifdef EBUS_SUPPORT
1936
1937 static void snd_cs4231_ebus_play_callback(struct ebus_dma_info *p, int event,
1938                                           void *cookie)
1939 {
1940         struct snd_cs4231 *chip = cookie;
1941
1942         snd_cs4231_play_callback(chip);
1943 }
1944
1945 static void snd_cs4231_ebus_capture_callback(struct ebus_dma_info *p,
1946                                              int event, void *cookie)
1947 {
1948         struct snd_cs4231 *chip = cookie;
1949
1950         snd_cs4231_capture_callback(chip);
1951 }
1952
1953 /*
1954  * EBUS DMA wrappers
1955  */
1956
1957 static int _ebus_dma_request(struct cs4231_dma_control *dma_cont,
1958                              dma_addr_t bus_addr, size_t len)
1959 {
1960         return ebus_dma_request(&dma_cont->ebus_info, bus_addr, len);
1961 }
1962
1963 static void _ebus_dma_enable(struct cs4231_dma_control *dma_cont, int on)
1964 {
1965         ebus_dma_enable(&dma_cont->ebus_info, on);
1966 }
1967
1968 static void _ebus_dma_prepare(struct cs4231_dma_control *dma_cont, int dir)
1969 {
1970         ebus_dma_prepare(&dma_cont->ebus_info, dir);
1971 }
1972
1973 static unsigned int _ebus_dma_addr(struct cs4231_dma_control *dma_cont)
1974 {
1975         return ebus_dma_addr(&dma_cont->ebus_info);
1976 }
1977
1978 static void _ebus_dma_preallocate(struct snd_cs4231 *chip, struct snd_pcm *pcm)
1979 {
1980         snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
1981                                       snd_dma_pci_data(chip->dev_u.pdev),
1982                                       64*1024, 128*1024);
1983 }
1984
1985 /*
1986  * Init and exit routines
1987  */
1988
1989 static int snd_cs4231_ebus_free(struct snd_cs4231 *chip)
1990 {
1991         if (chip->c_dma.ebus_info.regs) {
1992                 ebus_dma_unregister(&chip->c_dma.ebus_info);
1993                 iounmap(chip->c_dma.ebus_info.regs);
1994         }
1995         if (chip->p_dma.ebus_info.regs) {
1996                 ebus_dma_unregister(&chip->p_dma.ebus_info);
1997                 iounmap(chip->p_dma.ebus_info.regs);
1998         }
1999
2000         if (chip->port)
2001                 iounmap(chip->port);
2002
2003         return 0;
2004 }
2005
2006 static int snd_cs4231_ebus_dev_free(struct snd_device *device)
2007 {
2008         struct snd_cs4231 *cp = device->device_data;
2009
2010         return snd_cs4231_ebus_free(cp);
2011 }
2012
2013 static struct snd_device_ops snd_cs4231_ebus_dev_ops = {
2014         .dev_free       =       snd_cs4231_ebus_dev_free,
2015 };
2016
2017 static int __init snd_cs4231_ebus_create(struct snd_card *card,
2018                                          struct linux_ebus_device *edev,
2019                                          int dev)
2020 {
2021         struct snd_cs4231 *chip = card->private_data;
2022         int err;
2023
2024         spin_lock_init(&chip->lock);
2025         spin_lock_init(&chip->c_dma.ebus_info.lock);
2026         spin_lock_init(&chip->p_dma.ebus_info.lock);
2027         mutex_init(&chip->mce_mutex);
2028         mutex_init(&chip->open_mutex);
2029         chip->flags |= CS4231_FLAG_EBUS;
2030         chip->dev_u.pdev = edev->bus->self;
2031         memcpy(&chip->image, &snd_cs4231_original_image,
2032                sizeof(snd_cs4231_original_image));
2033         strcpy(chip->c_dma.ebus_info.name, "cs4231(capture)");
2034         chip->c_dma.ebus_info.flags = EBUS_DMA_FLAG_USE_EBDMA_HANDLER;
2035         chip->c_dma.ebus_info.callback = snd_cs4231_ebus_capture_callback;
2036         chip->c_dma.ebus_info.client_cookie = chip;
2037         chip->c_dma.ebus_info.irq = edev->irqs[0];
2038         strcpy(chip->p_dma.ebus_info.name, "cs4231(play)");
2039         chip->p_dma.ebus_info.flags = EBUS_DMA_FLAG_USE_EBDMA_HANDLER;
2040         chip->p_dma.ebus_info.callback = snd_cs4231_ebus_play_callback;
2041         chip->p_dma.ebus_info.client_cookie = chip;
2042         chip->p_dma.ebus_info.irq = edev->irqs[1];
2043
2044         chip->p_dma.prepare = _ebus_dma_prepare;
2045         chip->p_dma.enable = _ebus_dma_enable;
2046         chip->p_dma.request = _ebus_dma_request;
2047         chip->p_dma.address = _ebus_dma_addr;
2048         chip->p_dma.preallocate = _ebus_dma_preallocate;
2049
2050         chip->c_dma.prepare = _ebus_dma_prepare;
2051         chip->c_dma.enable = _ebus_dma_enable;
2052         chip->c_dma.request = _ebus_dma_request;
2053         chip->c_dma.address = _ebus_dma_addr;
2054         chip->c_dma.preallocate = _ebus_dma_preallocate;
2055
2056         chip->port = ioremap(edev->resource[0].start, 0x10);
2057         chip->p_dma.ebus_info.regs = ioremap(edev->resource[1].start, 0x10);
2058         chip->c_dma.ebus_info.regs = ioremap(edev->resource[2].start, 0x10);
2059         if (!chip->port || !chip->p_dma.ebus_info.regs ||
2060             !chip->c_dma.ebus_info.regs) {
2061                 snd_cs4231_ebus_free(chip);
2062                 snd_printdd("cs4231-%d: Unable to map chip registers.\n", dev);
2063                 return -EIO;
2064         }
2065
2066         if (ebus_dma_register(&chip->c_dma.ebus_info)) {
2067                 snd_cs4231_ebus_free(chip);
2068                 snd_printdd("cs4231-%d: Unable to register EBUS capture DMA\n",
2069                             dev);
2070                 return -EBUSY;
2071         }
2072         if (ebus_dma_irq_enable(&chip->c_dma.ebus_info, 1)) {
2073                 snd_cs4231_ebus_free(chip);
2074                 snd_printdd("cs4231-%d: Unable to enable EBUS capture IRQ\n",
2075                             dev);
2076                 return -EBUSY;
2077         }
2078
2079         if (ebus_dma_register(&chip->p_dma.ebus_info)) {
2080                 snd_cs4231_ebus_free(chip);
2081                 snd_printdd("cs4231-%d: Unable to register EBUS play DMA\n",
2082                             dev);
2083                 return -EBUSY;
2084         }
2085         if (ebus_dma_irq_enable(&chip->p_dma.ebus_info, 1)) {
2086                 snd_cs4231_ebus_free(chip);
2087                 snd_printdd("cs4231-%d: Unable to enable EBUS play IRQ\n", dev);
2088                 return -EBUSY;
2089         }
2090
2091         if (snd_cs4231_probe(chip) < 0) {
2092                 snd_cs4231_ebus_free(chip);
2093                 return -ENODEV;
2094         }
2095         snd_cs4231_init(chip);
2096
2097         if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
2098                                   chip, &snd_cs4231_ebus_dev_ops)) < 0) {
2099                 snd_cs4231_ebus_free(chip);
2100                 return err;
2101         }
2102
2103         return 0;
2104 }
2105
2106 static int __init cs4231_ebus_attach(struct linux_ebus_device *edev)
2107 {
2108         struct snd_card *card;
2109         int err;
2110
2111         err = cs4231_attach_begin(&card);
2112         if (err)
2113                 return err;
2114
2115         sprintf(card->longname, "%s at 0x%lx, irq %d",
2116                 card->shortname,
2117                 edev->resource[0].start,
2118                 edev->irqs[0]);
2119
2120         err = snd_cs4231_ebus_create(card, edev, dev);
2121         if (err < 0) {
2122                 snd_card_free(card);
2123                 return err;
2124         }
2125
2126         return cs4231_attach_finish(card);
2127 }
2128 #endif
2129
2130 static int __init cs4231_init(void)
2131 {
2132 #ifdef SBUS_SUPPORT
2133         struct sbus_bus *sbus;
2134         struct sbus_dev *sdev;
2135 #endif
2136 #ifdef EBUS_SUPPORT
2137         struct linux_ebus *ebus;
2138         struct linux_ebus_device *edev;
2139 #endif
2140         int found;
2141
2142         found = 0;
2143
2144 #ifdef SBUS_SUPPORT
2145         for_all_sbusdev(sdev, sbus) {
2146                 if (!strcmp(sdev->prom_name, "SUNW,CS4231")) {
2147                         if (cs4231_sbus_attach(sdev) == 0)
2148                                 found++;
2149                 }
2150         }
2151 #endif
2152 #ifdef EBUS_SUPPORT
2153         for_each_ebus(ebus) {
2154                 for_each_ebusdev(edev, ebus) {
2155                         int match = 0;
2156
2157                         if (!strcmp(edev->prom_node->name, "SUNW,CS4231")) {
2158                                 match = 1;
2159                         } else if (!strcmp(edev->prom_node->name, "audio")) {
2160                                 const char *compat;
2161
2162                                 compat = of_get_property(edev->prom_node,
2163                                                          "compatible", NULL);
2164                                 if (compat && !strcmp(compat, "SUNW,CS4231"))
2165                                         match = 1;
2166                         }
2167
2168                         if (match &&
2169                             cs4231_ebus_attach(edev) == 0)
2170                                 found++;
2171                 }
2172         }
2173 #endif
2174
2175
2176         return (found > 0) ? 0 : -EIO;
2177 }
2178
2179 static void __exit cs4231_exit(void)
2180 {
2181         struct snd_cs4231 *p = cs4231_list;
2182
2183         while (p != NULL) {
2184                 struct snd_cs4231 *next = p->next;
2185
2186                 snd_card_free(p->card);
2187
2188                 p = next;
2189         }
2190
2191         cs4231_list = NULL;
2192 }
2193
2194 module_init(cs4231_init);
2195 module_exit(cs4231_exit);