hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
// SPDX-License-Identifier: GPL-2.0-only
 
/*
 * ACPI support for platform bus type.
 *
 * Copyright (C) 2015, Linaro Ltd
 * Author: Graeme Gregory <graeme.gregory@linaro.org>
 */
 
#include <linux/acpi.h>
#include <linux/amba/bus.h>
#include <linux/clkdev.h>
#include <linux/clk-provider.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/ioport.h>
#include <linux/kernel.h>
#include <linux/module.h>
 
#include "internal.h"
 
static const struct acpi_device_id amba_id_list[] = {
   {"ARMH0061", 0}, /* PL061 GPIO Device */
   {"ARMHC500", 0}, /* ARM CoreSight ETM4x */
   {"ARMHC501", 0}, /* ARM CoreSight ETR */
   {"ARMHC502", 0}, /* ARM CoreSight STM */
   {"ARMHC503", 0}, /* ARM CoreSight Debug */
   {"ARMHC979", 0}, /* ARM CoreSight TPIU */
   {"ARMHC97C", 0}, /* ARM CoreSight SoC-400 TMC, SoC-600 ETF/ETB */
   {"ARMHC98D", 0}, /* ARM CoreSight Dynamic Replicator */
   {"ARMHC9CA", 0}, /* ARM CoreSight CATU */
   {"ARMHC9FF", 0}, /* ARM CoreSight Dynamic Funnel */
   {"", 0},
};
 
static void amba_register_dummy_clk(void)
{
   static struct clk *amba_dummy_clk;
 
   /* If clock already registered */
   if (amba_dummy_clk)
       return;
 
   amba_dummy_clk = clk_register_fixed_rate(NULL, "apb_pclk", NULL, 0, 0);
   clk_register_clkdev(amba_dummy_clk, "apb_pclk", NULL);
}
 
static int amba_handler_attach(struct acpi_device *adev,
               const struct acpi_device_id *id)
{
   struct amba_device *dev;
   struct resource_entry *rentry;
   struct list_head resource_list;
   bool address_found = false;
   int irq_no = 0;
   int ret;
 
   /* If the ACPI node already has a physical device attached, skip it. */
   if (adev->physical_node_count)
       return 0;
 
   dev = amba_device_alloc(dev_name(&adev->dev), 0, 0);
   if (!dev) {
       dev_err(&adev->dev, "%s(): amba_device_alloc() failed\n",
           __func__);
       return -ENOMEM;
   }
 
   INIT_LIST_HEAD(&resource_list);
   ret = acpi_dev_get_resources(adev, &resource_list, NULL, NULL);
   if (ret < 0)
       goto err_free;
 
   list_for_each_entry(rentry, &resource_list, node) {
       switch (resource_type(rentry->res)) {
       case IORESOURCE_MEM:
           if (!address_found) {
               dev->res = *rentry->res;
               dev->res.name = dev_name(&dev->dev);
               address_found = true;
           }
           break;
       case IORESOURCE_IRQ:
           if (irq_no < AMBA_NR_IRQS)
               dev->irq[irq_no++] = rentry->res->start;
           break;
       default:
           dev_warn(&adev->dev, "Invalid resource\n");
           break;
       }
   }
 
   acpi_dev_free_resource_list(&resource_list);
 
   /*
    * If the ACPI node has a parent and that parent has a physical device
    * attached to it, that physical device should be the parent of
    * the amba device we are about to create.
    */
   if (adev->parent)
       dev->dev.parent = acpi_get_first_physical_node(adev->parent);
 
   ACPI_COMPANION_SET(&dev->dev, adev);
 
   ret = amba_device_add(dev, &iomem_resource);
   if (ret) {
       dev_err(&adev->dev, "%s(): amba_device_add() failed (%d)\n",
              __func__, ret);
       goto err_free;
   }
 
   return 1;
 
err_free:
   amba_device_put(dev);
   return ret;
}
 
static struct acpi_scan_handler amba_handler = {
   .ids = amba_id_list,
   .attach = amba_handler_attach,
};
 
void __init acpi_amba_init(void)
{
   amba_register_dummy_clk();
   acpi_scan_add_handler(&amba_handler);
}