Quelle  cs35l32.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * cs35l32.c -- CS35L32 ALSA SoC audio driver
 *
 * Copyright 2014 CirrusLogic, Inc.
 *
 * Author: Brian Austin <brian.austin@cirrus.com>
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/regmap.h>
#include <linux/slab.h>
#include <linux/platform_device.h>
#include <linux/regulator/consumer.h>
#include <linux/gpio/consumer.h>
#include <linux/of.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/soc-dapm.h>
#include <sound/initval.h>
#include <sound/tlv.h>
#include <dt-bindings/sound/cs35l32.h>

#include "cs35l32.h"
#include "cirrus_legacy.h"

#define CS35L32_NUM_SUPPLIES 2
static const char *const cs35l32_supply_names[CS35L32_NUM_SUPPLIES] = {
 "VA",
 "VP",
};

struct  cs35l32_private {
 struct regmap *regmap;
 struct snd_soc_component *component;
 struct regulator_bulk_data supplies[CS35L32_NUM_SUPPLIES];
 struct cs35l32_platform_data pdata;
 struct gpio_desc *reset_gpio;
};

static const struct reg_default cs35l32_reg_defaults[] = {

 { 0x06, 0x04 }, /* Power Ctl 1 */
 { 0x07, 0xE8 }, /* Power Ctl 2 */
 { 0x08, 0x40 }, /* Clock Ctl */
 { 0x09, 0x20 }, /* Low Battery Threshold */
 { 0x0A, 0x00 }, /* Voltage Monitor [RO] */
 { 0x0B, 0x40 }, /* Conv Peak Curr Protection CTL */
 { 0x0C, 0x07 }, /* IMON Scaling */
 { 0x0D, 0x03 }, /* Audio/LED Pwr Manager */
 { 0x0F, 0x20 }, /* Serial Port Control */
 { 0x10, 0x14 }, /* Class D Amp CTL */
 { 0x11, 0x00 }, /* Protection Release CTL */
 { 0x12, 0xFF }, /* Interrupt Mask 1 */
 { 0x13, 0xFF }, /* Interrupt Mask 2 */
 { 0x14, 0xFF }, /* Interrupt Mask 3 */
 { 0x19, 0x00 }, /* LED Flash Mode Current */
 { 0x1A, 0x00 }, /* LED Movie Mode Current */
 { 0x1B, 0x20 }, /* LED Flash Timer */
 { 0x1C, 0x00 }, /* LED Flash Inhibit Current */
};

static bool cs35l32_readable_register(struct device *dev, unsigned int reg)
{
 switch (reg) {
 case CS35L32_DEVID_AB ... CS35L32_AUDIO_LED_MNGR:
 case CS35L32_ADSP_CTL ... CS35L32_FLASH_INHIBIT:
  return true;
 default:
  return false;
 }
}

static bool cs35l32_volatile_register(struct device *dev, unsigned int reg)
{
 switch (reg) {
 case CS35L32_DEVID_AB ... CS35L32_REV_ID:
 case CS35L32_INT_STATUS_1 ... CS35L32_LED_STATUS:
  return true;
 default:
  return false;
 }
}

static bool cs35l32_precious_register(struct device *dev, unsigned int reg)
{
 switch (reg) {
 case CS35L32_INT_STATUS_1 ... CS35L32_LED_STATUS:
  return true;
 default:
  return false;
 }
}

static DECLARE_TLV_DB_SCALE(classd_ctl_tlv, 900, 300, 0);

static const struct snd_kcontrol_new imon_ctl =
 SOC_DAPM_SINGLE("Switch", CS35L32_PWRCTL2, 6, 1, 1);

static const struct snd_kcontrol_new vmon_ctl =
 SOC_DAPM_SINGLE("Switch", CS35L32_PWRCTL2, 7, 1, 1);

static const struct snd_kcontrol_new vpmon_ctl =
 SOC_DAPM_SINGLE("Switch", CS35L32_PWRCTL2, 5, 1, 1);

static const struct snd_kcontrol_new cs35l32_snd_controls[] = {
 SOC_SINGLE_TLV("Speaker Volume", CS35L32_CLASSD_CTL,
         3, 0x04, 1, classd_ctl_tlv),
 SOC_SINGLE("Zero Cross Switch", CS35L32_CLASSD_CTL, 2, 1, 0),
 SOC_SINGLE("Gain Manager Switch", CS35L32_AUDIO_LED_MNGR, 3, 1, 0),
};

