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