src/drivers/intel/soundwire/soundwire.c

   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>
   8 #include <device/soundwire.h>
   9 #include <stdbool.h>
  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
  23         for (child = dev->downstream->children; child; child = child->sibling) {
  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
  52         if (!scope)
  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 = {
  96         .name = "Intel SoundWire Controller",
  97         .enable_dev = intel_soundwire_enable
  98 };