Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit b1e9ed26 authored by Takashi Iwai's avatar Takashi Iwai Committed by Jaroslav Kysela
Browse files

[ALSA] fm801 - Add PM support 



Modules: FM801 driver

Add PM support to fm801 driver.

Signed-off-by: default avatarTakashi Iwai <tiwai@suse.de>
parent 09668b44

sound/pci/fm801.c

+158 −87
Original line number Diff line number Diff line
@@ -103,7 +103,11 @@ MODULE_PARM_DESC(tea575x_tuner, "Enable TEA575x tuner."); 
#define FM801_OPL3_DATA1	0x6b	/* OPL3 Bank 1 Write */

#define FM801_POWERDOWN		0x70	/* Blocks Power Down Control */



#define FM801_AC97_ADDR_SHIFT	10

/* codec access */

#define FM801_AC97_READ		(1<<7)	/* read=1, write=0 */

#define FM801_AC97_VALID	(1<<8)	/* port valid=1 */

#define FM801_AC97_BUSY		(1<<9)	/* busy=1 */

#define FM801_AC97_ADDR_SHIFT	10	/* codec id (2bit) */



/* playback and record control register bits */

#define FM801_BUF1_LAST		(1<<1)
@@ -189,6 +193,10 @@ struct fm801 { 
#ifdef TEA575X_RADIO

	struct snd_tea575x tea;

#endif



#ifdef CONFIG_PM

	u16 saved_regs[0x20];

#endif

};



static struct pci_device_id snd_fm801_ids[] = {
@@ -231,7 +239,7 @@ static void snd_fm801_codec_write(struct snd_ac97 *ac97, 
	 *  Wait until the codec interface is not ready..

	 */

	for (idx = 0; idx < 100; idx++) {

		if (!(inw(FM801_REG(chip, AC97_CMD)) & (1<<9)))

		if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))

			goto ok1;

		udelay(10);

	}
@@ -246,7 +254,7 @@ static void snd_fm801_codec_write(struct snd_ac97 *ac97, 
	 *  Wait until the write command is not completed..

         */

	for (idx = 0; idx < 1000; idx++) {

		if (!(inw(FM801_REG(chip, AC97_CMD)) & (1<<9)))

		if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))

			return;

		udelay(10);

	}
@@ -262,7 +270,7 @@ static unsigned short snd_fm801_codec_read(struct snd_ac97 *ac97, unsigned short 
	 *  Wait until the codec interface is not ready..

	 */

	for (idx = 0; idx < 100; idx++) {

		if (!(inw(FM801_REG(chip, AC97_CMD)) & (1<<9)))

		if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))

			goto ok1;

		udelay(10);

	}
@@ -271,9 +279,10 @@ static unsigned short snd_fm801_codec_read(struct snd_ac97 *ac97, unsigned short 


 ok1:

	/* read command */

	outw(reg | (ac97->addr << FM801_AC97_ADDR_SHIFT) | (1<<7), FM801_REG(chip, AC97_CMD));

	outw(reg | (ac97->addr << FM801_AC97_ADDR_SHIFT) | FM801_AC97_READ,

	     FM801_REG(chip, AC97_CMD));

	for (idx = 0; idx < 100; idx++) {

		if (!(inw(FM801_REG(chip, AC97_CMD)) & (1<<9)))

		if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))

			goto ok2;

		udelay(10);

	}
