drivers/platform/x86/intel/int3472/intel_skl_int3472_common.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Author: Dan Scally <[email protected]> */
   3
   4 #include <linux/acpi.h>
   5 #include <linux/i2c.h>
   6 #include <linux/platform_device.h>
   7 #include <linux/slab.h>
   8
   9 #include "intel_skl_int3472_common.h"
  10
  11 union acpi_object *skl_int3472_get_acpi_buffer(struct acpi_device *adev, char *id)
  12 {
  13         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
  14         acpi_handle handle = adev->handle;
  15         union acpi_object *obj;
  16         acpi_status status;
  17
  18         status = acpi_evaluate_object(handle, id, NULL, &buffer);
  19         if (ACPI_FAILURE(status))
  20                 return ERR_PTR(-ENODEV);
  21
  22         obj = buffer.pointer;
  23         if (!obj)
  24                 return ERR_PTR(-ENODEV);
  25
  26         if (obj->type != ACPI_TYPE_BUFFER) {
  27                 acpi_handle_err(handle, "%s object is not an ACPI buffer\n", id);
  28                 kfree(obj);
  29                 return ERR_PTR(-EINVAL);
  30         }
  31
  32         return obj;
  33 }
  34
  35 int skl_int3472_fill_cldb(struct acpi_device *adev, struct int3472_cldb *cldb)
  36 {
  37         union acpi_object *obj;
  38         int ret;
  39
  40         obj = skl_int3472_get_acpi_buffer(adev, "CLDB");
  41         if (IS_ERR(obj))
  42                 return PTR_ERR(obj);
  43
  44         if (obj->buffer.length > sizeof(*cldb)) {
  45                 acpi_handle_err(adev->handle, "The CLDB buffer is too large\n");
  46                 ret = -EINVAL;
  47                 goto out_free_obj;
  48         }
  49
  50         memcpy(cldb, obj->buffer.pointer, obj->buffer.length);
  51         ret = 0;
  52
  53 out_free_obj:
  54         kfree(obj);
  55         return ret;
  56 }
  57
  58 static const struct acpi_device_id int3472_device_id[] = {
  59         { "INT3472", 0 },
  60         { }
  61 };
  62 MODULE_DEVICE_TABLE(acpi, int3472_device_id);
  63
  64 static struct platform_driver int3472_discrete = {
  65         .driver = {
  66                 .name = "int3472-discrete",
  67                 .acpi_match_table = int3472_device_id,
  68         },
  69         .probe = skl_int3472_discrete_probe,
  70         .remove = skl_int3472_discrete_remove,
  71 };
  72
  73 static struct i2c_driver int3472_tps68470 = {
  74         .driver = {
  75                 .name = "int3472-tps68470",
  76                 .acpi_match_table = int3472_device_id,
  77         },
  78         .probe_new = skl_int3472_tps68470_probe,
  79 };
  80
  81 static int skl_int3472_init(void)
  82 {
  83         int ret;
  84
  85         ret = platform_driver_register(&int3472_discrete);
  86         if (ret)
  87                 return ret;
  88
  89         ret = i2c_register_driver(THIS_MODULE, &int3472_tps68470);
  90         if (ret)
  91                 platform_driver_unregister(&int3472_discrete);
  92
  93         return ret;
  94 }
  95 module_init(skl_int3472_init);
  96
  97 static void skl_int3472_exit(void)
  98 {
  99         platform_driver_unregister(&int3472_discrete);
 100         i2c_del_driver(&int3472_tps68470);
 101 }
 102 module_exit(skl_int3472_exit);
 103
 104 MODULE_DESCRIPTION("Intel SkyLake INT3472 ACPI Device Driver");
 105 MODULE_AUTHOR("Daniel Scally <[email protected]>");
 106 MODULE_LICENSE("GPL v2");