static const struct snd_soc_dapm_widget cs35l32_dapm_widgets[] = {

 SND_SOC_DAPM_SUPPLY("BOOST", CS35L32_PWRCTL1, 2, 1, NULL, 0),
 SND_SOC_DAPM_OUT_DRV("Speaker", CS35L32_PWRCTL1, 7, 1, NULL, 0),

 SND_SOC_DAPM_AIF_OUT("SDOUT", NULL, 0, CS35L32_PWRCTL2, 3, 1),

 SND_SOC_DAPM_INPUT("VP"),
 SND_SOC_DAPM_INPUT("ISENSE"),
 SND_SOC_DAPM_INPUT("VSENSE"),

 SND_SOC_DAPM_SWITCH("VMON ADC", CS35L32_PWRCTL2, 7, 1, &vmon_ctl),
 SND_SOC_DAPM_SWITCH("IMON ADC", CS35L32_PWRCTL2, 6, 1, &imon_ctl),
 SND_SOC_DAPM_SWITCH("VPMON ADC", CS35L32_PWRCTL2, 5, 1, &vpmon_ctl),
};

static const struct snd_soc_dapm_route cs35l32_audio_map[] = {

 {"Speaker", NULL, "BOOST"},

 {"VMON ADC", NULL, "VSENSE"},
 {"IMON ADC", NULL, "ISENSE"},
 {"VPMON ADC", NULL, "VP"},

 {"SDOUT", "Switch", "VMON ADC"},
 {"SDOUT",  "Switch", "IMON ADC"},
 {"SDOUT", "Switch", "VPMON ADC"},

 {"Capture", NULL, "SDOUT"},
};

static int cs35l32_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
{
 struct snd_soc_component *component = codec_dai->component;

 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 case SND_SOC_DAIFMT_CBP_CFP:
  snd_soc_component_update_bits(component, CS35L32_ADSP_CTL,
        CS35L32_ADSP_MASTER_MASK,
    CS35L32_ADSP_MASTER_MASK);
  break;
 case SND_SOC_DAIFMT_CBC_CFC:
  snd_soc_component_update_bits(component, CS35L32_ADSP_CTL,
        CS35L32_ADSP_MASTER_MASK, 0);
  break;
 default:
  return -EINVAL;
 }

 return 0;
}

static int cs35l32_set_tristate(struct snd_soc_dai *dai, int tristate)
{
 struct snd_soc_component *component = dai->component;

 return snd_soc_component_update_bits(component, CS35L32_PWRCTL2,
     CS35L32_SDOUT_3ST, tristate << 3);
}

static const struct snd_soc_dai_ops cs35l32_ops = {
 .set_fmt = cs35l32_set_dai_fmt,
 .set_tristate = cs35l32_set_tristate,
};

static struct snd_soc_dai_driver cs35l32_dai[] = {
 {
  .name = "cs35l32-monitor",
  .id = 0,
  .capture = {
   .stream_name = "Capture",
   .channels_min = 2,
   .channels_max = 2,
   .rates = CS35L32_RATES,
   .formats = CS35L32_FORMATS,
  },
  .ops = &cs35l32_ops,
  .symmetric_rate = 1,
 }
};

static int cs35l32_component_set_sysclk(struct snd_soc_component *component,
         int clk_id, int source, unsigned int freq, int dir)
{
 unsigned int val;

 switch (freq) {
 case 6000000:
  val = CS35L32_MCLK_RATIO;
  break;
 case 12000000:
  val = CS35L32_MCLK_DIV2_MASK | CS35L32_MCLK_RATIO;
  break;
 case 6144000:
  val = 0;
  break;
 case 12288000:
  val = CS35L32_MCLK_DIV2_MASK;
  break;
 default:
  return -EINVAL;
 }

 return snd_soc_component_update_bits(component, CS35L32_CLK_CTL,
   CS35L32_MCLK_DIV2_MASK | CS35L32_MCLK_RATIO_MASK, val);
}