@@ -282,7 +291,7 @@ static unsigned short snd_fm801_codec_read(struct snd_ac97 *ac97, unsigned short 


 ok2:

	for (idx = 0; idx < 1000; idx++) {

		if (inw(FM801_REG(chip, AC97_CMD)) & (1<<8))

		if (inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_VALID)

			goto ok3;

		udelay(10);

	}
@@ -354,9 +363,11 @@ static int snd_fm801_playback_trigger(struct snd_pcm_substream *substream, 
		chip->ply_ctrl &= ~(FM801_START | FM801_PAUSE);

		break;

	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:

	case SNDRV_PCM_TRIGGER_SUSPEND:

		chip->ply_ctrl |= FM801_PAUSE;

		break;

	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:

	case SNDRV_PCM_TRIGGER_RESUME:

		chip->ply_ctrl &= ~FM801_PAUSE;

		break;

	default:
@@ -387,9 +398,11 @@ static int snd_fm801_capture_trigger(struct snd_pcm_substream *substream, 
		chip->cap_ctrl &= ~(FM801_START | FM801_PAUSE);

		break;

	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:

	case SNDRV_PCM_TRIGGER_SUSPEND:

		chip->cap_ctrl |= FM801_PAUSE;

		break;

	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:

	case SNDRV_PCM_TRIGGER_RESUME:

		chip->cap_ctrl &= ~FM801_PAUSE;

		break;

	default:
@@ -557,7 +570,7 @@ static struct snd_pcm_hardware snd_fm801_playback = 
{

	.info =			(SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |

				 SNDRV_PCM_INFO_BLOCK_TRANSFER |

				 SNDRV_PCM_INFO_PAUSE |

				 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME |

				 SNDRV_PCM_INFO_MMAP_VALID),

	.formats =		SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,

	.rates =		SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_8000_48000,
@@ -577,7 +590,7 @@ static struct snd_pcm_hardware snd_fm801_capture = 
{

	.info =			(SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |

				 SNDRV_PCM_INFO_BLOCK_TRANSFER |

				 SNDRV_PCM_INFO_PAUSE |

				 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME |

				 SNDRV_PCM_INFO_MMAP_VALID),

	.formats =		SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,

	.rates =		SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_8000_48000,
@@ -1218,6 +1231,85 @@ static int __devinit snd_fm801_mixer(struct fm801 *chip) 
 *  initialization routines

 */



static int wait_for_codec(struct fm801 *chip, unsigned int codec_id,

			  unsigned short reg, unsigned long waits)

{

	unsigned long timeout = jiffies + waits;



	outw(FM801_AC97_READ | (codec_id << FM801_AC97_ADDR_SHIFT) | reg,

	     FM801_REG(chip, AC97_CMD));

	udelay(5);

	do {

		if ((inw(FM801_REG(chip, AC97_CMD)) & (FM801_AC97_VALID|FM801_AC97_BUSY))

		    == FM801_AC97_VALID)

			return 0;

		schedule_timeout_uninterruptible(1);

	} while (time_after(timeout, jiffies));

	return -EIO;

}



static int snd_fm801_chip_init(struct fm801 *chip, int resume)

{

	int id;

	unsigned short cmdw;



	/* codec cold reset + AC'97 warm reset */

	outw((1<<5) | (1<<6), FM801_REG(chip, CODEC_CTRL));

	inw(FM801_REG(chip, CODEC_CTRL)); /* flush posting data */

	udelay(100);

	outw(0, FM801_REG(chip, CODEC_CTRL));



	if (wait_for_codec(chip, 0, AC97_RESET, msecs_to_jiffies(750)) < 0) {

		snd_printk(KERN_ERR "Primary AC'97 codec not found\n");

		if (! resume)

			return -EIO;

	}



	if (chip->multichannel) {

		if (chip->secondary_addr) {

			wait_for_codec(chip, chip->secondary_addr,

				       AC97_VENDOR_ID1, msecs_to_jiffies(50));

		} else {

			/* my card has the secondary codec */

			/* at address #3, so the loop is inverted */

			for (id = 3; id > 0; id--) {

				if (! wait_for_codec(chip, id, AC97_VENDOR_ID1,

						     msecs_to_jiffies(50))) {

					cmdw = inw(FM801_REG(chip, AC97_DATA));

					if (cmdw != 0xffff && cmdw != 0) {

						chip->secondary = 1;

						chip->secondary_addr = id;

						break;

					}

				}

			}

		}



		/* the recovery phase, it seems that probing for non-existing codec might */

		/* cause timeout problems */

		wait_for_codec(chip, 0, AC97_VENDOR_ID1, msecs_to_jiffies(750));

	}



	/* init volume */

	outw(0x0808, FM801_REG(chip, PCM_VOL));

	outw(0x9f1f, FM801_REG(chip, FM_VOL));

	outw(0x8808, FM801_REG(chip, I2S_VOL));



	/* I2S control - I2S mode */

	outw(0x0003, FM801_REG(chip, I2S_MODE));



	/* interrupt setup - unmask MPU, PLAYBACK & CAPTURE */

	cmdw = inw(FM801_REG(chip, IRQ_MASK));

	cmdw &= ~0x0083;

	outw(cmdw, FM801_REG(chip, IRQ_MASK));



	/* interrupt clear */

	outw(FM801_IRQ_PLAYBACK|FM801_IRQ_CAPTURE|FM801_IRQ_MPU, FM801_REG(chip, IRQ_STATUS));



	return 0;

}





static int snd_fm801_free(struct fm801 *chip)

{

	unsigned short cmdw;
@@ -1255,9 +1347,7 @@ static int __devinit snd_fm801_create(struct snd_card *card, 
				      struct fm801 ** rchip)

{

	struct fm801 *chip;

	unsigned char rev, id;

	unsigned short cmdw;

	unsigned long timeout;

	unsigned char rev;

	int err;

	static struct snd_device_ops ops = {

		.dev_free =	snd_fm801_dev_free,
@@ -1294,81 +1384,7 @@ static int __devinit snd_fm801_create(struct snd_card *card, 
	if (rev >= 0xb1)	/* FM801-AU */

		chip->multichannel = 1;



	/* codec cold reset + AC'97 warm reset */

	outw((1<<5)|(1<<6), FM801_REG(chip, CODEC_CTRL));

	inw(FM801_REG(chip, CODEC_CTRL)); /* flush posting data */

	udelay(100);

	outw(0, FM801_REG(chip, CODEC_CTRL));



	timeout = (jiffies + (3 * HZ) / 4) + 1;		/* min 750ms */



	outw((1<<7) | (0 << FM801_AC97_ADDR_SHIFT), FM801_REG(chip, AC97_CMD));

	udelay(5);

	do {

		if ((inw(FM801_REG(chip, AC97_CMD)) & (3<<8)) == (1<<8))

			goto __ac97_secondary;

		schedule_timeout_uninterruptible(1);

	} while (time_after(timeout, jiffies));

	snd_printk(KERN_ERR "Primary AC'97 codec not found\n");

	snd_fm801_free(chip);

	return -EIO;



      __ac97_secondary:

      	if (!chip->multichannel)	/* lookup is not required */

      		goto __ac97_ok;

	for (id = 3; id > 0; id--) {	/* my card has the secondary codec */

					/* at address #3, so the loop is inverted */



		timeout = jiffies + HZ / 20;



		outw((1<<7) | (id << FM801_AC97_ADDR_SHIFT) | AC97_VENDOR_ID1,

		     FM801_REG(chip, AC97_CMD));

		udelay(5);

		do {

			if ((inw(FM801_REG(chip, AC97_CMD)) & (3<<8)) == (1<<8)) {

				cmdw = inw(FM801_REG(chip, AC97_DATA));

				if (cmdw != 0xffff && cmdw != 0) {

					chip->secondary = 1;

					chip->secondary_addr = id;

					goto __ac97_ok;

				}

			}

			schedule_timeout_uninterruptible(1);

		} while (time_after(timeout, jiffies));

	}



	/* the recovery phase, it seems that probing for non-existing codec might */

	/* cause timeout problems */

	timeout = (jiffies + (3 * HZ) / 4) + 1;		/* min 750ms */



	outw((1<<7) | (0 << FM801_AC97_ADDR_SHIFT), FM801_REG(chip, AC97_CMD));

	udelay(5);

	do {

		if ((inw(FM801_REG(chip, AC97_CMD)) & (3<<8)) == (1<<8))

			goto __ac97_ok;

		schedule_timeout_uninterruptible(1);

	} while (time_after(timeout, jiffies));

	snd_printk(KERN_ERR "Primary AC'97 codec not responding\n");

	snd_fm801_free(chip);

	return -EIO;



      __ac97_ok:



	/* init volume */

	outw(0x0808, FM801_REG(chip, PCM_VOL));

	outw(0x9f1f, FM801_REG(chip, FM_VOL));

	outw(0x8808, FM801_REG(chip, I2S_VOL));



	/* I2S control - I2S mode */

	outw(0x0003, FM801_REG(chip, I2S_MODE));



	/* interrupt setup - unmask MPU, PLAYBACK & CAPTURE */

	cmdw = inw(FM801_REG(chip, IRQ_MASK));

	cmdw &= ~0x0083;

	outw(cmdw, FM801_REG(chip, IRQ_MASK));



	/* interrupt clear */

	outw(FM801_IRQ_PLAYBACK|FM801_IRQ_CAPTURE|FM801_IRQ_MPU, FM801_REG(chip, IRQ_STATUS));

	snd_fm801_chip_init(chip, 0);



	if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) {

		snd_fm801_free(chip);
@@ -1415,6 +1431,7 @@ static int __devinit snd_card_fm801_probe(struct pci_dev *pci, 
		snd_card_free(card);

		return err;

	}

	card->private_data = chip;



	strcpy(card->driver, "FM801");

	strcpy(card->shortname, "ForteMedia FM801-");
@@ -1462,11 +1479,65 @@ static void __devexit snd_card_fm801_remove(struct pci_dev *pci) 
	pci_set_drvdata(pci, NULL);

}



#ifdef CONFIG_PM

static unsigned char saved_regs[] = {

	FM801_PCM_VOL, FM801_I2S_VOL, FM801_FM_VOL, FM801_REC_SRC,

	FM801_PLY_CTRL, FM801_PLY_COUNT, FM801_PLY_BUF1, FM801_PLY_BUF2,

	FM801_CAP_CTRL, FM801_CAP_COUNT, FM801_CAP_BUF1, FM801_CAP_BUF2,

	FM801_CODEC_CTRL, FM801_I2S_MODE, FM801_VOLUME, FM801_GEN_CTRL,

};



static int snd_fm801_suspend(struct pci_dev *pci, pm_message_t state)

{

	struct snd_card *card = pci_get_drvdata(pci);

	struct fm801 *chip = card->private_data;

	int i;



	snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);

	snd_pcm_suspend_all(chip->pcm);

	snd_ac97_suspend(chip->ac97);

	snd_ac97_suspend(chip->ac97_sec);

	for (i = 0; i < ARRAY_SIZE(saved_regs); i++)

		chip->saved_regs[i] = inw(chip->port + saved_regs[i]);

	/* FIXME: tea575x suspend */



	pci_set_power_state(pci, PCI_D3hot);

	pci_disable_device(pci);

	pci_save_state(pci);

	return 0;

}



static int snd_fm801_resume(struct pci_dev *pci)

{

	struct snd_card *card = pci_get_drvdata(pci);

	struct fm801 *chip = card->private_data;

	int i;



	pci_restore_state(pci);

	pci_enable_device(pci);

	pci_set_power_state(pci, PCI_D0);

	pci_set_master(pci);



	snd_fm801_chip_init(chip, 1);

	snd_ac97_resume(chip->ac97);

	snd_ac97_resume(chip->ac97_sec);

	for (i = 0; i < ARRAY_SIZE(saved_regs); i++)

		outw(chip->saved_regs[i], chip->port + saved_regs[i]);



	snd_power_change_state(card, SNDRV_CTL_POWER_D0);

	return 0;

}

#endif



static struct pci_driver driver = {

	.name = "FM801",

	.id_table = snd_fm801_ids,

	.probe = snd_card_fm801_probe,

	.remove = __devexit_p(snd_card_fm801_remove),

#ifdef CONFIG_PM

	.suspend = snd_fm801_suspend,

	.resume = snd_fm801_resume,

#endif

};



static int __init alsa_card_fm801_init(void)