Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 | // SPDX-License-Identifier: GPL-2.0 // // soc-apci.c - support for ACPI enumeration. // // Copyright (c) 2013-15, Intel Corporation. #include <linux/export.h> #include <linux/module.h> #include <sound/soc-acpi.h> static bool snd_soc_acpi_id_present(struct snd_soc_acpi_mach *machine) { const struct snd_soc_acpi_codecs *comp_ids = machine->comp_ids; int i; if (machine->id[0]) { if (acpi_dev_present(machine->id, NULL, -1)) return true; } if (comp_ids) { for (i = 0; i < comp_ids->num_codecs; i++) { if (acpi_dev_present(comp_ids->codecs[i], NULL, -1)) { strscpy(machine->id, comp_ids->codecs[i], ACPI_ID_LEN); return true; } } } return false; } struct snd_soc_acpi_mach * snd_soc_acpi_find_machine(struct snd_soc_acpi_mach *machines) { struct snd_soc_acpi_mach *mach; struct snd_soc_acpi_mach *mach_alt; for (mach = machines; mach->id[0] || mach->comp_ids; mach++) { if (snd_soc_acpi_id_present(mach)) { if (mach->machine_quirk) { mach_alt = mach->machine_quirk(mach); if (!mach_alt) continue; /* not full match, ignore */ mach = mach_alt; } return mach; } } return NULL; } EXPORT_SYMBOL_GPL(snd_soc_acpi_find_machine); static acpi_status snd_soc_acpi_find_package(acpi_handle handle, u32 level, void *context, void **ret) { struct acpi_device *adev = acpi_fetch_acpi_dev(handle); acpi_status status; struct snd_soc_acpi_package_context *pkg_ctx = context; pkg_ctx->data_valid = false; if (adev && adev->status.present && adev->status.functional) { struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; union acpi_object *myobj = NULL; status = acpi_evaluate_object_typed(handle, pkg_ctx->name, NULL, &buffer, ACPI_TYPE_PACKAGE); if (ACPI_FAILURE(status)) return AE_OK; myobj = buffer.pointer; if (!myobj || myobj->package.count != pkg_ctx->length) { kfree(buffer.pointer); return AE_OK; } status = acpi_extract_package(myobj, pkg_ctx->format, pkg_ctx->state); if (ACPI_FAILURE(status)) { kfree(buffer.pointer); return AE_OK; } kfree(buffer.pointer); pkg_ctx->data_valid = true; return AE_CTRL_TERMINATE; } return AE_OK; } bool snd_soc_acpi_find_package_from_hid(const u8 hid[ACPI_ID_LEN], struct snd_soc_acpi_package_context *ctx) { acpi_status status; status = acpi_get_devices(hid, snd_soc_acpi_find_package, ctx, NULL); if (ACPI_FAILURE(status) || !ctx->data_valid) return false; return true; } EXPORT_SYMBOL_GPL(snd_soc_acpi_find_package_from_hid); struct snd_soc_acpi_mach *snd_soc_acpi_codec_list(void *arg) { struct snd_soc_acpi_mach *mach = arg; struct snd_soc_acpi_codecs *codec_list = (struct snd_soc_acpi_codecs *) mach->quirk_data; int i; if (mach->quirk_data == NULL) return mach; for (i = 0; i < codec_list->num_codecs; i++) { if (!acpi_dev_present(codec_list->codecs[i], NULL, -1)) return NULL; } return mach; } EXPORT_SYMBOL_GPL(snd_soc_acpi_codec_list); #define SDW_CODEC_ADR_MASK(_adr) ((_adr) & (SDW_DISCO_LINK_ID_MASK | SDW_VERSION_MASK | \ SDW_MFG_ID_MASK | SDW_PART_ID_MASK)) /* Check if all Slaves defined on the link can be found */ bool snd_soc_acpi_sdw_link_slaves_found(struct device *dev, const struct snd_soc_acpi_link_adr *link, struct sdw_extended_slave_id *ids, int num_slaves) { unsigned int part_id, link_id, unique_id, mfg_id, version; int i, j, k; for (i = 0; i < link->num_adr; i++) { u64 adr = link->adr_d[i].adr; int reported_part_count = 0; mfg_id = SDW_MFG_ID(adr); part_id = SDW_PART_ID(adr); link_id = SDW_DISCO_LINK_ID(adr); version = SDW_VERSION(adr); for (j = 0; j < num_slaves; j++) { /* find out how many identical parts were reported on that link */ if (ids[j].link_id == link_id && ids[j].id.part_id == part_id && ids[j].id.mfg_id == mfg_id && ids[j].id.sdw_version == version) reported_part_count++; } for (j = 0; j < num_slaves; j++) { int expected_part_count = 0; if (ids[j].link_id != link_id || ids[j].id.part_id != part_id || ids[j].id.mfg_id != mfg_id || ids[j].id.sdw_version != version) continue; /* find out how many identical parts are expected */ for (k = 0; k < link->num_adr; k++) { u64 adr2 = link->adr_d[k].adr; if (SDW_CODEC_ADR_MASK(adr2) == SDW_CODEC_ADR_MASK(adr)) expected_part_count++; } if (reported_part_count == expected_part_count) { /* * we have to check unique id * if there is more than one * Slave on the link */ unique_id = SDW_UNIQUE_ID(adr); if (reported_part_count == 1 || ids[j].id.unique_id == unique_id) { dev_dbg(dev, "found part_id %#x at link %d\n", part_id, link_id); break; } } else { dev_dbg(dev, "part_id %#x reported %d expected %d on link %d, skipping\n", part_id, reported_part_count, expected_part_count, link_id); } } if (j == num_slaves) { dev_dbg(dev, "Slave part_id %#x not found\n", part_id); return false; } } return true; } EXPORT_SYMBOL_GPL(snd_soc_acpi_sdw_link_slaves_found); MODULE_LICENSE("GPL v2"); MODULE_DESCRIPTION("ALSA SoC ACPI module"); |