sound/hda/ext/hdac_ext_controller.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  *  hdac-ext-controller.c - HD-audio extended controller functions.
   4  *
   5  *  Copyright (C) 2014-2015 Intel Corp
   6  *  Author: Jeeja KP <[email protected]>
   7  *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
   8  *
   9  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  10  */
  11
  12 #include <linux/delay.h>
  13 #include <linux/slab.h>
  14 #include <sound/hda_register.h>
  15 #include <sound/hdaudio_ext.h>
  16
  17 /*
  18  * processing pipe helpers - these helpers are useful for dealing with HDA
  19  * new capability of processing pipelines
  20  */
  21
  22 /**
  23  * snd_hdac_ext_bus_ppcap_enable - enable/disable processing pipe capability
  24  * @bus: the pointer to HDAC bus object
  25  * @enable: flag to turn on/off the capability
  26  */
  27 void snd_hdac_ext_bus_ppcap_enable(struct hdac_bus *bus, bool enable)
  28 {
  29
  30         if (!bus->ppcap) {
  31                 dev_err(bus->dev, "Address of PP capability is NULL");
  32                 return;
  33         }
  34
  35         if (enable)
  36                 snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL,
  37                                  AZX_PPCTL_GPROCEN, AZX_PPCTL_GPROCEN);
  38         else
  39                 snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL,
  40                                  AZX_PPCTL_GPROCEN, 0);
  41 }
  42 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_ppcap_enable);
  43
  44 /**
  45  * snd_hdac_ext_bus_ppcap_int_enable - ppcap interrupt enable/disable
  46  * @bus: the pointer to HDAC bus object
  47  * @enable: flag to enable/disable interrupt
  48  */
  49 void snd_hdac_ext_bus_ppcap_int_enable(struct hdac_bus *bus, bool enable)
  50 {
  51
  52         if (!bus->ppcap) {
  53                 dev_err(bus->dev, "Address of PP capability is NULL\n");
  54                 return;
  55         }
  56
  57         if (enable)
  58                 snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL,
  59                                  AZX_PPCTL_PIE, AZX_PPCTL_PIE);
  60         else
  61                 snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL,
  62                                  AZX_PPCTL_PIE, 0);
  63 }
  64 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_ppcap_int_enable);
  65
  66 /*
  67  * Multilink helpers - these helpers are useful for dealing with HDA
  68  * new multilink capability
  69  */
  70
  71 /**
  72  * snd_hdac_ext_bus_get_ml_capabilities - get multilink capability
  73  * @bus: the pointer to HDAC bus object
  74  *
  75  * This will parse all links and read the mlink capabilities and add them
  76  * in hlink_list of extended hdac bus
  77  * Note: this will be freed on bus exit by driver
  78  */
  79 int snd_hdac_ext_bus_get_ml_capabilities(struct hdac_bus *bus)
  80 {
  81         int idx;
  82         u32 link_count;
  83         struct hdac_ext_link *hlink;
  84
  85         link_count = readl(bus->mlcap + AZX_REG_ML_MLCD) + 1;
  86
  87         dev_dbg(bus->dev, "In %s Link count: %d\n", __func__, link_count);
  88
  89         for (idx = 0; idx < link_count; idx++) {
  90                 hlink  = kzalloc(sizeof(*hlink), GFP_KERNEL);
  91                 if (!hlink)
  92                         return -ENOMEM;
  93                 hlink->index = idx;
  94                 hlink->bus = bus;
  95                 hlink->ml_addr = bus->mlcap + AZX_ML_BASE +
  96                                         (AZX_ML_INTERVAL * idx);
  97                 hlink->lcaps  = readl(hlink->ml_addr + AZX_REG_ML_LCAP);
  98                 hlink->lsdiid = readw(hlink->ml_addr + AZX_REG_ML_LSDIID);
  99
 100                 /* since link in On, update the ref */
 101                 hlink->ref_count = 1;
 102
 103                 list_add_tail(&hlink->list, &bus->hlink_list);
 104         }
 105
 106         return 0;
 107 }
 108 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_ml_capabilities);
 109
 110 /**
 111  * snd_hdac_ext_link_free_all- free hdac extended link objects
 112  *
 113  * @bus: the pointer to HDAC bus object
 114  */
 115
 116 void snd_hdac_ext_link_free_all(struct hdac_bus *bus)
 117 {
 118         struct hdac_ext_link *hlink;
 119
 120         while (!list_empty(&bus->hlink_list)) {
 121                 hlink = list_first_entry(&bus->hlink_list, struct hdac_ext_link, list);
 122                 list_del(&hlink->list);
 123                 kfree(hlink);
 124         }
 125 }
 126 EXPORT_SYMBOL_GPL(snd_hdac_ext_link_free_all);
 127
 128 /**
 129  * snd_hdac_ext_bus_get_hlink_by_addr - get hlink at specified address
 130  * @bus: hlink's parent bus device
 131  * @addr: codec device address
 132  *
 133  * Returns hlink object or NULL if matching hlink is not found.
 134  */
 135 struct hdac_ext_link *snd_hdac_ext_bus_get_hlink_by_addr(struct hdac_bus *bus, int addr)
 136 {
 137         struct hdac_ext_link *hlink;
 138
 139         list_for_each_entry(hlink, &bus->hlink_list, list)
 140                 if (hlink->lsdiid & (0x1 << addr))
 141                         return hlink;
 142         return NULL;
 143 }
 144 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_hlink_by_addr);
 145
 146 /**
 147  * snd_hdac_ext_bus_get_hlink_by_name - get hlink based on codec name
 148  * @bus: the pointer to HDAC bus object
 149  * @codec_name: codec name
 150  */
 151 struct hdac_ext_link *snd_hdac_ext_bus_get_hlink_by_name(struct hdac_bus *bus,
 152                                                          const char *codec_name)
 153 {
 154         int bus_idx, addr;
 155
 156         if (sscanf(codec_name, "ehdaudio%dD%d", &bus_idx, &addr) != 2)
 157                 return NULL;
 158         if (bus->idx != bus_idx)
 159                 return NULL;
 160         if (addr < 0 || addr > 31)
 161                 return NULL;
 162
 163         return snd_hdac_ext_bus_get_hlink_by_addr(bus, addr);
 164 }
 165 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_hlink_by_name);
 166
 167 static int check_hdac_link_power_active(struct hdac_ext_link *hlink, bool enable)
 168 {
 169         int timeout;
 170         u32 val;
 171         int mask = (1 << AZX_ML_LCTL_CPA_SHIFT);
 172
 173         udelay(3);
 174         timeout = 150;
 175
 176         do {
 177                 val = readl(hlink->ml_addr + AZX_REG_ML_LCTL);
 178                 if (enable) {
 179                         if (((val & mask) >> AZX_ML_LCTL_CPA_SHIFT))
 180                                 return 0;
 181                 } else {
 182                         if (!((val & mask) >> AZX_ML_LCTL_CPA_SHIFT))
 183                                 return 0;
 184                 }
 185                 udelay(3);
 186         } while (--timeout);
 187
 188         return -EIO;
 189 }
 190
 191 /**
 192  * snd_hdac_ext_bus_link_power_up -power up hda link
 193  * @hlink: HD-audio extended link
 194  */
 195 int snd_hdac_ext_bus_link_power_up(struct hdac_ext_link *hlink)
 196 {
 197         snd_hdac_updatel(hlink->ml_addr, AZX_REG_ML_LCTL,
 198                          AZX_ML_LCTL_SPA, AZX_ML_LCTL_SPA);
 199
 200         return check_hdac_link_power_active(hlink, true);
 201 }
 202 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_up);
 203
 204 /**
 205  * snd_hdac_ext_bus_link_power_down -power down hda link
 206  * @hlink: HD-audio extended link
 207  */
 208 int snd_hdac_ext_bus_link_power_down(struct hdac_ext_link *hlink)
 209 {
 210         snd_hdac_updatel(hlink->ml_addr, AZX_REG_ML_LCTL, AZX_ML_LCTL_SPA, 0);
 211
 212         return check_hdac_link_power_active(hlink, false);
 213 }
 214 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_down);
 215
 216 /**
 217  * snd_hdac_ext_bus_link_power_up_all -power up all hda link
 218  * @bus: the pointer to HDAC bus object
 219  */
 220 int snd_hdac_ext_bus_link_power_up_all(struct hdac_bus *bus)
 221 {
 222         struct hdac_ext_link *hlink = NULL;
 223         int ret;
 224
 225         list_for_each_entry(hlink, &bus->hlink_list, list) {
 226                 ret = snd_hdac_ext_bus_link_power_up(hlink);
 227                 if (ret < 0)
 228                         return ret;
 229         }
 230
 231         return 0;
 232 }
 233 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_up_all);
 234
 235 /**
 236  * snd_hdac_ext_bus_link_power_down_all -power down all hda link
 237  * @bus: the pointer to HDAC bus object
 238  */
 239 int snd_hdac_ext_bus_link_power_down_all(struct hdac_bus *bus)
 240 {
 241         struct hdac_ext_link *hlink = NULL;
 242         int ret;
 243
 244         list_for_each_entry(hlink, &bus->hlink_list, list) {
 245                 ret = snd_hdac_ext_bus_link_power_down(hlink);
 246                 if (ret < 0)
 247                         return ret;
 248         }
 249
 250         return 0;
 251 }
 252 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_down_all);
 253
 254 /**
 255  * snd_hdac_ext_bus_link_set_stream_id - maps stream id to link output
 256  * @link: HD-audio ext link to set up
 257  * @stream: stream id
 258  */
 259 void snd_hdac_ext_bus_link_set_stream_id(struct hdac_ext_link *link,
 260                                          int stream)
 261 {
 262         snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 1 << stream);
 263 }
 264 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_set_stream_id);
 265
 266 /**
 267  * snd_hdac_ext_bus_link_clear_stream_id - maps stream id to link output
 268  * @link: HD-audio ext link to set up
 269  * @stream: stream id
 270  */
 271 void snd_hdac_ext_bus_link_clear_stream_id(struct hdac_ext_link *link,
 272                                            int stream)
 273 {
 274         snd_hdac_updatew(link->ml_addr, AZX_REG_ML_LOSIDV, (1 << stream), 0);
 275 }
 276 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_clear_stream_id);
 277
 278 int snd_hdac_ext_bus_link_get(struct hdac_bus *bus,
 279                                 struct hdac_ext_link *hlink)
 280 {
 281         unsigned long codec_mask;
 282         int ret = 0;
 283
 284         mutex_lock(&bus->lock);
 285
 286         /*
 287          * if we move from 0 to 1, count will be 1 so power up this link
 288          * as well, also check the dma status and trigger that
 289          */
 290         if (++hlink->ref_count == 1) {
 291                 if (!bus->cmd_dma_state) {
 292                         snd_hdac_bus_init_cmd_io(bus);
 293                         bus->cmd_dma_state = true;
 294                 }
 295
 296                 ret = snd_hdac_ext_bus_link_power_up(hlink);
 297
 298                 /*
 299                  * clear the register to invalidate all the output streams
 300                  */
 301                 snd_hdac_updatew(hlink->ml_addr, AZX_REG_ML_LOSIDV,
 302                                  AZX_ML_LOSIDV_STREAM_MASK, 0);
 303                 /*
 304                  *  wait for 521usec for codec to report status
 305                  *  HDA spec section 4.3 - Codec Discovery
 306                  */
 307                 udelay(521);
 308                 codec_mask = snd_hdac_chip_readw(bus, STATESTS);
 309                 dev_dbg(bus->dev, "codec_mask = 0x%lx\n", codec_mask);
 310                 snd_hdac_chip_writew(bus, STATESTS, codec_mask);
 311                 if (!bus->codec_mask)
 312                         bus->codec_mask = codec_mask;
 313         }
 314
 315         mutex_unlock(&bus->lock);
 316         return ret;
 317 }
 318 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_get);
 319
 320 int snd_hdac_ext_bus_link_put(struct hdac_bus *bus,
 321                               struct hdac_ext_link *hlink)
 322 {
 323         int ret = 0;
 324         struct hdac_ext_link *hlink_tmp;
 325         bool link_up = false;
 326
 327         mutex_lock(&bus->lock);
 328
 329         /*
 330          * if we move from 1 to 0, count will be 0
 331          * so power down this link as well
 332          */
 333         if (--hlink->ref_count == 0) {
 334                 ret = snd_hdac_ext_bus_link_power_down(hlink);
 335
 336                 /*
 337                  * now check if all links are off, if so turn off
 338                  * cmd dma as well
 339                  */
 340                 list_for_each_entry(hlink_tmp, &bus->hlink_list, list) {
 341                         if (hlink_tmp->ref_count) {
 342                                 link_up = true;
 343                                 break;
 344                         }
 345                 }
 346
 347                 if (!link_up) {
 348                         snd_hdac_bus_stop_cmd_io(bus);
 349                         bus->cmd_dma_state = false;
 350                 }
 351         }
 352
 353         mutex_unlock(&bus->lock);
 354         return ret;
 355 }
 356 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_put);
 357
 358 static void hdac_ext_codec_link_up(struct hdac_device *codec)
 359 {
 360         const char *devname = dev_name(&codec->dev);
 361         struct hdac_ext_link *hlink =
 362                 snd_hdac_ext_bus_get_hlink_by_name(codec->bus, devname);
 363
 364         if (hlink)
 365                 snd_hdac_ext_bus_link_get(codec->bus, hlink);
 366 }
 367
 368 static void hdac_ext_codec_link_down(struct hdac_device *codec)
 369 {
 370         const char *devname = dev_name(&codec->dev);
 371         struct hdac_ext_link *hlink =
 372                 snd_hdac_ext_bus_get_hlink_by_name(codec->bus, devname);
 373
 374         if (hlink)
 375                 snd_hdac_ext_bus_link_put(codec->bus, hlink);
 376 }
 377
 378 void snd_hdac_ext_bus_link_power(struct hdac_device *codec, bool enable)
 379 {
 380         struct hdac_bus *bus = codec->bus;
 381         bool oldstate = test_bit(codec->addr, &bus->codec_powered);
 382
 383         if (enable == oldstate)
 384                 return;
 385
 386         snd_hdac_bus_link_power(codec, enable);
 387
 388         if (enable)
 389                 hdac_ext_codec_link_up(codec);
 390         else
 391                 hdac_ext_codec_link_down(codec);
 392 }
 393 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power);