2 * arch/ppc/syslib/ppc_sys.c
4 * PPC System library functions
6 * Maintainer: Kumar Gala <galak@kernel.crashing.org>
8 * Copyright 2005 Freescale Semiconductor Inc.
9 * Copyright 2005 MontaVista, Inc. by Vitaly Bordug <vbordug@ru.mvista.com>
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License as published by the
13 * Free Software Foundation; either version 2 of the License, or (at your
14 * option) any later version.
17 #include <linux/string.h>
18 #include <linux/bootmem.h>
19 #include <asm/ppc_sys.h>
21 int (*ppc_sys_device_fixup) (struct platform_device * pdev);
23 static int ppc_sys_inited;
24 static int ppc_sys_func_inited;
26 static const char *ppc_sys_func_names[] = {
27 [PPC_SYS_FUNC_DUMMY] = "dummy",
28 [PPC_SYS_FUNC_ETH] = "eth",
29 [PPC_SYS_FUNC_UART] = "uart",
30 [PPC_SYS_FUNC_HLDC] = "hldc",
31 [PPC_SYS_FUNC_USB] = "usb",
32 [PPC_SYS_FUNC_IRDA] = "irda",
35 void __init identify_ppc_sys_by_id(u32 id)
39 if ((ppc_sys_specs[i].mask & id) == ppc_sys_specs[i].value)
44 cur_ppc_sys_spec = &ppc_sys_specs[i];
49 void __init identify_ppc_sys_by_name(char *name)
52 while (ppc_sys_specs[i].ppc_sys_name[0]) {
53 if (!strcmp(ppc_sys_specs[i].ppc_sys_name, name))
57 cur_ppc_sys_spec = &ppc_sys_specs[i];
62 static int __init count_sys_specs(void)
65 while (ppc_sys_specs[i].ppc_sys_name[0])
70 static int __init find_chip_by_name_and_id(char *name, u32 id)
75 unsigned int dups = 0;
77 unsigned char matched[count_sys_specs()];
79 while (ppc_sys_specs[i].ppc_sys_name[0]) {
80 if (!strcmp(ppc_sys_specs[i].ppc_sys_name, name))
88 for (i = 0; i < j; i++) {
89 if ((ppc_sys_specs[matched[i]].mask & id) ==
90 ppc_sys_specs[matched[i]].value) {
95 ret = (dups == 1) ? ret : (-1 * dups);
100 void __init identify_ppc_sys_by_name_and_id(char *name, u32 id)
102 int i = find_chip_by_name_and_id(name, id);
104 cur_ppc_sys_spec = &ppc_sys_specs[i];
107 /* Update all memory resources by paddr, call before platform_device_register */
109 ppc_sys_fixup_mem_resource(struct platform_device *pdev, phys_addr_t paddr)
112 for (i = 0; i < pdev->num_resources; i++) {
113 struct resource *r = &pdev->resource[i];
114 if ((r->flags & IORESOURCE_MEM) == IORESOURCE_MEM) {
121 /* Get platform_data pointer out of platform device, call before platform_device_register */
122 void *__init ppc_sys_get_pdata(enum ppc_sys_devices dev)
124 return ppc_sys_platform_devices[dev].dev.platform_data;
127 void ppc_sys_device_remove(enum ppc_sys_devices dev)
131 if (ppc_sys_inited) {
132 platform_device_unregister(&ppc_sys_platform_devices[dev]);
134 if (cur_ppc_sys_spec == NULL)
136 for (i = 0; i < cur_ppc_sys_spec->num_devices; i++)
137 if (cur_ppc_sys_spec->device_list[i] == dev)
138 cur_ppc_sys_spec->device_list[i] = -1;
142 /* Platform-notify mapping
143 * Helper function for BSP code to assign board-specific platfom-divice bits
146 void platform_notify_map(const struct platform_notify_dev_map *map,
149 struct platform_device *pdev;
153 /* do nothing if no device or no bus_id */
154 if (!dev || !dev->bus_id)
157 /* call per device map */
158 while (map->bus_id != NULL) {
160 s = strrchr(dev->bus_id, '.');
162 idx = (int)simple_strtol(s + 1, NULL, 10);
166 len = s - dev->bus_id;
168 if (!strncmp(dev->bus_id, map->bus_id, len)) {
169 pdev = container_of(dev, struct platform_device, dev);
177 Function assignment stuff.
178 Intended to work as follows:
179 the device name defined in foo_devices.c will be concatenated with :"func",
180 where func is string map of respective function from platfom_device_func enum
182 The PPC_SYS_FUNC_DUMMY function is intended to remove all assignments, making the device to appear
183 in platform bus with unmodified name.
187 Here we'll replace .name pointers with fixed-lenght strings
188 Hereby, this should be called *before* any func stuff triggeded.
190 void ppc_sys_device_initfunc(void)
194 static char new_names[NUM_PPC_SYS_DEVS][BUS_ID_SIZE];
195 enum ppc_sys_devices cur_dev;
197 /* If inited yet, do nothing */
198 if (ppc_sys_func_inited)
201 for (i = 0; i < cur_ppc_sys_spec->num_devices; i++) {
202 if ((cur_dev = cur_ppc_sys_spec->device_list[i]) < 0)
205 if (ppc_sys_platform_devices[cur_dev].name) {
207 name = ppc_sys_platform_devices[cur_dev].name;
208 strlcpy(new_names[i], name, BUS_ID_SIZE);
209 ppc_sys_platform_devices[cur_dev].name = new_names[i];
213 ppc_sys_func_inited = 1;
216 /*The "engine" of the func stuff. Here we either concat specified function string description
217 to the name, or remove it if PPC_SYS_FUNC_DUMMY parameter is passed here*/
218 void ppc_sys_device_setfunc(enum ppc_sys_devices dev,
219 enum platform_device_func func)
222 char *name = (char *)ppc_sys_platform_devices[dev].name;
223 char tmp[BUS_ID_SIZE];
225 if (!ppc_sys_func_inited) {
226 printk(KERN_ERR "Unable to alter function - not inited!\n");
230 if (ppc_sys_inited) {
231 platform_device_unregister(&ppc_sys_platform_devices[dev]);
234 if ((s = (char *)strchr(name, ':')) != NULL) { /* reassign */
235 /* Either change the name after ':' or remove func modifications */
236 if (func != PPC_SYS_FUNC_DUMMY)
237 strlcpy(s + 1, ppc_sys_func_names[func], BUS_ID_SIZE);
240 } else if (func != PPC_SYS_FUNC_DUMMY) {
241 /* do assignment if it is not just "clear" request */
242 sprintf(tmp, "%s:%s", name, ppc_sys_func_names[func]);
243 strlcpy(name, tmp, BUS_ID_SIZE);
246 if (ppc_sys_inited) {
247 platform_device_register(&ppc_sys_platform_devices[dev]);
251 void ppc_sys_device_disable(enum ppc_sys_devices dev)
253 BUG_ON(cur_ppc_sys_spec == NULL);
255 /*Check if it is enabled*/
256 if(!(cur_ppc_sys_spec->config[dev] & PPC_SYS_CONFIG_DISABLED)) {
257 if (ppc_sys_inited) {
258 platform_device_unregister(&ppc_sys_platform_devices[dev]);
260 cur_ppc_sys_spec->config[dev] |= PPC_SYS_CONFIG_DISABLED;
264 void ppc_sys_device_enable(enum ppc_sys_devices dev)
266 BUG_ON(cur_ppc_sys_spec == NULL);
268 /*Check if it is disabled*/
269 if(cur_ppc_sys_spec->config[dev] & PPC_SYS_CONFIG_DISABLED) {
270 if (ppc_sys_inited) {
271 platform_device_register(&ppc_sys_platform_devices[dev]);
273 cur_ppc_sys_spec->config[dev] &= ~PPC_SYS_CONFIG_DISABLED;
278 void ppc_sys_device_enable_all(void)
280 enum ppc_sys_devices cur_dev;
283 for (i = 0; i < cur_ppc_sys_spec->num_devices; i++) {
284 cur_dev = cur_ppc_sys_spec->device_list[i];
285 ppc_sys_device_enable(cur_dev);
289 void ppc_sys_device_disable_all(void)
291 enum ppc_sys_devices cur_dev;
294 for (i = 0; i < cur_ppc_sys_spec->num_devices; i++) {
295 cur_dev = cur_ppc_sys_spec->device_list[i];
296 ppc_sys_device_disable(cur_dev);
301 static int __init ppc_sys_init(void)
303 unsigned int i, dev_id, ret = 0;
305 BUG_ON(cur_ppc_sys_spec == NULL);
307 for (i = 0; i < cur_ppc_sys_spec->num_devices; i++) {
308 dev_id = cur_ppc_sys_spec->device_list[i];
309 if ((dev_id != -1) &&
310 !(cur_ppc_sys_spec->config[dev_id] & PPC_SYS_CONFIG_DISABLED)) {
311 if (ppc_sys_device_fixup != NULL)
312 ppc_sys_device_fixup(&ppc_sys_platform_devices
314 if (platform_device_register
315 (&ppc_sys_platform_devices[dev_id])) {
318 "unable to register device %d\n",
328 subsys_initcall(ppc_sys_init);