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 <jeeja.kp@intel.com> 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 */ snd_hdac_ext_bus_ppcap_enable(struct hdac_bus * bus,bool enable)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 */ snd_hdac_ext_bus_ppcap_int_enable(struct hdac_bus * bus,bool enable)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 */ snd_hdac_ext_bus_get_ml_capabilities(struct hdac_bus * bus)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 snd_hdac_ext_link_free_all(struct hdac_bus * bus)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 */ snd_hdac_ext_bus_get_hlink_by_addr(struct hdac_bus * bus,int addr)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 */ snd_hdac_ext_bus_get_hlink_by_name(struct hdac_bus * bus,const char * codec_name)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 check_hdac_link_power_active(struct hdac_ext_link * hlink,bool enable)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 */ snd_hdac_ext_bus_link_power_up(struct hdac_ext_link * hlink)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 */ snd_hdac_ext_bus_link_power_down(struct hdac_ext_link * hlink)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 */ snd_hdac_ext_bus_link_power_up_all(struct hdac_bus * bus)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 */ snd_hdac_ext_bus_link_power_down_all(struct hdac_bus * bus)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 */ snd_hdac_ext_bus_link_set_stream_id(struct hdac_ext_link * link,int stream)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 */ snd_hdac_ext_bus_link_clear_stream_id(struct hdac_ext_link * link,int stream)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 snd_hdac_ext_bus_link_get(struct hdac_bus * bus,struct hdac_ext_link * hlink)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 snd_hdac_ext_bus_link_put(struct hdac_bus * bus,struct hdac_ext_link * hlink)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 hdac_ext_codec_link_up(struct hdac_device * codec)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 hdac_ext_codec_link_down(struct hdac_device * codec)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 snd_hdac_ext_bus_link_power(struct hdac_device * codec,bool enable)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); 394