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
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
|
/*
* arch/ppc/syslib/ppc_sys.c
*
* PPC System library functions
*
* Maintainer: Kumar Gala <kumar.gala@freescale.com>
*
* Copyright 2005 Freescale Semiconductor Inc.
* Copyright 2005 MontaVista, Inc. by Vitaly Bordug <vbordug@ru.mvista.com>
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation; either version 2 of the License, or (at your
* option) any later version.
*/
#include <asm/ppc_sys.h>
int (*ppc_sys_device_fixup) (struct platform_device * pdev);
static int ppc_sys_inited;
void __init identify_ppc_sys_by_id(u32 id)
{
unsigned int i = 0;
while (1) {
if ((ppc_sys_specs[i].mask & id) == ppc_sys_specs[i].value)
break;
i++;
}
cur_ppc_sys_spec = &ppc_sys_specs[i];
return;
}
void __init identify_ppc_sys_by_name(char *name)
{
unsigned int i = 0;
while (ppc_sys_specs[i].ppc_sys_name[0])
{
if (!strcmp(ppc_sys_specs[i].ppc_sys_name, name))
break;
i++;
}
cur_ppc_sys_spec = &ppc_sys_specs[i];
return;
}
static int __init count_sys_specs(void)
{
int i = 0;
while (ppc_sys_specs[i].ppc_sys_name[0])
i++;
return i;
}
static int __init find_chip_by_name_and_id(char *name, u32 id)
{
int ret = -1;
unsigned int i = 0;
unsigned int j = 0;
unsigned int dups = 0;
unsigned char matched[count_sys_specs()];
while (ppc_sys_specs[i].ppc_sys_name[0]) {
if (!strcmp(ppc_sys_specs[i].ppc_sys_name, name))
matched[j++] = i;
i++;
}
if (j != 0) {
for (i = 0; i < j; i++) {
if ((ppc_sys_specs[matched[i]].mask & id) ==
ppc_sys_specs[matched[i]].value) {
ret = matched[i];
dups++;
}
}
ret = (dups == 1) ? ret : (-1 * dups);
}
return ret;
}
void __init identify_ppc_sys_by_name_and_id(char *name, u32 id)
{
int i = find_chip_by_name_and_id(name, id);
BUG_ON(i < 0);
cur_ppc_sys_spec = &ppc_sys_specs[i];
}
/* Update all memory resources by paddr, call before platform_device_register */
void __init
ppc_sys_fixup_mem_resource(struct platform_device *pdev, phys_addr_t paddr)
{
int i;
for (i = 0; i < pdev->num_resources; i++) {
struct resource *r = &pdev->resource[i];
if ((r->flags & IORESOURCE_MEM) == IORESOURCE_MEM) {
r->start += paddr;
r->end += paddr;
}
}
}
/* Get platform_data pointer out of platform device, call before platform_device_register */
void *__init ppc_sys_get_pdata(enum ppc_sys_devices dev)
{
return ppc_sys_platform_devices[dev].dev.platform_data;
}
void ppc_sys_device_remove(enum ppc_sys_devices dev)
{
unsigned int i;
if (ppc_sys_inited) {
platform_device_unregister(&ppc_sys_platform_devices[dev]);
} else {
if (cur_ppc_sys_spec == NULL)
return;
for (i = 0; i < cur_ppc_sys_spec->num_devices; i++)
if (cur_ppc_sys_spec->device_list[i] == dev)
cur_ppc_sys_spec->device_list[i] = -1;
}
}
static int __init ppc_sys_init(void)
{
unsigned int i, dev_id, ret = 0;
BUG_ON(cur_ppc_sys_spec == NULL);
for (i = 0; i < cur_ppc_sys_spec->num_devices; i++) {
dev_id = cur_ppc_sys_spec->device_list[i];
if (dev_id != -1) {
if (ppc_sys_device_fixup != NULL)
ppc_sys_device_fixup(&ppc_sys_platform_devices
[dev_id]);
if (platform_device_register
(&ppc_sys_platform_devices[dev_id])) {
ret = 1;
printk(KERN_ERR
"unable to register device %d\n",
dev_id);
}
}
}
ppc_sys_inited = 1;
return ret;
}
subsys_initcall(ppc_sys_init);
|