static const struct snd_soc_component_driver soc_component_dev_cs35l32 = {
 .set_sysclk  = cs35l32_component_set_sysclk,
 .controls  = cs35l32_snd_controls,
 .num_controls  = ARRAY_SIZE(cs35l32_snd_controls),
 .dapm_widgets  = cs35l32_dapm_widgets,
 .num_dapm_widgets = ARRAY_SIZE(cs35l32_dapm_widgets),
 .dapm_routes  = cs35l32_audio_map,
 .num_dapm_routes = ARRAY_SIZE(cs35l32_audio_map),
 .idle_bias_on  = 1,
 .use_pmdown_time = 1,
 .endianness  = 1,
};

/* Current and threshold powerup sequence Pg37 in datasheet */
static const struct reg_sequence cs35l32_monitor_patch[] = {

 { 0x00, 0x99 },
 { 0x48, 0x17 },
 { 0x49, 0x56 },
 { 0x43, 0x01 },
 { 0x3B, 0x62 },
 { 0x3C, 0x80 },
 { 0x00, 0x00 },
};

static const struct regmap_config cs35l32_regmap = {
 .reg_bits = 8,
 .val_bits = 8,

 .max_register = CS35L32_MAX_REGISTER,
 .reg_defaults = cs35l32_reg_defaults,
 .num_reg_defaults = ARRAY_SIZE(cs35l32_reg_defaults),
 .volatile_reg = cs35l32_volatile_register,
 .readable_reg = cs35l32_readable_register,
 .precious_reg = cs35l32_precious_register,
 .cache_type = REGCACHE_MAPLE,

 .use_single_read = true,
 .use_single_write = true,
};

static int cs35l32_handle_of_data(struct i2c_client *i2c_client,
        struct cs35l32_platform_data *pdata)
{
 struct device_node *np = i2c_client->dev.of_node;
 unsigned int val;

 if (of_property_read_u32(np, "cirrus,sdout-share", &val) >= 0)
  pdata->sdout_share = val;

 if (of_property_read_u32(np, "cirrus,boost-manager", &val))
  val = -1u;

 switch (val) {
 case CS35L32_BOOST_MGR_AUTO:
 case CS35L32_BOOST_MGR_AUTO_AUDIO:
 case CS35L32_BOOST_MGR_BYPASS:
 case CS35L32_BOOST_MGR_FIXED:
  pdata->boost_mng = val;
  break;
 case -1u:
 default:
  dev_err(&i2c_client->dev,
   "Wrong cirrus,boost-manager DT value %d\n", val);
  pdata->boost_mng = CS35L32_BOOST_MGR_BYPASS;
 }

 if (of_property_read_u32(np, "cirrus,sdout-datacfg", &val))
  val = -1u;
 switch (val) {
 case CS35L32_DATA_CFG_LR_VP:
 case CS35L32_DATA_CFG_LR_STAT:
 case CS35L32_DATA_CFG_LR:
 case CS35L32_DATA_CFG_LR_VPSTAT:
  pdata->sdout_datacfg = val;
  break;
 case -1u:
 default:
  dev_err(&i2c_client->dev,
   "Wrong cirrus,sdout-datacfg DT value %d\n", val);
  pdata->sdout_datacfg = CS35L32_DATA_CFG_LR;
 }

 if (of_property_read_u32(np, "cirrus,battery-threshold", &val))
  val = -1u;
 switch (val) {
 case CS35L32_BATT_THRESH_3_1V:
 case CS35L32_BATT_THRESH_3_2V:
 case CS35L32_BATT_THRESH_3_3V:
 case CS35L32_BATT_THRESH_3_4V:
  pdata->batt_thresh = val;
  break;
 case -1u:
 default:
  dev_err(&i2c_client->dev,
   "Wrong cirrus,battery-threshold DT value %d\n", val);
  pdata->batt_thresh = CS35L32_BATT_THRESH_3_3V;
 }

 if (of_property_read_u32(np, "cirrus,battery-recovery", &val))
  val = -1u;
 switch (val) {
 case CS35L32_BATT_RECOV_3_1V:
 case CS35L32_BATT_RECOV_3_2V:
 case CS35L32_BATT_RECOV_3_3V:
 case CS35L32_BATT_RECOV_3_4V:
 case CS35L32_BATT_RECOV_3_5V:
 case CS35L32_BATT_RECOV_3_6V:
  pdata->batt_recov = val;
  break;
 case -1u:
 default:
  dev_err(&i2c_client->dev,
   "Wrong cirrus,battery-recovery DT value %d\n", val);
  pdata->batt_recov = CS35L32_BATT_RECOV_3_4V;
 }

