Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 1 | /* |
| 2 | * hdac-ext-controller.c - HD-audio extended controller functions. |
| 3 | * |
| 4 | * Copyright (C) 2014-2015 Intel Corp |
| 5 | * Author: Jeeja KP <jeeja.kp@intel.com> |
| 6 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; version 2 of the License. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, but |
| 13 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * General Public License for more details. |
| 16 | * |
| 17 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 18 | */ |
| 19 | |
| 20 | #include <linux/delay.h> |
| 21 | #include <linux/slab.h> |
| 22 | #include <sound/hda_register.h> |
| 23 | #include <sound/hdaudio_ext.h> |
| 24 | |
| 25 | /* |
| 26 | * maximum HDAC capablities we should parse to avoid endless looping: |
| 27 | * currently we have 4 extended caps, so this is future proof for now. |
| 28 | * extend when this limit is seen meeting in real HW |
| 29 | */ |
| 30 | #define HDAC_MAX_CAPS 10 |
| 31 | |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 32 | /* |
| 33 | * processing pipe helpers - these helpers are useful for dealing with HDA |
| 34 | * new capability of processing pipelines |
| 35 | */ |
| 36 | |
| 37 | /** |
| 38 | * snd_hdac_ext_bus_ppcap_enable - enable/disable processing pipe capability |
| 39 | * @ebus: HD-audio extended core bus |
| 40 | * @enable: flag to turn on/off the capability |
| 41 | */ |
| 42 | void snd_hdac_ext_bus_ppcap_enable(struct hdac_ext_bus *ebus, bool enable) |
| 43 | { |
| 44 | struct hdac_bus *bus = &ebus->bus; |
| 45 | |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 46 | if (!bus->ppcap) { |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 47 | dev_err(bus->dev, "Address of PP capability is NULL"); |
| 48 | return; |
| 49 | } |
| 50 | |
| 51 | if (enable) |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 52 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, 0, AZX_PPCTL_GPROCEN); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 53 | else |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 54 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, AZX_PPCTL_GPROCEN, 0); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 55 | } |
| 56 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_ppcap_enable); |
| 57 | |
| 58 | /** |
| 59 | * snd_hdac_ext_bus_ppcap_int_enable - ppcap interrupt enable/disable |
| 60 | * @ebus: HD-audio extended core bus |
| 61 | * @enable: flag to enable/disable interrupt |
| 62 | */ |
| 63 | void snd_hdac_ext_bus_ppcap_int_enable(struct hdac_ext_bus *ebus, bool enable) |
| 64 | { |
| 65 | struct hdac_bus *bus = &ebus->bus; |
| 66 | |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 67 | if (!bus->ppcap) { |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 68 | dev_err(bus->dev, "Address of PP capability is NULL\n"); |
| 69 | return; |
| 70 | } |
| 71 | |
| 72 | if (enable) |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 73 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, 0, AZX_PPCTL_PIE); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 74 | else |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 75 | snd_hdac_updatel(bus->ppcap, AZX_REG_PP_PPCTL, AZX_PPCTL_PIE, 0); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 76 | } |
| 77 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_ppcap_int_enable); |
| 78 | |
| 79 | /* |
| 80 | * Multilink helpers - these helpers are useful for dealing with HDA |
| 81 | * new multilink capability |
| 82 | */ |
| 83 | |
| 84 | /** |
| 85 | * snd_hdac_ext_bus_get_ml_capabilities - get multilink capability |
| 86 | * @ebus: HD-audio extended core bus |
| 87 | * |
| 88 | * This will parse all links and read the mlink capabilities and add them |
| 89 | * in hlink_list of extended hdac bus |
| 90 | * Note: this will be freed on bus exit by driver |
| 91 | */ |
| 92 | int snd_hdac_ext_bus_get_ml_capabilities(struct hdac_ext_bus *ebus) |
| 93 | { |
| 94 | int idx; |
| 95 | u32 link_count; |
| 96 | struct hdac_ext_link *hlink; |
| 97 | struct hdac_bus *bus = &ebus->bus; |
| 98 | |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 99 | link_count = readl(bus->mlcap + AZX_REG_ML_MLCD) + 1; |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 100 | |
| 101 | dev_dbg(bus->dev, "In %s Link count: %d\n", __func__, link_count); |
| 102 | |
| 103 | for (idx = 0; idx < link_count; idx++) { |
| 104 | hlink = kzalloc(sizeof(*hlink), GFP_KERNEL); |
| 105 | if (!hlink) |
| 106 | return -ENOMEM; |
| 107 | hlink->index = idx; |
| 108 | hlink->bus = bus; |
Vinod Koul | ec8ae57 | 2016-08-04 15:46:01 +0530 | [diff] [blame] | 109 | hlink->ml_addr = bus->mlcap + AZX_ML_BASE + |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 110 | (AZX_ML_INTERVAL * idx); |
Jeeja KP | a7e3dd8 | 2015-08-21 21:36:17 +0530 | [diff] [blame] | 111 | hlink->lcaps = readl(hlink->ml_addr + AZX_REG_ML_LCAP); |
| 112 | hlink->lsdiid = readw(hlink->ml_addr + AZX_REG_ML_LSDIID); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 113 | |
Vinod Koul | 4446085d | 2016-05-12 08:58:53 +0530 | [diff] [blame] | 114 | /* since link in On, update the ref */ |
| 115 | hlink->ref_count = 1; |
| 116 | |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 117 | list_add_tail(&hlink->list, &ebus->hlink_list); |
| 118 | } |
| 119 | |
| 120 | return 0; |
| 121 | } |
| 122 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_ml_capabilities); |
| 123 | |
| 124 | /** |
Vinod Koul | bab4445 | 2015-06-17 11:20:17 +0530 | [diff] [blame] | 125 | * snd_hdac_link_free_all- free hdac extended link objects |
| 126 | * |
| 127 | * @ebus: HD-audio ext core bus |
| 128 | */ |
| 129 | |
| 130 | void snd_hdac_link_free_all(struct hdac_ext_bus *ebus) |
| 131 | { |
| 132 | struct hdac_ext_link *l; |
| 133 | |
| 134 | while (!list_empty(&ebus->hlink_list)) { |
| 135 | l = list_first_entry(&ebus->hlink_list, struct hdac_ext_link, list); |
| 136 | list_del(&l->list); |
| 137 | kfree(l); |
| 138 | } |
| 139 | } |
| 140 | EXPORT_SYMBOL_GPL(snd_hdac_link_free_all); |
| 141 | |
| 142 | /** |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 143 | * snd_hdac_ext_bus_get_link_index - get link based on codec name |
| 144 | * @ebus: HD-audio extended core bus |
| 145 | * @codec_name: codec name |
| 146 | */ |
| 147 | struct hdac_ext_link *snd_hdac_ext_bus_get_link(struct hdac_ext_bus *ebus, |
| 148 | const char *codec_name) |
| 149 | { |
| 150 | int i; |
| 151 | struct hdac_ext_link *hlink = NULL; |
| 152 | int bus_idx, addr; |
| 153 | |
| 154 | if (sscanf(codec_name, "ehdaudio%dD%d", &bus_idx, &addr) != 2) |
| 155 | return NULL; |
| 156 | if (ebus->idx != bus_idx) |
| 157 | return NULL; |
| 158 | |
| 159 | list_for_each_entry(hlink, &ebus->hlink_list, list) { |
| 160 | for (i = 0; i < HDA_MAX_CODECS; i++) { |
| 161 | if (hlink->lsdiid & (0x1 << addr)) |
| 162 | return hlink; |
| 163 | } |
| 164 | } |
| 165 | |
| 166 | return NULL; |
| 167 | } |
| 168 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_get_link); |
| 169 | |
| 170 | static int check_hdac_link_power_active(struct hdac_ext_link *link, bool enable) |
| 171 | { |
| 172 | int timeout; |
| 173 | u32 val; |
| 174 | int mask = (1 << AZX_MLCTL_CPA); |
| 175 | |
| 176 | udelay(3); |
Jayachandran B | cf8fe58 | 2015-12-18 15:12:01 +0530 | [diff] [blame] | 177 | timeout = 150; |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 178 | |
| 179 | do { |
Jeeja KP | a7e3dd8 | 2015-08-21 21:36:17 +0530 | [diff] [blame] | 180 | val = readl(link->ml_addr + AZX_REG_ML_LCTL); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 181 | if (enable) { |
| 182 | if (((val & mask) >> AZX_MLCTL_CPA)) |
| 183 | return 0; |
| 184 | } else { |
| 185 | if (!((val & mask) >> AZX_MLCTL_CPA)) |
| 186 | return 0; |
| 187 | } |
| 188 | udelay(3); |
| 189 | } while (--timeout); |
| 190 | |
| 191 | return -EIO; |
| 192 | } |
| 193 | |
| 194 | /** |
| 195 | * snd_hdac_ext_bus_link_power_up -power up hda link |
| 196 | * @link: HD-audio extended link |
| 197 | */ |
| 198 | int snd_hdac_ext_bus_link_power_up(struct hdac_ext_link *link) |
| 199 | { |
Jeeja KP | a7e3dd8 | 2015-08-21 21:36:17 +0530 | [diff] [blame] | 200 | snd_hdac_updatel(link->ml_addr, AZX_REG_ML_LCTL, 0, AZX_MLCTL_SPA); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 201 | |
| 202 | return check_hdac_link_power_active(link, true); |
| 203 | } |
| 204 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_up); |
| 205 | |
| 206 | /** |
| 207 | * snd_hdac_ext_bus_link_power_down -power down hda link |
| 208 | * @link: HD-audio extended link |
| 209 | */ |
| 210 | int snd_hdac_ext_bus_link_power_down(struct hdac_ext_link *link) |
| 211 | { |
Jeeja KP | a7e3dd8 | 2015-08-21 21:36:17 +0530 | [diff] [blame] | 212 | snd_hdac_updatel(link->ml_addr, AZX_REG_ML_LCTL, AZX_MLCTL_SPA, 0); |
Jeeja KP | 0b00a56 | 2015-06-11 14:11:48 +0530 | [diff] [blame] | 213 | |
| 214 | return check_hdac_link_power_active(link, false); |
| 215 | } |
| 216 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_down); |
Jeeja KP | c5b0c09 | 2015-08-21 21:36:18 +0530 | [diff] [blame] | 217 | |
| 218 | /** |
Vinod Koul | 6706a19 | 2015-12-18 15:12:02 +0530 | [diff] [blame] | 219 | * snd_hdac_ext_bus_link_power_up_all -power up all hda link |
| 220 | * @ebus: HD-audio extended bus |
| 221 | */ |
| 222 | int snd_hdac_ext_bus_link_power_up_all(struct hdac_ext_bus *ebus) |
| 223 | { |
| 224 | struct hdac_ext_link *hlink = NULL; |
| 225 | int ret; |
| 226 | |
| 227 | list_for_each_entry(hlink, &ebus->hlink_list, list) { |
| 228 | snd_hdac_updatel(hlink->ml_addr, |
| 229 | AZX_REG_ML_LCTL, 0, AZX_MLCTL_SPA); |
| 230 | ret = check_hdac_link_power_active(hlink, true); |
| 231 | if (ret < 0) |
| 232 | return ret; |
| 233 | } |
| 234 | |
| 235 | return 0; |
| 236 | } |
| 237 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_up_all); |
| 238 | |
| 239 | /** |
Jeeja KP | c5b0c09 | 2015-08-21 21:36:18 +0530 | [diff] [blame] | 240 | * snd_hdac_ext_bus_link_power_down_all -power down all hda link |
| 241 | * @ebus: HD-audio extended bus |
| 242 | */ |
| 243 | int snd_hdac_ext_bus_link_power_down_all(struct hdac_ext_bus *ebus) |
| 244 | { |
| 245 | struct hdac_ext_link *hlink = NULL; |
| 246 | int ret; |
| 247 | |
| 248 | list_for_each_entry(hlink, &ebus->hlink_list, list) { |
| 249 | snd_hdac_updatel(hlink->ml_addr, AZX_REG_ML_LCTL, AZX_MLCTL_SPA, 0); |
| 250 | ret = check_hdac_link_power_active(hlink, false); |
| 251 | if (ret < 0) |
| 252 | return ret; |
| 253 | } |
| 254 | |
| 255 | return 0; |
| 256 | } |
| 257 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_power_down_all); |
Vinod Koul | 4446085d | 2016-05-12 08:58:53 +0530 | [diff] [blame] | 258 | |
| 259 | int snd_hdac_ext_bus_link_get(struct hdac_ext_bus *ebus, |
| 260 | struct hdac_ext_link *link) |
| 261 | { |
| 262 | int ret = 0; |
| 263 | |
| 264 | mutex_lock(&ebus->lock); |
| 265 | |
| 266 | /* |
| 267 | * if we move from 0 to 1, count will be 1 so power up this link |
| 268 | * as well, also check the dma status and trigger that |
| 269 | */ |
| 270 | if (++link->ref_count == 1) { |
| 271 | if (!ebus->cmd_dma_state) { |
| 272 | snd_hdac_bus_init_cmd_io(&ebus->bus); |
| 273 | ebus->cmd_dma_state = true; |
| 274 | } |
| 275 | |
| 276 | ret = snd_hdac_ext_bus_link_power_up(link); |
| 277 | } |
| 278 | |
| 279 | mutex_unlock(&ebus->lock); |
| 280 | return ret; |
| 281 | } |
| 282 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_get); |
| 283 | |
| 284 | int snd_hdac_ext_bus_link_put(struct hdac_ext_bus *ebus, |
| 285 | struct hdac_ext_link *link) |
| 286 | { |
| 287 | int ret = 0; |
| 288 | struct hdac_ext_link *hlink; |
| 289 | bool link_up = false; |
| 290 | |
| 291 | mutex_lock(&ebus->lock); |
| 292 | |
| 293 | /* |
| 294 | * if we move from 1 to 0, count will be 0 |
| 295 | * so power down this link as well |
| 296 | */ |
| 297 | if (--link->ref_count == 0) { |
| 298 | ret = snd_hdac_ext_bus_link_power_down(link); |
| 299 | |
| 300 | /* |
| 301 | * now check if all links are off, if so turn off |
| 302 | * cmd dma as well |
| 303 | */ |
| 304 | list_for_each_entry(hlink, &ebus->hlink_list, list) { |
| 305 | if (hlink->ref_count) { |
| 306 | link_up = true; |
| 307 | break; |
| 308 | } |
| 309 | } |
| 310 | |
| 311 | if (!link_up) { |
| 312 | snd_hdac_bus_stop_cmd_io(&ebus->bus); |
| 313 | ebus->cmd_dma_state = false; |
| 314 | } |
| 315 | } |
| 316 | |
| 317 | mutex_unlock(&ebus->lock); |
| 318 | return ret; |
| 319 | } |
| 320 | EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_link_put); |