]>
Commit | Line | Data |
---|---|---|
2ab561a1 DMT |
1 | /* |
2 | * Extensible SAL Interface (ESI) support routines. | |
3 | * | |
4 | * Copyright (C) 2006 Hewlett-Packard Co | |
5 | * Alex Williamson <alex.williamson@hp.com> | |
6 | */ | |
7 | #include <linux/kernel.h> | |
8 | #include <linux/init.h> | |
9 | #include <linux/module.h> | |
10 | #include <linux/string.h> | |
11 | ||
12 | #include <asm/esi.h> | |
13 | #include <asm/sal.h> | |
14 | ||
15 | MODULE_AUTHOR("Alex Williamson <alex.williamson@hp.com>"); | |
16 | MODULE_DESCRIPTION("Extensible SAL Interface (ESI) support"); | |
17 | MODULE_LICENSE("GPL"); | |
18 | ||
19 | #define MODULE_NAME "esi" | |
20 | ||
21 | #define ESI_TABLE_GUID \ | |
22 | EFI_GUID(0x43EA58DC, 0xCF28, 0x4b06, 0xB3, \ | |
23 | 0x91, 0xB7, 0x50, 0x59, 0x34, 0x2B, 0xD4) | |
24 | ||
25 | enum esi_systab_entry_type { | |
26 | ESI_DESC_ENTRY_POINT = 0 | |
27 | }; | |
28 | ||
29 | /* | |
30 | * Entry type: Size: | |
31 | * 0 48 | |
32 | */ | |
33 | #define ESI_DESC_SIZE(type) "\060"[(unsigned) (type)] | |
34 | ||
35 | typedef struct ia64_esi_desc_entry_point { | |
36 | u8 type; | |
37 | u8 reserved1[15]; | |
38 | u64 esi_proc; | |
39 | u64 gp; | |
40 | efi_guid_t guid; | |
41 | } ia64_esi_desc_entry_point_t; | |
42 | ||
43 | struct pdesc { | |
44 | void *addr; | |
45 | void *gp; | |
46 | }; | |
47 | ||
48 | static struct ia64_sal_systab *esi_systab; | |
49 | ||
50 | static int __init esi_init (void) | |
51 | { | |
52 | efi_config_table_t *config_tables; | |
53 | struct ia64_sal_systab *systab; | |
54 | unsigned long esi = 0; | |
55 | char *p; | |
56 | int i; | |
57 | ||
58 | config_tables = __va(efi.systab->tables); | |
59 | ||
60 | for (i = 0; i < (int) efi.systab->nr_tables; ++i) { | |
61 | if (efi_guidcmp(config_tables[i].guid, ESI_TABLE_GUID) == 0) { | |
62 | esi = config_tables[i].table; | |
63 | break; | |
64 | } | |
65 | } | |
66 | ||
67 | if (!esi) | |
68 | return -ENODEV;; | |
69 | ||
70 | systab = __va(esi); | |
71 | ||
72 | if (strncmp(systab->signature, "ESIT", 4) != 0) { | |
73 | printk(KERN_ERR "bad signature in ESI system table!"); | |
74 | return -ENODEV; | |
75 | } | |
76 | ||
77 | p = (char *) (systab + 1); | |
78 | for (i = 0; i < systab->entry_count; i++) { | |
79 | /* | |
80 | * The first byte of each entry type contains the type | |
81 | * descriptor. | |
82 | */ | |
83 | switch (*p) { | |
84 | case ESI_DESC_ENTRY_POINT: | |
85 | break; | |
86 | default: | |
87 | printk(KERN_WARNING "Unkown table type %d found in " | |
88 | "ESI table, ignoring rest of table\n", *p); | |
89 | return -ENODEV; | |
90 | } | |
91 | ||
92 | p += ESI_DESC_SIZE(*p); | |
93 | } | |
94 | ||
95 | esi_systab = systab; | |
96 | return 0; | |
97 | } | |
98 | ||
99 | ||
100 | int ia64_esi_call (efi_guid_t guid, struct ia64_sal_retval *isrvp, | |
101 | enum esi_proc_type proc_type, u64 func, | |
102 | u64 arg1, u64 arg2, u64 arg3, u64 arg4, u64 arg5, u64 arg6, | |
103 | u64 arg7) | |
104 | { | |
105 | struct ia64_fpreg fr[6]; | |
106 | unsigned long flags = 0; | |
107 | int i; | |
108 | char *p; | |
109 | ||
110 | if (!esi_systab) | |
111 | return -1; | |
112 | ||
113 | p = (char *) (esi_systab + 1); | |
114 | for (i = 0; i < esi_systab->entry_count; i++) { | |
115 | if (*p == ESI_DESC_ENTRY_POINT) { | |
116 | ia64_esi_desc_entry_point_t *esi = (void *)p; | |
117 | if (!efi_guidcmp(guid, esi->guid)) { | |
118 | ia64_sal_handler esi_proc; | |
119 | struct pdesc pdesc; | |
120 | ||
121 | pdesc.addr = __va(esi->esi_proc); | |
122 | pdesc.gp = __va(esi->gp); | |
123 | ||
124 | esi_proc = (ia64_sal_handler) &pdesc; | |
125 | ||
126 | ia64_save_scratch_fpregs(fr); | |
127 | if (proc_type == ESI_PROC_SERIALIZED) | |
128 | spin_lock_irqsave(&sal_lock, flags); | |
129 | else if (proc_type == ESI_PROC_MP_SAFE) | |
130 | local_irq_save(flags); | |
131 | else | |
132 | preempt_disable(); | |
133 | *isrvp = (*esi_proc)(func, arg1, arg2, arg3, | |
134 | arg4, arg5, arg6, arg7); | |
135 | if (proc_type == ESI_PROC_SERIALIZED) | |
136 | spin_unlock_irqrestore(&sal_lock, | |
137 | flags); | |
138 | else if (proc_type == ESI_PROC_MP_SAFE) | |
139 | local_irq_restore(flags); | |
140 | else | |
141 | preempt_enable(); | |
142 | ia64_load_scratch_fpregs(fr); | |
143 | return 0; | |
144 | } | |
145 | } | |
146 | p += ESI_DESC_SIZE(*p); | |
147 | } | |
148 | return -1; | |
149 | } | |
150 | EXPORT_SYMBOL_GPL(ia64_esi_call); | |
151 | ||
152 | int ia64_esi_call_phys (efi_guid_t guid, struct ia64_sal_retval *isrvp, | |
153 | u64 func, u64 arg1, u64 arg2, u64 arg3, u64 arg4, | |
154 | u64 arg5, u64 arg6, u64 arg7) | |
155 | { | |
156 | struct ia64_fpreg fr[6]; | |
157 | unsigned long flags; | |
158 | u64 esi_params[8]; | |
159 | char *p; | |
160 | int i; | |
161 | ||
162 | if (!esi_systab) | |
163 | return -1; | |
164 | ||
165 | p = (char *) (esi_systab + 1); | |
166 | for (i = 0; i < esi_systab->entry_count; i++) { | |
167 | if (*p == ESI_DESC_ENTRY_POINT) { | |
168 | ia64_esi_desc_entry_point_t *esi = (void *)p; | |
169 | if (!efi_guidcmp(guid, esi->guid)) { | |
170 | ia64_sal_handler esi_proc; | |
171 | struct pdesc pdesc; | |
172 | ||
173 | pdesc.addr = (void *)esi->esi_proc; | |
174 | pdesc.gp = (void *)esi->gp; | |
175 | ||
176 | esi_proc = (ia64_sal_handler) &pdesc; | |
177 | ||
178 | esi_params[0] = func; | |
179 | esi_params[1] = arg1; | |
180 | esi_params[2] = arg2; | |
181 | esi_params[3] = arg3; | |
182 | esi_params[4] = arg4; | |
183 | esi_params[5] = arg5; | |
184 | esi_params[6] = arg6; | |
185 | esi_params[7] = arg7; | |
186 | ia64_save_scratch_fpregs(fr); | |
187 | spin_lock_irqsave(&sal_lock, flags); | |
188 | *isrvp = esi_call_phys(esi_proc, esi_params); | |
189 | spin_unlock_irqrestore(&sal_lock, flags); | |
190 | ia64_load_scratch_fpregs(fr); | |
191 | return 0; | |
192 | } | |
193 | } | |
194 | p += ESI_DESC_SIZE(*p); | |
195 | } | |
196 | return -1; | |
197 | } | |
198 | EXPORT_SYMBOL_GPL(ia64_esi_call_phys); | |
199 | ||
200 | static void __exit esi_exit (void) | |
201 | { | |
202 | } | |
203 | ||
204 | module_init(esi_init); | |
205 | module_exit(esi_exit); /* makes module removable... */ |