Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[linux-2.6] / arch / ia64 / kernel / esi.c
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... */