.. | .. |
---|
17 | 17 | |
---|
18 | 18 | static DEFINE_IDA(soc_ida); |
---|
19 | 19 | |
---|
20 | | -static ssize_t soc_info_get(struct device *dev, |
---|
21 | | - struct device_attribute *attr, |
---|
22 | | - char *buf); |
---|
| 20 | +/* Prototype to allow declarations of DEVICE_ATTR(<foo>) before soc_info_show */ |
---|
| 21 | +static ssize_t soc_info_show(struct device *dev, struct device_attribute *attr, |
---|
| 22 | + char *buf); |
---|
23 | 23 | |
---|
24 | 24 | struct soc_device { |
---|
25 | 25 | struct device dev; |
---|
.. | .. |
---|
31 | 31 | .name = "soc", |
---|
32 | 32 | }; |
---|
33 | 33 | |
---|
34 | | -static DEVICE_ATTR(machine, S_IRUGO, soc_info_get, NULL); |
---|
35 | | -static DEVICE_ATTR(family, S_IRUGO, soc_info_get, NULL); |
---|
36 | | -static DEVICE_ATTR(soc_id, S_IRUGO, soc_info_get, NULL); |
---|
37 | | -static DEVICE_ATTR(revision, S_IRUGO, soc_info_get, NULL); |
---|
| 34 | +static DEVICE_ATTR(machine, 0444, soc_info_show, NULL); |
---|
| 35 | +static DEVICE_ATTR(family, 0444, soc_info_show, NULL); |
---|
| 36 | +static DEVICE_ATTR(serial_number, 0444, soc_info_show, NULL); |
---|
| 37 | +static DEVICE_ATTR(soc_id, 0444, soc_info_show, NULL); |
---|
| 38 | +static DEVICE_ATTR(revision, 0444, soc_info_show, NULL); |
---|
38 | 39 | |
---|
39 | 40 | struct device *soc_device_to_device(struct soc_device *soc_dev) |
---|
40 | 41 | { |
---|
41 | 42 | return &soc_dev->dev; |
---|
42 | 43 | } |
---|
43 | | -EXPORT_SYMBOL_GPL(soc_device_to_device); |
---|
44 | 44 | |
---|
45 | 45 | static umode_t soc_attribute_mode(struct kobject *kobj, |
---|
46 | 46 | struct attribute *attr, |
---|
47 | 47 | int index) |
---|
48 | 48 | { |
---|
49 | | - struct device *dev = container_of(kobj, struct device, kobj); |
---|
| 49 | + struct device *dev = kobj_to_dev(kobj); |
---|
50 | 50 | struct soc_device *soc_dev = container_of(dev, struct soc_device, dev); |
---|
51 | 51 | |
---|
52 | | - if ((attr == &dev_attr_machine.attr) |
---|
53 | | - && (soc_dev->attr->machine != NULL)) |
---|
| 52 | + if ((attr == &dev_attr_machine.attr) && soc_dev->attr->machine) |
---|
54 | 53 | return attr->mode; |
---|
55 | | - if ((attr == &dev_attr_family.attr) |
---|
56 | | - && (soc_dev->attr->family != NULL)) |
---|
| 54 | + if ((attr == &dev_attr_family.attr) && soc_dev->attr->family) |
---|
57 | 55 | return attr->mode; |
---|
58 | | - if ((attr == &dev_attr_revision.attr) |
---|
59 | | - && (soc_dev->attr->revision != NULL)) |
---|
| 56 | + if ((attr == &dev_attr_revision.attr) && soc_dev->attr->revision) |
---|
60 | 57 | return attr->mode; |
---|
61 | | - if ((attr == &dev_attr_soc_id.attr) |
---|
62 | | - && (soc_dev->attr->soc_id != NULL)) |
---|
| 58 | + if ((attr == &dev_attr_serial_number.attr) && soc_dev->attr->serial_number) |
---|
| 59 | + return attr->mode; |
---|
| 60 | + if ((attr == &dev_attr_soc_id.attr) && soc_dev->attr->soc_id) |
---|
63 | 61 | return attr->mode; |
---|
64 | 62 | |
---|
65 | | - /* Unknown or unfilled attribute. */ |
---|
| 63 | + /* Unknown or unfilled attribute */ |
---|
66 | 64 | return 0; |
---|
67 | 65 | } |
---|
68 | 66 | |
---|
69 | | -static ssize_t soc_info_get(struct device *dev, |
---|
70 | | - struct device_attribute *attr, |
---|
71 | | - char *buf) |
---|
| 67 | +static ssize_t soc_info_show(struct device *dev, struct device_attribute *attr, |
---|
| 68 | + char *buf) |
---|
72 | 69 | { |
---|
73 | 70 | struct soc_device *soc_dev = container_of(dev, struct soc_device, dev); |
---|
| 71 | + const char *output; |
---|
74 | 72 | |
---|
75 | 73 | if (attr == &dev_attr_machine) |
---|
76 | | - return sprintf(buf, "%s\n", soc_dev->attr->machine); |
---|
77 | | - if (attr == &dev_attr_family) |
---|
78 | | - return sprintf(buf, "%s\n", soc_dev->attr->family); |
---|
79 | | - if (attr == &dev_attr_revision) |
---|
80 | | - return sprintf(buf, "%s\n", soc_dev->attr->revision); |
---|
81 | | - if (attr == &dev_attr_soc_id) |
---|
82 | | - return sprintf(buf, "%s\n", soc_dev->attr->soc_id); |
---|
| 74 | + output = soc_dev->attr->machine; |
---|
| 75 | + else if (attr == &dev_attr_family) |
---|
| 76 | + output = soc_dev->attr->family; |
---|
| 77 | + else if (attr == &dev_attr_revision) |
---|
| 78 | + output = soc_dev->attr->revision; |
---|
| 79 | + else if (attr == &dev_attr_serial_number) |
---|
| 80 | + output = soc_dev->attr->serial_number; |
---|
| 81 | + else if (attr == &dev_attr_soc_id) |
---|
| 82 | + output = soc_dev->attr->soc_id; |
---|
| 83 | + else |
---|
| 84 | + return -EINVAL; |
---|
83 | 85 | |
---|
84 | | - return -EINVAL; |
---|
85 | | - |
---|
| 86 | + return sysfs_emit(buf, "%s\n", output); |
---|
86 | 87 | } |
---|
87 | 88 | |
---|
88 | 89 | static struct attribute *soc_attr[] = { |
---|
89 | 90 | &dev_attr_machine.attr, |
---|
90 | 91 | &dev_attr_family.attr, |
---|
| 92 | + &dev_attr_serial_number.attr, |
---|
91 | 93 | &dev_attr_soc_id.attr, |
---|
92 | 94 | &dev_attr_revision.attr, |
---|
93 | 95 | NULL, |
---|
.. | .. |
---|
98 | 100 | .is_visible = soc_attribute_mode, |
---|
99 | 101 | }; |
---|
100 | 102 | |
---|
101 | | -static const struct attribute_group *soc_attr_groups[] = { |
---|
102 | | - &soc_attr_group, |
---|
103 | | - NULL, |
---|
104 | | -}; |
---|
105 | | - |
---|
106 | 103 | static void soc_release(struct device *dev) |
---|
107 | 104 | { |
---|
108 | 105 | struct soc_device *soc_dev = container_of(dev, struct soc_device, dev); |
---|
109 | 106 | |
---|
| 107 | + ida_simple_remove(&soc_ida, soc_dev->soc_dev_num); |
---|
| 108 | + kfree(soc_dev->dev.groups); |
---|
110 | 109 | kfree(soc_dev); |
---|
111 | 110 | } |
---|
112 | 111 | |
---|
.. | .. |
---|
115 | 114 | struct soc_device *soc_device_register(struct soc_device_attribute *soc_dev_attr) |
---|
116 | 115 | { |
---|
117 | 116 | struct soc_device *soc_dev; |
---|
| 117 | + const struct attribute_group **soc_attr_groups; |
---|
118 | 118 | int ret; |
---|
119 | 119 | |
---|
120 | 120 | if (!soc_bus_type.p) { |
---|
.. | .. |
---|
130 | 130 | goto out1; |
---|
131 | 131 | } |
---|
132 | 132 | |
---|
| 133 | + soc_attr_groups = kcalloc(3, sizeof(*soc_attr_groups), GFP_KERNEL); |
---|
| 134 | + if (!soc_attr_groups) { |
---|
| 135 | + ret = -ENOMEM; |
---|
| 136 | + goto out2; |
---|
| 137 | + } |
---|
| 138 | + soc_attr_groups[0] = &soc_attr_group; |
---|
| 139 | + soc_attr_groups[1] = soc_dev_attr->custom_attr_group; |
---|
| 140 | + |
---|
133 | 141 | /* Fetch a unique (reclaimable) SOC ID. */ |
---|
134 | 142 | ret = ida_simple_get(&soc_ida, 0, 0, GFP_KERNEL); |
---|
135 | 143 | if (ret < 0) |
---|
136 | | - goto out2; |
---|
| 144 | + goto out3; |
---|
137 | 145 | soc_dev->soc_dev_num = ret; |
---|
138 | 146 | |
---|
139 | 147 | soc_dev->attr = soc_dev_attr; |
---|
.. | .. |
---|
144 | 152 | dev_set_name(&soc_dev->dev, "soc%d", soc_dev->soc_dev_num); |
---|
145 | 153 | |
---|
146 | 154 | ret = device_register(&soc_dev->dev); |
---|
147 | | - if (ret) |
---|
148 | | - goto out3; |
---|
| 155 | + if (ret) { |
---|
| 156 | + put_device(&soc_dev->dev); |
---|
| 157 | + return ERR_PTR(ret); |
---|
| 158 | + } |
---|
149 | 159 | |
---|
150 | 160 | return soc_dev; |
---|
151 | 161 | |
---|
152 | 162 | out3: |
---|
153 | | - ida_simple_remove(&soc_ida, soc_dev->soc_dev_num); |
---|
154 | | - put_device(&soc_dev->dev); |
---|
155 | | - soc_dev = NULL; |
---|
| 163 | + kfree(soc_attr_groups); |
---|
156 | 164 | out2: |
---|
157 | 165 | kfree(soc_dev); |
---|
158 | 166 | out1: |
---|
.. | .. |
---|
163 | 171 | /* Ensure soc_dev->attr is freed prior to calling soc_device_unregister. */ |
---|
164 | 172 | void soc_device_unregister(struct soc_device *soc_dev) |
---|
165 | 173 | { |
---|
166 | | - ida_simple_remove(&soc_ida, soc_dev->soc_dev_num); |
---|
167 | | - |
---|
168 | 174 | device_unregister(&soc_dev->dev); |
---|
169 | 175 | early_soc_dev_attr = NULL; |
---|
170 | 176 | } |
---|