sound/soc/au1x/psc-ac97.c

   1 /*
   2  * Au12x0/Au1550 PSC ALSA ASoC audio support.
   3  *
   4  * (c) 2007-2009 MSC Vertriebsges.m.b.H.,
   5  *      Manuel Lauss <manuel.lauss@gmail.com>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  *
  11  * Au1xxx-PSC AC97 glue.
  12  *
  13  * NOTE: all of these drivers can only work with a SINGLE instance
  14  *       of a PSC. Multiple independent audio devices are impossible
  15  *       with ASoC v1.
  16  */
  17
  18 #include <linux/init.h>
  19 #include <linux/module.h>
  20 #include <linux/device.h>
  21 #include <linux/delay.h>
  22 #include <linux/mutex.h>
  23 #include <linux/suspend.h>
  24 #include <sound/core.h>
  25 #include <sound/pcm.h>
  26 #include <sound/initval.h>
  27 #include <sound/soc.h>
  28 #include <asm/mach-au1x00/au1000.h>
  29 #include <asm/mach-au1x00/au1xxx_psc.h>
  30
  31 #include "psc.h"
  32
  33 /* how often to retry failed codec register reads/writes */
  34 #define AC97_RW_RETRIES 5
  35
  36 #define AC97_DIR        \
  37         (SND_SOC_DAIDIR_PLAYBACK | SND_SOC_DAIDIR_CAPTURE)
  38
  39 #define AC97_RATES      \
  40         SNDRV_PCM_RATE_8000_48000
  41
  42 #define AC97_FMTS       \
  43         (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3BE)
  44
  45 #define AC97PCR_START(stype)    \
  46         ((stype) == PCM_TX ? PSC_AC97PCR_TS : PSC_AC97PCR_RS)
  47 #define AC97PCR_STOP(stype)     \
  48         ((stype) == PCM_TX ? PSC_AC97PCR_TP : PSC_AC97PCR_RP)
  49 #define AC97PCR_CLRFIFO(stype)  \
  50         ((stype) == PCM_TX ? PSC_AC97PCR_TC : PSC_AC97PCR_RC)
  51
  52 #define AC97STAT_BUSY(stype)    \
  53         ((stype) == PCM_TX ? PSC_AC97STAT_TB : PSC_AC97STAT_RB)
  54
  55 /* instance data. There can be only one, MacLeod!!!! */
  56 static struct au1xpsc_audio_data *au1xpsc_ac97_workdata;
  57
  58 /* AC97 controller reads codec register */
  59 static unsigned short au1xpsc_ac97_read(struct snd_ac97 *ac97,
  60                                         unsigned short reg)
  61 {
  62         /* FIXME */
  63         struct au1xpsc_audio_data *pscdata = au1xpsc_ac97_workdata;
  64         unsigned short retry, tmo;
  65         unsigned long data;
  66
  67         au_writel(PSC_AC97EVNT_CD, AC97_EVNT(pscdata));
  68         au_sync();
  69
  70         retry = AC97_RW_RETRIES;
  71         do {
  72                 mutex_lock(&pscdata->lock);
  73
  74                 au_writel(PSC_AC97CDC_RD | PSC_AC97CDC_INDX(reg),
  75                           AC97_CDC(pscdata));
  76                 au_sync();
  77
  78                 tmo = 2000;
  79                 while ((!(au_readl(AC97_EVNT(pscdata)) & PSC_AC97EVNT_CD))
  80                         && --tmo)
  81                         udelay(2);
  82
  83                 data = au_readl(AC97_CDC(pscdata));
  84
  85                 au_writel(PSC_AC97EVNT_CD, AC97_EVNT(pscdata));
  86                 au_sync();
  87
  88                 mutex_unlock(&pscdata->lock);
  89
  90                 if (reg != ((data >> 16) & 0x7f))
  91                         tmo = 1;        /* wrong register, try again */
  92
  93         } while (--retry && !tmo);
  94
  95         return retry ? data & 0xffff : 0xffff;
  96 }
  97
  98 /* AC97 controller writes to codec register */
  99 static void au1xpsc_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
 100                                 unsigned short val)
 101 {
 102         /* FIXME */
 103         struct au1xpsc_audio_data *pscdata = au1xpsc_ac97_workdata;
 104         unsigned int tmo, retry;
 105
 106         au_writel(PSC_AC97EVNT_CD, AC97_EVNT(pscdata));
 107         au_sync();
 108
 109         retry = AC97_RW_RETRIES;
 110         do {
 111                 mutex_lock(&pscdata->lock);
 112
 113                 au_writel(PSC_AC97CDC_INDX(reg) | (val & 0xffff),
 114                           AC97_CDC(pscdata));
 115                 au_sync();
 116
 117                 tmo = 2000;
 118                 while ((!(au_readl(AC97_EVNT(pscdata)) & PSC_AC97EVNT_CD))
 119                        && --tmo)
 120                         udelay(2);
 121
 122                 au_writel(PSC_AC97EVNT_CD, AC97_EVNT(pscdata));
 123                 au_sync();
 124
 125                 mutex_unlock(&pscdata->lock);
 126         } while (--retry && !tmo);
 127 }
 128
 129 /* AC97 controller asserts a warm reset */
 130 static void au1xpsc_ac97_warm_reset(struct snd_ac97 *ac97)
 131 {
 132         /* FIXME */
 133         struct au1xpsc_audio_data *pscdata = au1xpsc_ac97_workdata;
 134
 135         au_writel(PSC_AC97RST_SNC, AC97_RST(pscdata));
 136         au_sync();
 137         msleep(10);
 138         au_writel(0, AC97_RST(pscdata));
 139         au_sync();
 140 }
 141
 142 static void au1xpsc_ac97_cold_reset(struct snd_ac97 *ac97)
 143 {
 144         /* FIXME */
 145         struct au1xpsc_audio_data *pscdata = au1xpsc_ac97_workdata;
 146         int i;
 147
 148         /* disable PSC during cold reset */
 149         au_writel(0, AC97_CFG(au1xpsc_ac97_workdata));
 150         au_sync();
 151         au_writel(PSC_CTRL_DISABLE, PSC_CTRL(pscdata));
 152         au_sync();
 153
 154         /* issue cold reset */
 155         au_writel(PSC_AC97RST_RST, AC97_RST(pscdata));
 156         au_sync();
 157         msleep(500);
 158         au_writel(0, AC97_RST(pscdata));
 159         au_sync();
 160
 161         /* enable PSC */
 162         au_writel(PSC_CTRL_ENABLE, PSC_CTRL(pscdata));
 163         au_sync();
 164
 165         /* wait for PSC to indicate it's ready */
 166         i = 1000;
 167         while (!((au_readl(AC97_STAT(pscdata)) & PSC_AC97STAT_SR)) && (--i))
 168                 msleep(1);
 169
 170         if (i == 0) {
 171                 printk(KERN_ERR "au1xpsc-ac97: PSC not ready!\n");
 172                 return;
 173         }
 174
 175         /* enable the ac97 function */
 176         au_writel(pscdata->cfg | PSC_AC97CFG_DE_ENABLE, AC97_CFG(pscdata));
 177         au_sync();
 178
 179         /* wait for AC97 core to become ready */
 180         i = 1000;
 181         while (!((au_readl(AC97_STAT(pscdata)) & PSC_AC97STAT_DR)) && (--i))
 182                 msleep(1);
 183         if (i == 0)
 184                 printk(KERN_ERR "au1xpsc-ac97: AC97 ctrl not ready\n");
 185 }
 186
 187 /* AC97 controller operations */
 188 struct snd_ac97_bus_ops soc_ac97_ops = {
 189         .read           = au1xpsc_ac97_read,
 190         .write          = au1xpsc_ac97_write,
 191         .reset          = au1xpsc_ac97_cold_reset,
 192         .warm_reset     = au1xpsc_ac97_warm_reset,
 193 };
 194 EXPORT_SYMBOL_GPL(soc_ac97_ops);
 195
 196 static int au1xpsc_ac97_hw_params(struct snd_pcm_substream *substream,
 197                                   struct snd_pcm_hw_params *params,
 198                                   struct snd_soc_dai *dai)
 199 {
 200         /* FIXME */
 201         struct au1xpsc_audio_data *pscdata = au1xpsc_ac97_workdata;
 202         unsigned long r, ro, stat;
 203         int chans, stype = SUBSTREAM_TYPE(substream);
 204
 205         chans = params_channels(params);
 206
 207         r = ro = au_readl(AC97_CFG(pscdata));
 208         stat = au_readl(AC97_STAT(pscdata));
 209
 210         /* already active? */
 211         if (stat & (PSC_AC97STAT_TB | PSC_AC97STAT_RB)) {
 212                 /* reject parameters not currently set up */
 213                 if ((PSC_AC97CFG_GET_LEN(r) != params->msbits) ||
 214                     (pscdata->rate != params_rate(params)))
 215                         return -EINVAL;
 216         } else {
 217
 218                 /* set sample bitdepth: REG[24:21]=(BITS-2)/2 */
 219                 r &= ~PSC_AC97CFG_LEN_MASK;
 220                 r |= PSC_AC97CFG_SET_LEN(params->msbits);
 221
 222                 /* channels: enable slots for front L/R channel */
 223                 if (stype == PCM_TX) {
 224                         r &= ~PSC_AC97CFG_TXSLOT_MASK;
 225                         r |= PSC_AC97CFG_TXSLOT_ENA(3);
 226                         r |= PSC_AC97CFG_TXSLOT_ENA(4);
 227                 } else {
 228                         r &= ~PSC_AC97CFG_RXSLOT_MASK;
 229                         r |= PSC_AC97CFG_RXSLOT_ENA(3);
 230                         r |= PSC_AC97CFG_RXSLOT_ENA(4);
 231                 }
 232
 233                 /* do we need to poke the hardware? */
 234                 if (!(r ^ ro))
 235                         goto out;
 236
 237                 /* ac97 engine is about to be disabled */
 238                 mutex_lock(&pscdata->lock);
 239
 240                 /* disable AC97 device controller first... */
 241                 au_writel(r & ~PSC_AC97CFG_DE_ENABLE, AC97_CFG(pscdata));
 242                 au_sync();
 243
 244                 /* ...wait for it... */
 245                 while (au_readl(AC97_STAT(pscdata)) & PSC_AC97STAT_DR)
 246                         asm volatile ("nop");
 247
 248                 /* ...write config... */
 249                 au_writel(r, AC97_CFG(pscdata));
 250                 au_sync();
 251
 252                 /* ...enable the AC97 controller again... */
 253                 au_writel(r | PSC_AC97CFG_DE_ENABLE, AC97_CFG(pscdata));
 254                 au_sync();
 255
 256                 /* ...and wait for ready bit */
 257                 while (!(au_readl(AC97_STAT(pscdata)) & PSC_AC97STAT_DR))
 258                         asm volatile ("nop");
 259
 260                 mutex_unlock(&pscdata->lock);
 261
 262                 pscdata->cfg = r;
 263                 pscdata->rate = params_rate(params);
 264         }
 265
 266 out:
 267         return 0;
 268 }
 269
 270 static int au1xpsc_ac97_trigger(struct snd_pcm_substream *substream,
 271                                 int cmd, struct snd_soc_dai *dai)
 272 {
 273         /* FIXME */
 274         struct au1xpsc_audio_data *pscdata = au1xpsc_ac97_workdata;
 275         int ret, stype = SUBSTREAM_TYPE(substream);
 276
 277         ret = 0;
 278
 279         switch (cmd) {
 280         case SNDRV_PCM_TRIGGER_START:
 281         case SNDRV_PCM_TRIGGER_RESUME:
 282                 au_writel(AC97PCR_CLRFIFO(stype), AC97_PCR(pscdata));
 283                 au_sync();
 284                 au_writel(AC97PCR_START(stype), AC97_PCR(pscdata));
 285                 au_sync();
 286                 break;
 287         case SNDRV_PCM_TRIGGER_STOP:
 288         case SNDRV_PCM_TRIGGER_SUSPEND:
 289                 au_writel(AC97PCR_STOP(stype), AC97_PCR(pscdata));
 290                 au_sync();
 291
 292                 while (au_readl(AC97_STAT(pscdata)) & AC97STAT_BUSY(stype))
 293                         asm volatile ("nop");
 294
 295                 au_writel(AC97PCR_CLRFIFO(stype), AC97_PCR(pscdata));
 296                 au_sync();
 297
 298                 break;
 299         default:
 300                 ret = -EINVAL;
 301         }
 302         return ret;
 303 }
 304
 305 static int au1xpsc_ac97_probe(struct platform_device *pdev,
 306                               struct snd_soc_dai *dai)
 307 {
 308         int ret;
 309         struct resource *r;
 310         unsigned long sel;
 311
 312         if (au1xpsc_ac97_workdata)
 313                 return -EBUSY;
 314
 315         au1xpsc_ac97_workdata =
 316                 kzalloc(sizeof(struct au1xpsc_audio_data), GFP_KERNEL);
 317         if (!au1xpsc_ac97_workdata)
 318                 return -ENOMEM;
 319
 320         mutex_init(&au1xpsc_ac97_workdata->lock);
 321
 322         r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 323         if (!r) {
 324                 ret = -ENODEV;
 325                 goto out0;
 326         }
 327
 328         ret = -EBUSY;
 329         au1xpsc_ac97_workdata->ioarea =
 330                 request_mem_region(r->start, r->end - r->start + 1,
 331                                         "au1xpsc_ac97");
 332         if (!au1xpsc_ac97_workdata->ioarea)
 333                 goto out0;
 334
 335         au1xpsc_ac97_workdata->mmio = ioremap(r->start, 0xffff);
 336         if (!au1xpsc_ac97_workdata->mmio)
 337                 goto out1;
 338
 339         /* configuration: max dma trigger threshold, enable ac97 */
 340         au1xpsc_ac97_workdata->cfg = PSC_AC97CFG_RT_FIFO8 |
 341                                      PSC_AC97CFG_TT_FIFO8 |
 342                                      PSC_AC97CFG_DE_ENABLE;
 343
 344         /* preserve PSC clock source set up by platform (dev.platform_data
 345          * is already occupied by soc layer)
 346          */
 347         sel = au_readl(PSC_SEL(au1xpsc_ac97_workdata)) & PSC_SEL_CLK_MASK;
 348         au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_ac97_workdata));
 349         au_sync();
 350         au_writel(0, PSC_SEL(au1xpsc_ac97_workdata));
 351         au_sync();
 352         au_writel(PSC_SEL_PS_AC97MODE | sel, PSC_SEL(au1xpsc_ac97_workdata));
 353         au_sync();
 354         /* next up: cold reset.  Dont check for PSC-ready now since
 355          * there may not be any codec clock yet.
 356          */
 357
 358         return 0;
 359
 360 out1:
 361         release_resource(au1xpsc_ac97_workdata->ioarea);
 362         kfree(au1xpsc_ac97_workdata->ioarea);
 363 out0:
 364         kfree(au1xpsc_ac97_workdata);
 365         au1xpsc_ac97_workdata = NULL;
 366         return ret;
 367 }
 368
 369 static void au1xpsc_ac97_remove(struct platform_device *pdev,
 370                                 struct snd_soc_dai *dai)
 371 {
 372         /* disable PSC completely */
 373         au_writel(0, AC97_CFG(au1xpsc_ac97_workdata));
 374         au_sync();
 375         au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_ac97_workdata));
 376         au_sync();
 377
 378         iounmap(au1xpsc_ac97_workdata->mmio);
 379         release_resource(au1xpsc_ac97_workdata->ioarea);
 380         kfree(au1xpsc_ac97_workdata->ioarea);
 381         kfree(au1xpsc_ac97_workdata);
 382         au1xpsc_ac97_workdata = NULL;
 383 }
 384
 385 static int au1xpsc_ac97_suspend(struct snd_soc_dai *dai)
 386 {
 387         /* save interesting registers and disable PSC */
 388         au1xpsc_ac97_workdata->pm[0] =
 389                         au_readl(PSC_SEL(au1xpsc_ac97_workdata));
 390
 391         au_writel(0, AC97_CFG(au1xpsc_ac97_workdata));
 392         au_sync();
 393         au_writel(PSC_CTRL_DISABLE, PSC_CTRL(au1xpsc_ac97_workdata));
 394         au_sync();
 395
 396         return 0;
 397 }
 398
 399 static int au1xpsc_ac97_resume(struct snd_soc_dai *dai)
 400 {
 401         /* restore PSC clock config */
 402         au_writel(au1xpsc_ac97_workdata->pm[0] | PSC_SEL_PS_AC97MODE,
 403                         PSC_SEL(au1xpsc_ac97_workdata));
 404         au_sync();
 405
 406         /* after this point the ac97 core will cold-reset the codec.
 407          * During cold-reset the PSC is reinitialized and the last
 408          * configuration set up in hw_params() is restored.
 409          */
 410         return 0;
 411 }
 412
 413 static struct snd_soc_dai_ops au1xpsc_ac97_dai_ops = {
 414         .trigger        = au1xpsc_ac97_trigger,
 415         .hw_params      = au1xpsc_ac97_hw_params,
 416 };
 417
 418 struct snd_soc_dai au1xpsc_ac97_dai = {
 419         .name                   = "au1xpsc_ac97",
 420         .ac97_control           = 1,
 421         .probe                  = au1xpsc_ac97_probe,
 422         .remove                 = au1xpsc_ac97_remove,
 423         .suspend                = au1xpsc_ac97_suspend,
 424         .resume                 = au1xpsc_ac97_resume,
 425         .playback = {
 426                 .rates          = AC97_RATES,
 427                 .formats        = AC97_FMTS,
 428                 .channels_min   = 2,
 429                 .channels_max   = 2,
 430         },
 431         .capture = {
 432                 .rates          = AC97_RATES,
 433                 .formats        = AC97_FMTS,
 434                 .channels_min   = 2,
 435                 .channels_max   = 2,
 436         },
 437         .ops = &au1xpsc_ac97_dai_ops,
 438 };
 439 EXPORT_SYMBOL_GPL(au1xpsc_ac97_dai);
 440
 441 static int __init au1xpsc_ac97_init(void)
 442 {
 443         au1xpsc_ac97_workdata = NULL;
 444         return snd_soc_register_dai(&au1xpsc_ac97_dai);
 445 }
 446
 447 static void __exit au1xpsc_ac97_exit(void)
 448 {
 449         snd_soc_unregister_dai(&au1xpsc_ac97_dai);
 450 }
 451
 452 module_init(au1xpsc_ac97_init);
 453 module_exit(au1xpsc_ac97_exit);
 454
 455 MODULE_LICENSE("GPL");
 456 MODULE_DESCRIPTION("Au12x0/Au1550 PSC AC97 ALSA ASoC audio driver");
 457 MODULE_AUTHOR("Manuel Lauss <manuel.lauss@gmail.com>");