[ALSA] PM support for cs5535audio

Appended is my patch adding PM support to the cs5535audio driver.
I also added the ac97 quirk but it's not yet confirmed which
boards need to be in the quirk list. The patch also includes some
Kconfig and misc cleanup.

Signed-off-by: Jaya Kumar <jayakumar.alsa@gmail.com>
Signed-off-by: Takashi Iwai <tiwai@suse.de>

5 files changed, 184 insertions, 6 deletions

diff --git a/sound/pci/cs5535audio/Makefile b/sound/pci/cs5535audio/Makefile
index 08d8ee6547d..2911a8adc1f 100644
--- a/sound/pci/cs5535audio/Makefile
+++ b/sound/pci/cs5535audio/Makefile
@@ -4,5 +4,9 @@
 
 snd-cs5535audio-objs := cs5535audio.o cs5535audio_pcm.o
 
+ifdef CONFIG_PM
+snd-cs5535audio-objs += cs5535audio_pm.o
+endif
+
 # Toplevel Module Dependency
 obj-$(CONFIG_SND_CS5535AUDIO) += snd-cs5535audio.o
diff --git a/sound/pci/cs5535audio/cs5535audio.c b/sound/pci/cs5535audio/cs5535audio.c
index 2c1213a35dc..41f02f05dfd 100644
--- a/sound/pci/cs5535audio/cs5535audio.c
+++ b/sound/pci/cs5535audio/cs5535audio.c
@@ -1,5 +1,5 @@
 /*
- * Driver for audio on multifunction CS5535 companion device
+ * Driver for audio on multifunction CS5535/6 companion device
  * Copyright (C) Jaya Kumar
  *
  * Based on Jaroslav Kysela and Takashi Iwai's examples.
@@ -40,16 +40,29 @@
 
 #define DRIVER_NAME "cs5535audio"
 
+static char *ac97_quirk;
+module_param(ac97_quirk, charp, 0444);
+MODULE_PARM_DESC(ac97_quirk, "AC'97 board specific workarounds.");
+
+static struct ac97_quirk ac97_quirks[] __devinitdata = {
+#if 0 /* Not yet confirmed if all 5536 boards are HP only */
+        {
+                .subvendor = PCI_VENDOR_ID_AMD, 
+                .subdevice = PCI_DEVICE_ID_AMD_CS5536_AUDIO, 
+                .name = "AMD RDK",     
+                .type = AC97_TUNE_HP_ONLY
+        },
+#endif
+        {}
+};
 
 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
 
 static struct pci_device_id snd_cs5535audio_ids[] __devinitdata = {
-        { PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_CS5535_AUDIO,
-          PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },
-        { PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_CS5536_AUDIO,
-          PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0, },
+        { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_CS5535_AUDIO) },
+        { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_CS5536_AUDIO) },
         {}
 };
 
@@ -148,6 +161,8 @@ static int snd_cs5535audio_mixer(struct cs5535audio *cs5535au)
                 return err;
         }
 
+        snd_ac97_tune_hardware(cs5535au->ac97, ac97_quirks, ac97_quirk);
+
         return 0;
 }
 
