1 // SPDX-License-Identifier: GPL-2.0-only 1 // SPDX-License-Identifier: GPL-2.0-only 2 // Copyright (c) 2015-2019 Intel Corporation 2 // Copyright (c) 2015-2019 Intel Corporation 3 3 4 #include <linux/acpi.h> 4 #include <linux/acpi.h> 5 #include <sound/intel-nhlt.h> 5 #include <sound/intel-nhlt.h> 6 6 7 struct nhlt_acpi_table *intel_nhlt_init(struct 7 struct nhlt_acpi_table *intel_nhlt_init(struct device *dev) 8 { 8 { 9 struct nhlt_acpi_table *nhlt; 9 struct nhlt_acpi_table *nhlt; 10 acpi_status status; 10 acpi_status status; 11 11 12 status = acpi_get_table(ACPI_SIG_NHLT, 12 status = acpi_get_table(ACPI_SIG_NHLT, 0, 13 (struct acpi_t 13 (struct acpi_table_header **)&nhlt); 14 if (ACPI_FAILURE(status)) { 14 if (ACPI_FAILURE(status)) { 15 dev_warn(dev, "NHLT table not 15 dev_warn(dev, "NHLT table not found\n"); 16 return NULL; 16 return NULL; 17 } 17 } 18 18 19 return nhlt; 19 return nhlt; 20 } 20 } 21 EXPORT_SYMBOL_GPL(intel_nhlt_init); 21 EXPORT_SYMBOL_GPL(intel_nhlt_init); 22 22 23 void intel_nhlt_free(struct nhlt_acpi_table *n 23 void intel_nhlt_free(struct nhlt_acpi_table *nhlt) 24 { 24 { 25 acpi_put_table((struct acpi_table_head 25 acpi_put_table((struct acpi_table_header *)nhlt); 26 } 26 } 27 EXPORT_SYMBOL_GPL(intel_nhlt_free); 27 EXPORT_SYMBOL_GPL(intel_nhlt_free); 28 28 29 int intel_nhlt_get_dmic_geo(struct device *dev 29 int intel_nhlt_get_dmic_geo(struct device *dev, struct nhlt_acpi_table *nhlt) 30 { 30 { 31 struct nhlt_endpoint *epnt; 31 struct nhlt_endpoint *epnt; 32 struct nhlt_dmic_array_config *cfg; 32 struct nhlt_dmic_array_config *cfg; 33 struct nhlt_vendor_dmic_array_config * 33 struct nhlt_vendor_dmic_array_config *cfg_vendor; 34 struct nhlt_fmt *fmt_configs; << 35 unsigned int dmic_geo = 0; 34 unsigned int dmic_geo = 0; 36 u16 max_ch = 0; !! 35 u8 j; 37 u8 i, j; << 38 36 39 if (!nhlt) 37 if (!nhlt) 40 return 0; 38 return 0; 41 39 42 if (nhlt->header.length <= sizeof(stru !! 40 epnt = (struct nhlt_endpoint *)nhlt->desc; 43 dev_warn(dev, "Invalid DMIC de << 44 return 0; << 45 } << 46 << 47 for (j = 0, epnt = nhlt->desc; j < nhl << 48 epnt = (struct nhlt_endpoint *)(( << 49 << 50 if (epnt->linktype != NHLT_LIN << 51 continue; << 52 << 53 cfg = (struct nhlt_dmic_array_ << 54 fmt_configs = (struct nhlt_fmt << 55 << 56 /* find max number of channels << 57 if (fmt_configs->fmt_count) { << 58 struct nhlt_fmt_cfg *f << 59 << 60 dev_dbg(dev, "found %d << 61 fmt_configs->f << 62 << 63 for (i = 0; i < fmt_co << 64 struct wav_fmt << 65 << 66 fmt_ext = &fmt << 67 << 68 if (fmt_ext->f << 69 max_ch << 70 << 71 /* Move to the << 72 fmt_cfg = (str << 73 << 74 } << 75 dev_dbg(dev, "max chan << 76 } else { << 77 dev_dbg(dev, "No forma << 78 } << 79 41 80 if (cfg->device_config.config_ !! 42 for (j = 0; j < nhlt->endpoint_count; j++) { 81 dmic_geo = max_ch; !! 43 if (epnt->linktype == NHLT_LINK_DMIC) { 82 } else { !! 44 cfg = (struct nhlt_dmic_array_config *) >> 45 (epnt->config.caps); 83 switch (cfg->array_typ 46 switch (cfg->array_type) { 84 case NHLT_MIC_ARRAY_2C 47 case NHLT_MIC_ARRAY_2CH_SMALL: 85 case NHLT_MIC_ARRAY_2C 48 case NHLT_MIC_ARRAY_2CH_BIG: 86 dmic_geo = MIC 49 dmic_geo = MIC_ARRAY_2CH; 87 break; 50 break; 88 51 89 case NHLT_MIC_ARRAY_4C 52 case NHLT_MIC_ARRAY_4CH_1ST_GEOM: 90 case NHLT_MIC_ARRAY_4C 53 case NHLT_MIC_ARRAY_4CH_L_SHAPED: 91 case NHLT_MIC_ARRAY_4C 54 case NHLT_MIC_ARRAY_4CH_2ND_GEOM: 92 dmic_geo = MIC 55 dmic_geo = MIC_ARRAY_4CH; 93 break; 56 break; 94 case NHLT_MIC_ARRAY_VE 57 case NHLT_MIC_ARRAY_VENDOR_DEFINED: 95 cfg_vendor = ( 58 cfg_vendor = (struct nhlt_vendor_dmic_array_config *)cfg; 96 dmic_geo = cfg 59 dmic_geo = cfg_vendor->nb_mics; 97 break; 60 break; 98 default: 61 default: 99 dev_warn(dev, !! 62 dev_warn(dev, "undefined DMIC array_type 0x%0x\n", 100 __fun !! 63 cfg->array_type); 101 } << 102 << 103 if (dmic_geo > 0) { << 104 dev_dbg(dev, " << 105 } << 106 if (max_ch > dmic_geo) << 107 dev_dbg(dev, " << 108 max_ch << 109 } 64 } 110 } 65 } >> 66 epnt = (struct nhlt_endpoint *)((u8 *)epnt + epnt->length); 111 } 67 } 112 68 113 dev_dbg(dev, "dmic number %d max_ch %d << 114 << 115 return dmic_geo; 69 return dmic_geo; 116 } 70 } 117 EXPORT_SYMBOL_GPL(intel_nhlt_get_dmic_geo); 71 EXPORT_SYMBOL_GPL(intel_nhlt_get_dmic_geo); 118 << 119 bool intel_nhlt_has_endpoint_type(struct nhlt_ << 120 { << 121 struct nhlt_endpoint *epnt; << 122 int i; << 123 << 124 if (!nhlt) << 125 return false; << 126 << 127 epnt = (struct nhlt_endpoint *)nhlt->d << 128 for (i = 0; i < nhlt->endpoint_count; << 129 if (epnt->linktype == link_typ << 130 return true; << 131 << 132 epnt = (struct nhlt_endpoint * << 133 } << 134 return false; << 135 } << 136 EXPORT_SYMBOL(intel_nhlt_has_endpoint_type); << 137 << 138 int intel_nhlt_ssp_endpoint_mask(struct nhlt_a << 139 { << 140 struct nhlt_endpoint *epnt; << 141 int ssp_mask = 0; << 142 int i; << 143 << 144 if (!nhlt || (device_type != NHLT_DEVI << 145 return 0; << 146 << 147 epnt = (struct nhlt_endpoint *)nhlt->d << 148 for (i = 0; i < nhlt->endpoint_count; << 149 if (epnt->linktype == NHLT_LIN << 150 /* for SSP the virtual << 151 ssp_mask |= BIT(epnt-> << 152 } << 153 epnt = (struct nhlt_endpoint * << 154 } << 155 << 156 return ssp_mask; << 157 } << 158 EXPORT_SYMBOL(intel_nhlt_ssp_endpoint_mask); << 159 << 160 #define SSP_BLOB_V1_0_SIZE 84 << 161 #define SSP_BLOB_V1_0_MDIVC_OFFSET 19 /* << 162 << 163 #define SSP_BLOB_V1_5_SIZE 96 << 164 #define SSP_BLOB_V1_5_MDIVC_OFFSET 21 /* << 165 #define SSP_BLOB_VER_1_5 0xEE00 << 166 << 167 #define SSP_BLOB_V2_0_SIZE 88 << 168 #define SSP_BLOB_V2_0_MDIVC_OFFSET 20 /* << 169 #define SSP_BLOB_VER_2_0 0xEE00 << 170 << 171 int intel_nhlt_ssp_mclk_mask(struct nhlt_acpi_ << 172 { << 173 struct nhlt_endpoint *epnt; << 174 struct nhlt_fmt *fmt; << 175 struct nhlt_fmt_cfg *cfg; << 176 int mclk_mask = 0; << 177 int i, j; << 178 << 179 if (!nhlt) << 180 return 0; << 181 << 182 epnt = (struct nhlt_endpoint *)nhlt->d << 183 for (i = 0; i < nhlt->endpoint_count; << 184 << 185 /* we only care about endpoint << 186 if (epnt->linktype == NHLT_LIN << 187 epnt->device_type == NHLT_ << 188 epnt->virtual_bus_id == ss << 189 << 190 fmt = (struct nhlt_fmt << 191 cfg = fmt->fmt_config; << 192 << 193 /* << 194 * In theory all forma << 195 * double-check that t << 196 */ << 197 for (j = 0; j < fmt->f << 198 u32 *blob; << 199 int mdivc_offs << 200 int size; << 201 << 202 /* first check << 203 if (cfg->confi << 204 return << 205 << 206 blob = (u32 *) << 207 << 208 if (blob[1] == << 209 mdivc_ << 210 size = << 211 } else if (blo << 212 mdivc_ << 213 size = << 214 } else { << 215 mdivc_ << 216 size = << 217 } << 218 << 219 /* make sure w << 220 if (cfg->confi << 221 return << 222 << 223 mclk_mask |= << 224 << 225 cfg = (struct << 226 } << 227 } << 228 epnt = (struct nhlt_endpoint * << 229 } << 230 << 231 /* make sure only one MCLK is used */ << 232 if (hweight_long(mclk_mask) != 1) << 233 return -EINVAL; << 234 << 235 return mclk_mask; << 236 } << 237 EXPORT_SYMBOL(intel_nhlt_ssp_mclk_mask); << 238 << 239 static struct nhlt_specific_cfg * << 240 nhlt_get_specific_cfg(struct device *dev, stru << 241 u32 rate, u8 vbps, u8 bp << 242 { << 243 struct nhlt_fmt_cfg *cfg = fmt->fmt_co << 244 struct wav_fmt *wfmt; << 245 u16 _bps, _vbps; << 246 int i; << 247 << 248 dev_dbg(dev, "Endpoint format count=%d << 249 << 250 for (i = 0; i < fmt->fmt_count; i++) { << 251 wfmt = &cfg->fmt_ext.fmt; << 252 _bps = wfmt->bits_per_sample; << 253 _vbps = cfg->fmt_ext.sample.va << 254 << 255 dev_dbg(dev, "Endpoint format: << 256 wfmt->channels, _vbps, << 257 << 258 /* << 259 * When looking for exact matc << 260 * from NHLT table when ignore << 261 */ << 262 if (wfmt->channels == num_ch & << 263 (ignore_vbps || vbps == _v << 264 return &cfg->config; << 265 << 266 cfg = (struct nhlt_fmt_cfg *)( << 267 } << 268 << 269 return NULL; << 270 } << 271 << 272 static bool nhlt_check_ep_match(struct device << 273 u32 bus_id, u8 << 274 { << 275 dev_dbg(dev, "Endpoint: vbus_id=%d lin << 276 epnt->virtual_bus_id, epnt->li << 277 epnt->direction, epnt->device_ << 278 << 279 if ((epnt->virtual_bus_id != bus_id) | << 280 (epnt->linktype != link_type) || << 281 (epnt->direction != dir)) << 282 return false; << 283 << 284 /* link of type DMIC bypasses device_t << 285 return epnt->linktype == NHLT_LINK_DMI << 286 epnt->device_type == dev_type; << 287 } << 288 << 289 struct nhlt_specific_cfg * << 290 intel_nhlt_get_endpoint_blob(struct device *de << 291 u32 bus_id, u8 li << 292 u8 num_ch, u32 ra << 293 { << 294 struct nhlt_specific_cfg *cfg; << 295 struct nhlt_endpoint *epnt; << 296 bool ignore_vbps = false; << 297 struct nhlt_fmt *fmt; << 298 int i; << 299 << 300 if (!nhlt) << 301 return NULL; << 302 << 303 dev_dbg(dev, "Looking for configuratio << 304 dev_dbg(dev, " vbus_id=%d link_type=% << 305 bus_id, link_type, dir, dev_ty << 306 if (link_type == NHLT_LINK_DMIC && bps << 307 /* << 308 * The DMIC hardware supports << 309 * size, which is 24 bit sampl << 310 * are used for indicating the << 311 * It has been observed that s << 312 * specified as 32 while some << 313 * The format these variations << 314 * hardware is configured and << 315 * Note: when the samples assu << 316 * introduced by the lower two << 317 * real life implication on au << 318 */ << 319 dev_dbg(dev, << 320 " ch=%d fmt=%d rate=% << 321 num_ch, bps, rate); << 322 ignore_vbps = true; << 323 } else { << 324 dev_dbg(dev, " ch=%d fmt=%d/% << 325 } << 326 dev_dbg(dev, "Endpoint count=%d\n", nh << 327 << 328 epnt = (struct nhlt_endpoint *)nhlt->d << 329 << 330 for (i = 0; i < nhlt->endpoint_count; << 331 if (nhlt_check_ep_match(dev, e << 332 fmt = (struct nhlt_fmt << 333 << 334 cfg = nhlt_get_specifi << 335 << 336 if (cfg) << 337 return cfg; << 338 } << 339 << 340 epnt = (struct nhlt_endpoint * << 341 } << 342 << 343 return NULL; << 344 } << 345 EXPORT_SYMBOL(intel_nhlt_get_endpoint_blob); << 346 << 347 int intel_nhlt_ssp_device_type(struct device * << 348 u8 virtual_bus_ << 349 { << 350 struct nhlt_endpoint *epnt; << 351 int i; << 352 << 353 if (!nhlt) << 354 return -EINVAL; << 355 << 356 epnt = (struct nhlt_endpoint *)nhlt->d << 357 for (i = 0; i < nhlt->endpoint_count; << 358 /* for SSP link the virtual bu << 359 if (epnt->linktype == NHLT_LIN << 360 epnt->virtual_bus_id == vi << 361 dev_dbg(dev, "SSP%d: d << 362 epnt->device_t << 363 return epnt->device_ty << 364 } << 365 << 366 epnt = (struct nhlt_endpoint * << 367 } << 368 << 369 return -EINVAL; << 370 } << 371 EXPORT_SYMBOL(intel_nhlt_ssp_device_type); << 372 72
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.