 return 0;
}

static int cs35l32_i2c_probe(struct i2c_client *i2c_client)
{
 struct cs35l32_private *cs35l32;
 struct cs35l32_platform_data *pdata =
  dev_get_platdata(&i2c_client->dev);
 int ret, i, devid;
 unsigned int reg;

 cs35l32 = devm_kzalloc(&i2c_client->dev, sizeof(*cs35l32), GFP_KERNEL);
 if (!cs35l32)
  return -ENOMEM;

 i2c_set_clientdata(i2c_client, cs35l32);

 cs35l32->regmap = devm_regmap_init_i2c(i2c_client, &cs35l32_regmap);
 if (IS_ERR(cs35l32->regmap)) {
  ret = PTR_ERR(cs35l32->regmap);
  dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret);
  return ret;
 }

 if (pdata) {
  cs35l32->pdata = *pdata;
 } else {
  pdata = devm_kzalloc(&i2c_client->dev, sizeof(*pdata),
         GFP_KERNEL);
  if (!pdata)
   return -ENOMEM;

  if (i2c_client->dev.of_node) {
   ret = cs35l32_handle_of_data(i2c_client,
           &cs35l32->pdata);
   if (ret != 0)
    return ret;
  }
 }

 for (i = 0; i < ARRAY_SIZE(cs35l32->supplies); i++)
  cs35l32->supplies[i].supply = cs35l32_supply_names[i];

 ret = devm_regulator_bulk_get(&i2c_client->dev,
          ARRAY_SIZE(cs35l32->supplies),
          cs35l32->supplies);
 if (ret != 0) {
  dev_err(&i2c_client->dev,
   "Failed to request supplies: %d\n", ret);
  return ret;
 }

 ret = regulator_bulk_enable(ARRAY_SIZE(cs35l32->supplies),
        cs35l32->supplies);
 if (ret != 0) {
  dev_err(&i2c_client->dev,
   "Failed to enable supplies: %d\n", ret);
  return ret;
 }

 /* Reset the Device */
 cs35l32->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev,
  "reset", GPIOD_OUT_LOW);
 if (IS_ERR(cs35l32->reset_gpio)) {
  ret = PTR_ERR(cs35l32->reset_gpio);
  goto err_supplies;
 }

 gpiod_set_value_cansleep(cs35l32->reset_gpio, 1);

 /* initialize codec */
 devid = cirrus_read_device_id(cs35l32->regmap, CS35L32_DEVID_AB);
 if (devid < 0) {
  ret = devid;
  dev_err(&i2c_client->dev, "Failed to read device ID: %d\n", ret);
  goto err_disable;
 }

 if (devid != CS35L32_CHIP_ID) {
  ret = -ENODEV;
  dev_err(&i2c_client->dev,
   "CS35L32 Device ID (%X). Expected %X\n",
   devid, CS35L32_CHIP_ID);
  goto err_disable;
 }

 ret = regmap_read(cs35l32->regmap, CS35L32_REV_ID, ®);
 if (ret < 0) {
  dev_err(&i2c_client->dev, "Get Revision ID failed\n");
  goto err_disable;
 }

 ret = regmap_register_patch(cs35l32->regmap, cs35l32_monitor_patch,
        ARRAY_SIZE(cs35l32_monitor_patch));
 if (ret < 0) {
  dev_err(&i2c_client->dev, "Failed to apply errata patch\n");
  goto err_disable;
 }

 dev_info(&i2c_client->dev,
   "Cirrus Logic CS35L32, Revision: %02X\n", reg & 0xFF);

 /* Setup VBOOST Management */
 if (cs35l32->pdata.boost_mng)
  regmap_update_bits(cs35l32->regmap, CS35L32_AUDIO_LED_MNGR,
       CS35L32_BOOST_MASK,
    cs35l32->pdata.boost_mng);

 /* Setup ADSP Format Config */
 if (cs35l32->pdata.sdout_share)
  regmap_update_bits(cs35l32->regmap, CS35L32_ADSP_CTL,
        CS35L32_ADSP_SHARE_MASK,
    cs35l32->pdata.sdout_share << 3);

 /* Setup ADSP Data Configuration */
 if (cs35l32->pdata.sdout_datacfg)
  regmap_update_bits(cs35l32->regmap, CS35L32_ADSP_CTL,
       CS35L32_ADSP_DATACFG_MASK,
    cs35l32->pdata.sdout_datacfg << 4);

 /* Setup Low Battery Recovery  */
 if (cs35l32->pdata.batt_recov)
  regmap_update_bits(cs35l32->regmap, CS35L32_BATT_THRESHOLD,
       CS35L32_BATT_REC_MASK,
    cs35l32->pdata.batt_recov << 1);

 /* Setup Low Battery Threshold */
 if (cs35l32->pdata.batt_thresh)
  regmap_update_bits(cs35l32->regmap, CS35L32_BATT_THRESHOLD,
       CS35L32_BATT_THRESH_MASK,
    cs35l32->pdata.batt_thresh << 4);

 /* Power down the AMP */
 regmap_update_bits(cs35l32->regmap, CS35L32_PWRCTL1, CS35L32_PDN_AMP,
       CS35L32_PDN_AMP);

 /* Clear MCLK Error Bit since we don't have the clock yet */
 regmap_read(cs35l32->regmap, CS35L32_INT_STATUS_1, ®);

 ret = devm_snd_soc_register_component(&i2c_client->dev,
   &soc_component_dev_cs35l32, cs35l32_dai,
   ARRAY_SIZE(cs35l32_dai));
 if (ret < 0)
  goto err_disable;

 return 0;

