drivers/mfd/twl4030-audio.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * MFD driver for twl4030 audio submodule, which contains an audio codec, and
   4  * the vibra control.
   5  *
   6  * Author: Peter Ujfalusi <peter.ujfalusi@ti.com>
   7  *
   8  * Copyright:   (C) 2009 Nokia Corporation
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/types.h>
  13 #include <linux/slab.h>
  14 #include <linux/kernel.h>
  15 #include <linux/fs.h>
  16 #include <linux/platform_device.h>
  17 #include <linux/of.h>
  18 #include <linux/of_platform.h>
  19 #include <linux/mfd/twl.h>
  20 #include <linux/mfd/core.h>
  21 #include <linux/mfd/twl4030-audio.h>
  22
  23 #define TWL4030_AUDIO_CELLS     2
  24
  25 static struct platform_device *twl4030_audio_dev;
  26
  27 struct twl4030_audio_resource {
  28         int request_count;
  29         u8 reg;
  30         u8 mask;
  31 };
  32
  33 struct twl4030_audio {
  34         unsigned int audio_mclk;
  35         struct mutex mutex;
  36         struct twl4030_audio_resource resource[TWL4030_AUDIO_RES_MAX];
  37         struct mfd_cell cells[TWL4030_AUDIO_CELLS];
  38 };
  39
  40 /*
  41  * Modify the resource, the function returns the content of the register
  42  * after the modification.
  43  */
  44 static int twl4030_audio_set_resource(enum twl4030_audio_res id, int enable)
  45 {
  46         struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev);
  47         u8 val;
  48
  49         twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &val,
  50                         audio->resource[id].reg);
  51
  52         if (enable)
  53                 val |= audio->resource[id].mask;
  54         else
  55                 val &= ~audio->resource[id].mask;
  56
  57         twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
  58                                         val, audio->resource[id].reg);
  59
  60         return val;
  61 }
  62
  63 static inline int twl4030_audio_get_resource(enum twl4030_audio_res id)
  64 {
  65         struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev);
  66         u8 val;
  67
  68         twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &val,
  69                         audio->resource[id].reg);
  70
  71         return val;
  72 }
  73
  74 /*
  75  * Enable the resource.
  76  * The function returns with error or the content of the register
  77  */
  78 int twl4030_audio_enable_resource(enum twl4030_audio_res id)
  79 {
  80         struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev);
  81         int val;
  82
  83         if (id >= TWL4030_AUDIO_RES_MAX) {
  84                 dev_err(&twl4030_audio_dev->dev,
  85                                 "Invalid resource ID (%u)\n", id);
  86                 return -EINVAL;
  87         }
  88
  89         mutex_lock(&audio->mutex);
  90         if (!audio->resource[id].request_count)
  91                 /* Resource was disabled, enable it */
  92                 val = twl4030_audio_set_resource(id, 1);
  93         else
  94                 val = twl4030_audio_get_resource(id);
  95
  96         audio->resource[id].request_count++;
  97         mutex_unlock(&audio->mutex);
  98
  99         return val;
 100 }
 101 EXPORT_SYMBOL_GPL(twl4030_audio_enable_resource);
 102
 103 /*
 104  * Disable the resource.
 105  * The function returns with error or the content of the register
 106  */
 107 int twl4030_audio_disable_resource(enum twl4030_audio_res id)
 108 {
 109         struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev);
 110         int val;
 111
 112         if (id >= TWL4030_AUDIO_RES_MAX) {
 113                 dev_err(&twl4030_audio_dev->dev,
 114                                 "Invalid resource ID (%u)\n", id);
 115                 return -EINVAL;
 116         }
 117
 118         mutex_lock(&audio->mutex);
 119         if (!audio->resource[id].request_count) {
 120                 dev_err(&twl4030_audio_dev->dev,
 121                         "Resource has been disabled already (%u)\n", id);
 122                 mutex_unlock(&audio->mutex);
 123                 return -EPERM;
 124         }
 125         audio->resource[id].request_count--;
 126
 127         if (!audio->resource[id].request_count)
 128                 /* Resource can be disabled now */
 129                 val = twl4030_audio_set_resource(id, 0);
 130         else
 131                 val = twl4030_audio_get_resource(id);
 132
 133         mutex_unlock(&audio->mutex);
 134
 135         return val;
 136 }
 137 EXPORT_SYMBOL_GPL(twl4030_audio_disable_resource);
 138
 139 unsigned int twl4030_audio_get_mclk(void)
 140 {
 141         struct twl4030_audio *audio = platform_get_drvdata(twl4030_audio_dev);
 142
 143         return audio->audio_mclk;
 144 }
 145 EXPORT_SYMBOL_GPL(twl4030_audio_get_mclk);
 146
 147 static bool twl4030_audio_has_codec(struct twl4030_audio_data *pdata,
 148                               struct device_node *parent)
 149 {
 150         struct device_node *node;
 151
 152         if (pdata && pdata->codec)
 153                 return true;
 154
 155         node = of_get_child_by_name(parent, "codec");
 156         if (node) {
 157                 of_node_put(node);
 158                 return true;
 159         }
 160
 161         return false;
 162 }
 163
 164 static bool twl4030_audio_has_vibra(struct twl4030_audio_data *pdata,
 165                               struct device_node *node)
 166 {
 167         int vibra;
 168
 169         if (pdata && pdata->vibra)
 170                 return true;
 171
 172         if (!of_property_read_u32(node, "ti,enable-vibra", &vibra) && vibra)
 173                 return true;
 174
 175         return false;
 176 }
 177
 178 static int twl4030_audio_probe(struct platform_device *pdev)
 179 {
 180         struct twl4030_audio *audio;
 181         struct twl4030_audio_data *pdata = dev_get_platdata(&pdev->dev);
 182         struct device_node *node = pdev->dev.of_node;
 183         struct mfd_cell *cell = NULL;
 184         int ret, childs = 0;
 185         u8 val;
 186
 187         if (!pdata && !node) {
 188                 dev_err(&pdev->dev, "Platform data is missing\n");
 189                 return -EINVAL;
 190         }
 191
 192         audio = devm_kzalloc(&pdev->dev, sizeof(struct twl4030_audio),
 193                              GFP_KERNEL);
 194         if (!audio)
 195                 return -ENOMEM;
 196
 197         mutex_init(&audio->mutex);
 198         audio->audio_mclk = twl_get_hfclk_rate();
 199
 200         /* Configure APLL_INFREQ and disable APLL if enabled */
 201         switch (audio->audio_mclk) {
 202         case 19200000:
 203                 val = TWL4030_APLL_INFREQ_19200KHZ;
 204                 break;
 205         case 26000000:
 206                 val = TWL4030_APLL_INFREQ_26000KHZ;
 207                 break;
 208         case 38400000:
 209                 val = TWL4030_APLL_INFREQ_38400KHZ;
 210                 break;
 211         default:
 212                 dev_err(&pdev->dev, "Invalid audio_mclk\n");
 213                 return -EINVAL;
 214         }
 215         twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, val, TWL4030_REG_APLL_CTL);
 216
 217         /* Codec power */
 218         audio->resource[TWL4030_AUDIO_RES_POWER].reg = TWL4030_REG_CODEC_MODE;
 219         audio->resource[TWL4030_AUDIO_RES_POWER].mask = TWL4030_CODECPDZ;
 220
 221         /* PLL */
 222         audio->resource[TWL4030_AUDIO_RES_APLL].reg = TWL4030_REG_APLL_CTL;
 223         audio->resource[TWL4030_AUDIO_RES_APLL].mask = TWL4030_APLL_EN;
 224
 225         if (twl4030_audio_has_codec(pdata, node)) {
 226                 cell = &audio->cells[childs];
 227                 cell->name = "twl4030-codec";
 228                 if (pdata) {
 229                         cell->platform_data = pdata->codec;
 230                         cell->pdata_size = sizeof(*pdata->codec);
 231                 }
 232                 childs++;
 233         }
 234         if (twl4030_audio_has_vibra(pdata, node)) {
 235                 cell = &audio->cells[childs];
 236                 cell->name = "twl4030-vibra";
 237                 if (pdata) {
 238                         cell->platform_data = pdata->vibra;
 239                         cell->pdata_size = sizeof(*pdata->vibra);
 240                 }
 241                 childs++;
 242         }
 243
 244         platform_set_drvdata(pdev, audio);
 245         twl4030_audio_dev = pdev;
 246
 247         if (childs)
 248                 ret = mfd_add_devices(&pdev->dev, pdev->id, audio->cells,
 249                                       childs, NULL, 0, NULL);
 250         else {
 251                 dev_err(&pdev->dev, "No platform data found for childs\n");
 252                 ret = -ENODEV;
 253         }
 254
 255         if (ret)
 256                 twl4030_audio_dev = NULL;
 257
 258         return ret;
 259 }
 260
 261 static void twl4030_audio_remove(struct platform_device *pdev)
 262 {
 263         mfd_remove_devices(&pdev->dev);
 264         twl4030_audio_dev = NULL;
 265 }
 266
 267 static const struct of_device_id twl4030_audio_of_match[] = {
 268         {.compatible = "ti,twl4030-audio", },
 269         { },
 270 };
 271 MODULE_DEVICE_TABLE(of, twl4030_audio_of_match);
 272
 273 static struct platform_driver twl4030_audio_driver = {
 274         .driver         = {
 275                 .name   = "twl4030-audio",
 276                 .of_match_table = twl4030_audio_of_match,
 277         },
 278         .probe          = twl4030_audio_probe,
 279         .remove_new     = twl4030_audio_remove,
 280 };
 281
 282 module_platform_driver(twl4030_audio_driver);
 283
 284 MODULE_AUTHOR("Peter Ujfalusi <peter.ujfalusi@ti.com>");
 285 MODULE_DESCRIPTION("TWL4030 audio block MFD driver");
 286 MODULE_ALIAS("platform:twl4030-audio");