text: /*
   * wm8728.c  --  WM8728 ALSA SoC Audio driver
   *
   * Copyright 2008 Wolfson Microelectronics plc
   *
   * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   */
  
  #include <linux/module.h>
  #include <linux/moduleparam.h>
  #include <linux/init.h>
  #include <linux/delay.h>
  #include <linux/pm.h>
  #include <linux/i2c.h>
  #include <linux/platform_device.h>
  #include <linux/regmap.h>
  #include <linux/spi/spi.h>
  #include <linux/slab.h>
  #include <linux/of_device.h>
  #include <sound/core.h>
  #include <sound/pcm.h>
  #include <sound/pcm_params.h>
  #include <sound/soc.h>
  #include <sound/initval.h>
  #include <sound/tlv.h>
  
  #include "wm8728.h"
  
  /*
   * We can't read the WM8728 register space so we cache them instead.
   * Note that the defaults here aren't the physical defaults, we latch
   * the volume update bits, mute the output and enable infinite zero
   * detect.
   */
  static const struct reg_default wm8728_reg_defaults[] = {
  	{ 0, 0x1ff },
  	{ 1, 0x1ff },
  	{ 2, 0x001 },
  	{ 3, 0x100 },
  };
  
  /* codec private data */
  struct wm8728_priv {
  	struct regmap *regmap;
  };
  
  static const DECLARE_TLV_DB_SCALE(wm8728_tlv, -12750, 50, 1);
  
  static const struct snd_kcontrol_new wm8728_snd_controls[] = {
  
  SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8728_DACLVOL, WM8728_DACRVOL,
  		 0, 255, 0, wm8728_tlv),
  
  SOC_SINGLE("Deemphasis", WM8728_DACCTL, 1, 1, 0),
  };
  
  /*
   * DAPM controls.
   */
  static const struct snd_soc_dapm_widget wm8728_dapm_widgets[] = {
  SND_SOC_DAPM_DAC("DAC", "HiFi Playback", SND_SOC_NOPM, 0, 0),
  SND_SOC_DAPM_OUTPUT("VOUTL"),
  SND_SOC_DAPM_OUTPUT("VOUTR"),
  };
  
  static const struct snd_soc_dapm_route wm8728_intercon[] = {
  	{"VOUTL", NULL, "DAC"},
  	{"VOUTR", NULL, "DAC"},
  };
  
  static int wm8728_mute(struct snd_soc_dai *dai, int mute)
  {
  	struct snd_soc_codec *codec = dai->codec;
  	u16 mute_reg = snd_soc_read(codec, WM8728_DACCTL);
  
  	if (mute)
  		snd_soc_write(codec, WM8728_DACCTL, mute_reg | 1);
  	else
  		snd_soc_write(codec, WM8728_DACCTL, mute_reg & ~1);
  
  	return 0;
  }
  
  static int wm8728_hw_params(struct snd_pcm_substream *substream,
  	struct snd_pcm_hw_params *params,
  	struct snd_soc_dai *dai)
  {
  	struct snd_soc_codec *codec = dai->codec;
  	u16 dac = snd_soc_read(codec, WM8728_DACCTL);
  
  	dac &= ~0x18;
  
  	switch (params_format(params)) {
  	case SNDRV_PCM_FORMAT_S16_LE:
  		break;
  	case SNDRV_PCM_FORMAT_S20_3LE:
  		dac |= 0x10;
  		break;
  	case SNDRV_PCM_FORMAT_S24_LE:
  		dac |= 0x08;
  		break;
  	default:
  		return -EINVAL;
  	}
  
  	snd_soc_write(codec, WM8728_DACCTL, dac);
  
  	return 0;
  }
  
  static int wm8728_set_dai_fmt(struct snd_soc_dai *codec_dai,
  		unsigned int fmt)
  {
  	struct snd_soc_codec *codec = codec_dai->codec;
  	u16 iface = snd_soc_read(codec, WM8728_IFCTL);
  
  	/* Currently only I2S is supported by the driver, though the
  	 * hardware is more flexible.
  	 */
  	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  	case SND_SOC_DAIFMT_I2S:
  		iface |= 1;
  		break;
  	default:
  		return -EINVAL;
  	}
  
  	/* The hardware only support full slave mode */
  	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  	case SND_SOC_DAIFMT_CBS_CFS:
  		break;
  	default:
  		return -EINVAL;
  	}
  
  	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  	case SND_SOC_DAIFMT_NB_NF:
  		iface &= ~0x22;
  		break;
  	case SND_SOC_DAIFMT_IB_NF:
  		iface |=  0x20;
  		iface &= ~0x02;
  		break;
  	case SND_SOC_DAIFMT_NB_IF:
  		iface |= 0x02;
  		iface &= ~0x20;
  		break;
  	case SND_SOC_DAIFMT_IB_IF:
  		iface |= 0x22;
  		break;
  	default:
  		return -EINVAL;
  	}
  
  	snd_soc_write(codec, WM8728_IFCTL, iface);
  	return 0;
  }
  
  static int wm8728_set_bias_level(struct snd_soc_codec *codec,
  				 enum snd_soc_bias_level level)
  {
  	struct wm8728_priv *wm8728 = snd_soc_codec_get_drvdata(codec);
  	u16 reg;
  
  	switch (level) {
  	case SND_SOC_BIAS_ON:
  	case SND_SOC_BIAS_PREPARE:
  	case SND_SOC_BIAS_STANDBY:
  		if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
  			/* Power everything up... */
  			reg = snd_soc_read(codec, WM8728_DACCTL);
  			snd_soc_write(codec, WM8728_DACCTL, reg & ~0x4);
  
  			/* ..then sync in the register cache. */
  			regcache_sync(wm8728->regmap);
  		}
  		break;
  
  	case SND_SOC_BIAS_OFF:
  		reg = snd_soc_read(codec, WM8728_DACCTL);
  		snd_soc_write(codec, WM8728_DACCTL, reg | 0x4);
  		break;
  	}
  	codec->dapm.bias_level = level;
  	return 0;
  }
  
  #define WM8728_RATES (SNDRV_PCM_RATE_8000_192000)
  
  #define WM8728_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
  	SNDRV_PCM_FMTBIT_S24_LE)
  
  static const struct snd_soc_dai_ops wm8728_dai_ops = {
  	.hw_params	= wm8728_hw_params,
  	.digital_mute	= wm8728_mute,
  	.set_fmt	= wm8728_set_dai_fmt,
  };
  
  static struct snd_soc_dai_driver wm8728_dai = {
  	.name = "wm8728-hifi",
  	.playback = {
  		.stream_name = "Playback",
  		.channels_min = 2,
  		.channels_max = 2,
  		.rates = WM8728_RATES,
  		.formats = WM8728_FORMATS,
  	},
  	.ops = &wm8728_dai_ops,
  };
  
  static int wm8728_suspend(struct snd_soc_codec *codec)
  {
  	wm8728_set_bias_level(codec, SND_SOC_BIAS_OFF);
  
  	return 0;
  }
  
  static int wm8728_resume(struct snd_soc_codec *codec)
  {
  	wm8728_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  
  	return 0;
  }
  
  static int wm8728_probe(struct snd_soc_codec *codec)
  {
  	int ret;
  
  	ret = snd_soc_codec_set_cache_io(codec, 7, 9, SND_SOC_REGMAP);
  	if (ret < 0) {
  		printk(KERN_ERR "wm8728: failed to configure cache I/O: %d\n",
  		       ret);
  		return ret;
  	}
  
  	/* power on device */
  	wm8728_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  
  	return ret;
  }
  
  static int wm8728_remove(struct snd_soc_codec *codec)
  {
  	wm8728_set_bias_level(codec, SND_SOC_BIAS_OFF);
  	return 0;
  }
  
  static struct snd_soc_codec_driver soc_codec_dev_wm8728 = {
  	.probe =	wm8728_probe,
  	.remove =	wm8728_remove,
  	.suspend =	wm8728_suspend,
  	.resume =	wm8728_resume,
  	.set_bias_level = wm8728_set_bias_level,
  	.controls = wm8728_snd_controls,
  	.num_controls = ARRAY_SIZE(wm8728_snd_controls),
  	.dapm_widgets = wm8728_dapm_widgets,
  	.num_dapm_widgets = ARRAY_SIZE(wm8728_dapm_widgets),
  	.dapm_routes = wm8728_intercon,
  	.num_dapm_routes = ARRAY_SIZE(wm8728_intercon),
  };
  
  static const struct of_device_id wm8728_of_match[] = {
  	{ .compatible = "wlf,wm8728", },
  	{ }
  };
  MODULE_DEVICE_TABLE(of, wm8728_of_match);
  
  static const struct regmap_config wm8728_regmap = {
  	.reg_bits = 7,
  	.val_bits = 9,
  	.max_register = WM8728_IFCTL,
  
  	.reg_defaults = wm8728_reg_defaults,
  	.num_reg_defaults = ARRAY_SIZE(wm8728_reg_defaults),
  	.cache_type = REGCACHE_RBTREE,
  };
  
  #if defined(CONFIG_SPI_MASTER)
  static int wm8728_spi_probe(struct spi_device *spi)
  {
  	struct wm8728_priv *wm8728;
  	int ret;
  
  	wm8728 = devm_kzalloc(&spi->dev, sizeof(struct wm8728_priv),
  			      GFP_KERNEL);
  	if (wm8728 == NULL)
  		return -ENOMEM;
  
  	wm8728->regmap = devm_regmap_init_spi(spi, &wm8728_regmap);
  	if (IS_ERR(wm8728->regmap))
  		return PTR_ERR(wm8728->regmap);
  
  	spi_set_drvdata(spi, wm8728);
  
  	ret = snd_soc_register_codec(&spi->dev,
  			&soc_codec_dev_wm8728, &wm8728_dai, 1);
  
  	return ret;
  }
  
  static int wm8728_spi_remove(struct spi_device *spi)
  {
  	snd_soc_unregister_codec(&spi->dev);
  
  	return 0;
  }
  
  static struct spi_driver wm8728_spi_driver = {
  	.driver = {
  		.name	= "wm8728",
  		.owner	= THIS_MODULE,
  		.of_match_table = wm8728_of_match,
  	},
  	.probe		= wm8728_spi_probe,
  	.remove		= wm8728_spi_remove,
  };
  #endif /* CONFIG_SPI_MASTER */
  
  #if IS_ENABLED(CONFIG_I2C)
  static int wm8728_i2c_probe(struct i2c_client *i2c,
  			    const struct i2c_device_id *id)
  {
  	struct wm8728_priv *wm8728;
  	int ret;
  
  	wm8728 = devm_kzalloc(&i2c->dev, sizeof(struct wm8728_priv),
  			      GFP_KERNEL);
  	if (wm8728 == NULL)
  		return -ENOMEM;
  
  	wm8728->regmap = devm_regmap_init_i2c(i2c, &wm8728_regmap);
  	if (IS_ERR(wm8728->regmap))
  		return PTR_ERR(wm8728->regmap);
  
  	i2c_set_clientdata(i2c, wm8728);
  
  	ret =  snd_soc_register_codec(&i2c->dev,
  			&soc_codec_dev_wm8728, &wm8728_dai, 1);
  
  	return ret;
  }
  
  static int wm8728_i2c_remove(struct i2c_client *client)
  {
  	snd_soc_unregister_codec(&client->dev);
  	return 0;
  }
  
  static const struct i2c_device_id wm8728_i2c_id[] = {
  	{ "wm8728", 0 },
  	{ }
  };
  MODULE_DEVICE_TABLE(i2c, wm8728_i2c_id);
  
  static struct i2c_driver wm8728_i2c_driver = {
  	.driver = {
  		.name = "wm8728",
  		.owner = THIS_MODULE,
  		.of_match_table = wm8728_of_match,
  	},
  	.probe =    wm8728_i2c_probe,
  	.remove =   wm8728_i2c_remove,
  	.id_table = wm8728_i2c_id,
  };
  #endif
  
  static int __init wm8728_modinit(void)
  {
  	int ret = 0;
  #if IS_ENABLED(CONFIG_I2C)
  	ret = i2c_add_driver(&wm8728_i2c_driver);
  	if (ret != 0) {
  		printk(KERN_ERR "Failed to register wm8728 I2C driver: %d\n",
  		       ret);
  	}
  #endif
  #if defined(CONFIG_SPI_MASTER)
  	ret = spi_register_driver(&wm8728_spi_driver);
  	if (ret != 0) {
  		printk(KERN_ERR "Failed to register wm8728 SPI driver: %d\n",
  		       ret);
  	}
  #endif
  	return ret;
  }
  module_init(wm8728_modinit);
  
  static void __exit wm8728_exit(void)
  {
  #if IS_ENABLED(CONFIG_I2C)
  	i2c_del_driver(&wm8728_i2c_driver);
  #endif
  #if defined(CONFIG_SPI_MASTER)
  	spi_unregister_driver(&wm8728_spi_driver);
  #endif
  }
  module_exit(wm8728_exit);
  
  MODULE_DESCRIPTION("ASoC WM8728 driver");
  MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
  MODULE_LICENSE("GPL");
  