err_disable:
 gpiod_set_value_cansleep(cs35l32->reset_gpio, 0);
err_supplies:
 regulator_bulk_disable(ARRAY_SIZE(cs35l32->supplies),
          cs35l32->supplies);
 return ret;
}

static void cs35l32_i2c_remove(struct i2c_client *i2c_client)
{
 struct cs35l32_private *cs35l32 = i2c_get_clientdata(i2c_client);

 /* Hold down reset */
 gpiod_set_value_cansleep(cs35l32->reset_gpio, 0);
}

static int cs35l32_runtime_suspend(struct device *dev)
{
 struct cs35l32_private *cs35l32 = dev_get_drvdata(dev);

 regcache_cache_only(cs35l32->regmap, true);
 regcache_mark_dirty(cs35l32->regmap);

 /* Hold down reset */
 gpiod_set_value_cansleep(cs35l32->reset_gpio, 0);

 /* remove power */
 regulator_bulk_disable(ARRAY_SIZE(cs35l32->supplies),
          cs35l32->supplies);

 return 0;
}

static int cs35l32_runtime_resume(struct device *dev)
{
 struct cs35l32_private *cs35l32 = dev_get_drvdata(dev);
 int ret;

 /* Enable power */
 ret = regulator_bulk_enable(ARRAY_SIZE(cs35l32->supplies),
        cs35l32->supplies);
 if (ret != 0) {
  dev_err(dev, "Failed to enable supplies: %d\n",
   ret);
  return ret;
 }

 gpiod_set_value_cansleep(cs35l32->reset_gpio, 1);

 regcache_cache_only(cs35l32->regmap, false);
 regcache_sync(cs35l32->regmap);

 return 0;
}

static const struct dev_pm_ops cs35l32_runtime_pm = {
 RUNTIME_PM_OPS(cs35l32_runtime_suspend, cs35l32_runtime_resume, NULL)
};

static const struct of_device_id cs35l32_of_match[] = {
 { .compatible = "cirrus,cs35l32", },
 {},
};
MODULE_DEVICE_TABLE(of, cs35l32_of_match);


static const struct i2c_device_id cs35l32_id[] = {
 {"cs35l32"},
 {}
};

MODULE_DEVICE_TABLE(i2c, cs35l32_id);

static struct i2c_driver cs35l32_i2c_driver = {
 .driver = {
     .name = "cs35l32",
     .pm = pm_ptr(&cs35l32_runtime_pm),
     .of_match_table = cs35l32_of_match,
     },
 .id_table = cs35l32_id,
 .probe = cs35l32_i2c_probe,
 .remove = cs35l32_i2c_remove,
};

module_i2c_driver(cs35l32_i2c_driver);

MODULE_DESCRIPTION("ASoC CS35L32 driver");
MODULE_AUTHOR("Brian Austin, Cirrus Logic Inc, ");
MODULE_LICENSE("GPL");