Duncan Laurie | c2891f1 | 2020-04-29 12:34:38 -0700 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
| 2 | |
| 3 | #include <acpi/acpigen.h> |
| 4 | #include <acpi/acpi_device.h> |
| 5 | #include <acpi/acpi_soundwire.h> |
| 6 | #include <commonlib/helpers.h> |
| 7 | #include <device/device.h> |
Duncan Laurie | c2891f1 | 2020-04-29 12:34:38 -0700 | [diff] [blame] | 8 | #include <device/soundwire.h> |
| 9 | #include <stdbool.h> |
Duncan Laurie | c2891f1 | 2020-04-29 12:34:38 -0700 | [diff] [blame] | 10 | |
| 11 | #include "soundwire.h" |
| 12 | #include "chip.h" |
| 13 | |
| 14 | __weak int soc_fill_soundwire_controller(struct intel_soundwire_controller **controller) |
| 15 | { |
| 16 | return -1; |
| 17 | } |
| 18 | |
| 19 | static bool link_enabled(const struct device *dev, unsigned int link) |
| 20 | { |
| 21 | struct device *child; |
| 22 | |
Arthur Heymans | 7fcd4d5 | 2023-08-24 15:12:19 +0200 | [diff] [blame] | 23 | for (child = dev->downstream->children; child; child = child->sibling) { |
Duncan Laurie | c2891f1 | 2020-04-29 12:34:38 -0700 | [diff] [blame] | 24 | if (child->enabled && child->path.type == DEVICE_PATH_GENERIC && |
| 25 | child->path.generic.id == link) |
| 26 | return true; |
| 27 | } |
| 28 | return false; |
| 29 | } |
| 30 | |
| 31 | static void intel_soundwire_link_prop_cb(struct acpi_dp *dsd, unsigned int id, |
| 32 | const struct soundwire_controller *controller) |
| 33 | { |
| 34 | struct intel_soundwire_controller *intel_controller = |
| 35 | container_of(controller, struct intel_soundwire_controller, sdw); |
| 36 | unsigned int quirk_mask = intel_controller->quirk_mask; |
| 37 | |
| 38 | /* Disable link if no are children enabled on this link device. */ |
| 39 | if (!link_enabled(intel_controller->dev, id)) |
| 40 | quirk_mask |= INTEL_SOUNDWIRE_QUIRK_BUS_DISABLE; |
| 41 | |
| 42 | acpi_dp_add_integer(dsd, "intel-sdw-ip-clock", intel_controller->ip_clock); |
| 43 | acpi_dp_add_integer(dsd, "intel-quirk-mask", quirk_mask); |
| 44 | } |
| 45 | |
| 46 | static void intel_soundwire_fill_ssdt(const struct device *dev) |
| 47 | { |
| 48 | struct acpi_dp *dsd; |
| 49 | struct intel_soundwire_controller *controller; |
| 50 | const char *scope = acpi_device_scope(dev); |
| 51 | |
Karthikeyan Ramasubramanian | d1c0f95 | 2020-11-02 16:26:52 -0700 | [diff] [blame] | 52 | if (!scope) |
Duncan Laurie | c2891f1 | 2020-04-29 12:34:38 -0700 | [diff] [blame] | 53 | return; |
| 54 | |
| 55 | if (soc_fill_soundwire_controller(&controller) < 0 || !controller) |
| 56 | return; |
| 57 | |
| 58 | /* Provide device pointer for link property callback function. */ |
| 59 | controller->dev = dev; |
| 60 | |
| 61 | acpigen_write_scope(scope); |
| 62 | acpigen_write_device(acpi_device_name(dev)); |
| 63 | acpigen_write_name_string("_DDN", dev->chip_ops->name); |
| 64 | acpigen_write_name_integer("_ADR", controller->acpi_address); |
| 65 | acpigen_write_name_string("_CID", ACPI_HID_CONTAINER); |
| 66 | |
| 67 | acpigen_write_STA(acpi_device_status(dev)); |
| 68 | |
| 69 | dsd = acpi_dp_new_table("_DSD"); |
| 70 | soundwire_gen_controller(dsd, &controller->sdw, &intel_soundwire_link_prop_cb); |
| 71 | acpi_dp_write(dsd); |
| 72 | |
| 73 | acpigen_pop_len(); /* Device */ |
| 74 | acpigen_pop_len(); /* Scope */ |
| 75 | } |
| 76 | |
| 77 | static const char *intel_soundwire_acpi_name(const struct device *dev) |
| 78 | { |
| 79 | return "SNDW"; |
| 80 | } |
| 81 | |
| 82 | static struct device_operations intel_soundwire_ops = { |
| 83 | .read_resources = noop_read_resources, |
| 84 | .set_resources = noop_set_resources, |
| 85 | .acpi_name = intel_soundwire_acpi_name, |
| 86 | .acpi_fill_ssdt = intel_soundwire_fill_ssdt, |
| 87 | .scan_bus = scan_static_bus, |
| 88 | }; |
| 89 | |
| 90 | static void intel_soundwire_enable(struct device *dev) |
| 91 | { |
| 92 | dev->ops = &intel_soundwire_ops; |
| 93 | } |
| 94 | |
| 95 | struct chip_operations drivers_intel_soundwire_ops = { |
Nicholas Sudsgaard | bfb11be | 2024-01-30 09:53:46 +0900 | [diff] [blame] | 96 | .name = "Intel SoundWire Controller", |
Duncan Laurie | c2891f1 | 2020-04-29 12:34:38 -0700 | [diff] [blame] | 97 | .enable_dev = intel_soundwire_enable |
| 98 | }; |