@@ -347,6 +362,8 @@ static int __devinit snd_cs5535audio_probe(struct pci_dev *pci,
         if ((err = snd_cs5535audio_create(card, pci, &cs5535au)) < 0)
                 goto probefail_out;
 
+        card->private_data = cs5535au;
+
         if ((err = snd_cs5535audio_mixer(cs5535au)) < 0)
                 goto probefail_out;
 
@@ -383,6 +400,10 @@ static struct pci_driver driver = {
         .id_table = snd_cs5535audio_ids,
         .probe = snd_cs5535audio_probe,
         .remove = __devexit_p(snd_cs5535audio_remove),
+#ifdef CONFIG_PM
+        .suspend = snd_cs5535audio_suspend,
+        .resume = snd_cs5535audio_resume,
+#endif
 };
 
 static int __init alsa_card_cs5535audio_init(void)
diff --git a/sound/pci/cs5535audio/cs5535audio.h b/sound/pci/cs5535audio/cs5535audio.h
index 5e55a1a1ed6..4fd1f31a6cf 100644
--- a/sound/pci/cs5535audio/cs5535audio.h
+++ b/sound/pci/cs5535audio/cs5535audio.h
@@ -74,6 +74,8 @@
 #define PRM_RDY_STS                     0x00800000
 #define ACC_CODEC_CNTL_WR_CMD           (~0x80000000)
 #define ACC_CODEC_CNTL_RD_CMD           0x80000000
+#define ACC_CODEC_CNTL_LNK_SHUTDOWN     0x00040000
+#define ACC_CODEC_CNTL_LNK_WRM_RST      0x00020000
 #define PRD_JMP                         0x2000
 #define PRD_EOP                         0x4000
 #define PRD_EOT                         0x8000
@@ -88,6 +90,7 @@ struct cs5535audio_dma_ops {
         void (*disable_dma)(struct cs5535audio *cs5535au);
         void (*pause_dma)(struct cs5535audio *cs5535au);
         void (*setup_prd)(struct cs5535audio *cs5535au, u32 prd_addr);
+        u32 (*read_prd)(struct cs5535audio *cs5535au);
         u32 (*read_dma_pntr)(struct cs5535audio *cs5535au);
 };
 
@@ -103,11 +106,14 @@ struct cs5535audio_dma {
         struct snd_pcm_substream *substream;
         unsigned int buf_addr, buf_bytes;
         unsigned int period_bytes, periods;
+        int suspended;
+        u32 saved_prd;
 };
 
 struct cs5535audio {
         struct snd_card *card;
         struct snd_ac97 *ac97;
+        struct snd_pcm *pcm;
         int irq;
         struct pci_dev *pci;
         unsigned long port;
@@ -117,6 +123,8 @@ struct cs5535audio {
         struct cs5535audio_dma dmas[NUM_CS5535AUDIO_DMAS];
 };
 
+int snd_cs5535audio_suspend(struct pci_dev *pci, pm_message_t state);
+int snd_cs5535audio_resume(struct pci_dev *pci);
 int __devinit snd_cs5535audio_pcm(struct cs5535audio *cs5535audio);
 
 #endif /* __SOUND_CS5535AUDIO_H */
diff --git a/sound/pci/cs5535audio/cs5535audio_pcm.c b/sound/pci/cs5535audio/cs5535audio_pcm.c
index 60bb82b2ff4..f0a48693d68 100644
--- a/sound/pci/cs5535audio/cs5535audio_pcm.c
+++ b/sound/pci/cs5535audio/cs5535audio_pcm.c
@@ -43,7 +43,8 @@ static struct snd_pcm_hardware snd_cs5535audio_playback =
                                 SNDRV_PCM_INFO_BLOCK_TRANSFER |
                                 SNDRV_PCM_INFO_MMAP_VALID |
                                 SNDRV_PCM_INFO_PAUSE |
-                                SNDRV_PCM_INFO_SYNC_START
+                                SNDRV_PCM_INFO_SYNC_START |
+                                SNDRV_PCM_INFO_RESUME
                                 ),
         .formats =              (
                                 SNDRV_PCM_FMTBIT_S16_LE
@@ -193,6 +194,11 @@ static void cs5535audio_playback_setup_prd(struct cs5535audio *cs5535au,
         cs_writel(cs5535au, ACC_BM0_PRD, prd_addr);
 }
 
+static u32 cs5535audio_playback_read_prd(struct cs5535audio *cs5535au)
+{
+        return cs_readl(cs5535au, ACC_BM0_PRD);
+}
+
 static u32 cs5535audio_playback_read_dma_pntr(struct cs5535audio *cs5535au)
 {
         return cs_readl(cs5535au, ACC_BM0_PNTR);
@@ -219,6 +225,11 @@ static void cs5535audio_capture_setup_prd(struct cs5535audio *cs5535au,
         cs_writel(cs5535au, ACC_BM1_PRD, prd_addr);
 }
 
+static u32 cs5535audio_capture_read_prd(struct cs5535audio *cs5535au)
+{
+        return cs_readl(cs5535au, ACC_BM1_PRD);
+}
+
 static u32 cs5535audio_capture_read_dma_pntr(struct cs5535audio *cs5535au)
 {
         return cs_readl(cs5535au, ACC_BM1_PNTR);
@@ -285,9 +296,17 @@ static int snd_cs5535audio_trigger(struct snd_pcm_substream *substream, int cmd)
         case SNDRV_PCM_TRIGGER_START:
                 dma->ops->enable_dma(cs5535au);
                 break;
+        case SNDRV_PCM_TRIGGER_RESUME:
+                dma->ops->enable_dma(cs5535au);
+                dma->suspended = 0;
+                break;
         case SNDRV_PCM_TRIGGER_STOP:
                 dma->ops->disable_dma(cs5535au);
                 break;
+        case SNDRV_PCM_TRIGGER_SUSPEND:
+                dma->ops->disable_dma(cs5535au);
+                dma->suspended = 1;
+                break;
         default:
                 snd_printk(KERN_ERR "unhandled trigger\n");
                 err = -EINVAL;
@@ -375,6 +394,7 @@ static struct cs5535audio_dma_ops snd_cs5535audio_playback_dma_ops = {
         .enable_dma = cs5535audio_playback_enable_dma,
         .disable_dma = cs5535audio_playback_disable_dma,
         .setup_prd = cs5535audio_playback_setup_prd,
+        .read_prd = cs5535audio_playback_read_prd,
         .pause_dma = cs5535audio_playback_pause_dma,
         .read_dma_pntr = cs5535audio_playback_read_dma_pntr,
 };
@@ -384,6 +404,7 @@ static struct cs5535audio_dma_ops snd_cs5535audio_capture_dma_ops = {
         .enable_dma = cs5535audio_capture_enable_dma,
         .disable_dma = cs5535audio_capture_disable_dma,
         .setup_prd = cs5535audio_capture_setup_prd,
+        .read_prd = cs5535audio_capture_read_prd,
         .pause_dma = cs5535audio_capture_pause_dma,
         .read_dma_pntr = cs5535audio_capture_read_dma_pntr,
 };
@@ -413,6 +434,7 @@ int __devinit snd_cs5535audio_pcm(struct cs5535audio *cs5535au)
         snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
                                         snd_dma_pci_data(cs5535au->pci),
                                         64*1024, 128*1024);
+        cs5535au->pcm = pcm;
 
         return 0;
 }
diff --git a/sound/pci/cs5535audio/cs5535audio_pm.c b/sound/pci/cs5535audio/cs5535audio_pm.c
new file mode 100644
index 00000000000..aad0e69db9c
--- /dev/null
+++ b/sound/pci/cs5535audio/cs5535audio_pm.c
@@ -0,0 +1,123 @@
+/*
+ * Power management for audio on multifunction CS5535 companion device
+ * Copyright (C) Jaya Kumar
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
+ *
+ */
+
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/pci.h>
+#include <linux/delay.h>
+#include <sound/driver.h>
+#include <sound/core.h>
+#include <sound/control.h>
+#include <sound/initval.h>
+#include <sound/asoundef.h>
+#include <sound/pcm.h>
+#include <sound/ac97_codec.h>
+#include "cs5535audio.h"
+
+static void snd_cs5535audio_stop_hardware(struct cs5535audio *cs5535au)
+{
+        /* 
+        we depend on snd_ac97_suspend to tell the
+        AC97 codec to shutdown. the amd spec suggests
+        that the LNK_SHUTDOWN be done at the same time
+        that the codec power-down is issued. instead,
+        we do it just after rather than at the same 
+        time. excluding codec specific build_ops->suspend
+        ac97 powerdown hits:
+        0x8000 EAPD 
+        0x4000 Headphone amplifier 
+        0x0300 ADC & DAC 
+        0x0400 Analog Mixer powerdown (Vref on) 
+        I am not sure if this is the best that we can do.
+        The remainder to be investigated are:
+        - analog mixer (vref off) 0x0800
+        - AC-link powerdown 0x1000
+        - codec internal clock 0x2000
+        */
+
+        /* set LNK_SHUTDOWN to shutdown AC link */
+        cs_writel(cs5535au, ACC_CODEC_CNTL, ACC_CODEC_CNTL_LNK_SHUTDOWN);
+
+}
+
+int snd_cs5535audio_suspend(struct pci_dev *pci, pm_message_t state)
+{
+        struct snd_card *card = pci_get_drvdata(pci);
+        struct cs5535audio *cs5535au = card->private_data;
+        int i;
+
+        snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
+        for (i = 0; i < NUM_CS5535AUDIO_DMAS; i++) {
+                struct cs5535audio_dma *dma = &cs5535au->dmas[i];
+                if (dma && dma->substream && !dma->suspended) 
+                        dma->saved_prd = dma->ops->read_prd(cs5535au);
+        }
+        snd_pcm_suspend_all(cs5535au->pcm);
+        snd_ac97_suspend(cs5535au->ac97);
+        /* save important regs, then disable aclink in hw */
+        snd_cs5535audio_stop_hardware(cs5535au);
+        pci_disable_device(pci);
+        pci_save_state(pci);
+
+        return 0;
+}
+
+int snd_cs5535audio_resume(struct pci_dev *pci)
+{
+        struct snd_card *card = pci_get_drvdata(pci);
+        struct cs5535audio *cs5535au = card->private_data;
+        u32 tmp;
+        int timeout;
+        int i;
+
+        pci_restore_state(pci);
+        pci_enable_device(pci);
+        pci_set_master(pci);
+
+        /* set LNK_WRM_RST to reset AC link */
+        cs_writel(cs5535au, ACC_CODEC_CNTL, ACC_CODEC_CNTL_LNK_WRM_RST);
+
+        timeout = 50;
+        do {
+                tmp = cs_readl(cs5535au, ACC_CODEC_STATUS);
+                if (tmp & PRM_RDY_STS)
+                        break;
+                udelay(1);
+        } while (--timeout);
+
+        if (!timeout)
+                snd_printk(KERN_ERR "Failure getting AC Link ready\n");
+
+        /* we depend on ac97 to perform the codec power up */
+        snd_ac97_resume(cs5535au->ac97);
+        /* set up rate regs, dma. actual initiation is done in trig */
+        for (i = 0; i < NUM_CS5535AUDIO_DMAS; i++) {
+                struct cs5535audio_dma *dma = &cs5535au->dmas[i];
+                if (dma && dma->substream && dma->suspended) {
+                        dma->substream->ops->prepare(dma->substream);
+                        dma->ops->setup_prd(cs5535au, dma->saved_prd);
+                }
+        }
+                
+        snd_power_change_state(card, SNDRV_CTL_POWER_D0);
+
+        return 0;
+}
+