Merge branch 'master'
[linux-2.6] / arch / mips / kernel / kspd.c
1 /*
2  * Copyright (C) 2005 MIPS Technologies, Inc.  All rights reserved.
3  *
4  *  This program is free software; you can distribute it and/or modify it
5  *  under the terms of the GNU General Public License (Version 2) as
6  *  published by the Free Software Foundation.
7  *
8  *  This program is distributed in the hope it will be useful, but WITHOUT
9  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
11  *  for more details.
12  *
13  *  You should have received a copy of the GNU General Public License along
14  *  with this program; if not, write to the Free Software Foundation, Inc.,
15  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
16  *
17  */
18 #include <linux/kernel.h>
19 #include <linux/module.h>
20 #include <linux/unistd.h>
21 #include <linux/file.h>
22 #include <linux/fs.h>
23 #include <linux/syscalls.h>
24 #include <linux/workqueue.h>
25 #include <linux/errno.h>
26 #include <linux/list.h>
27
28 #include <asm/vpe.h>
29 #include <asm/rtlx.h>
30 #include <asm/kspd.h>
31
32 static struct workqueue_struct *workqueue = NULL;
33 static struct work_struct work;
34
35 extern unsigned long cpu_khz;
36
37 struct mtsp_syscall {
38         int cmd;
39         unsigned char abi;
40         unsigned char size;
41 };
42
43 struct mtsp_syscall_ret {
44         int retval;
45         int errno;
46 };
47
48 struct mtsp_syscall_generic {
49         int arg0;
50         int arg1;
51         int arg2;
52         int arg3;
53         int arg4;
54         int arg5;
55         int arg6;
56 };
57
58 static struct list_head kspd_notifylist;
59 static int sp_stopping = 0;
60
61 /* these should match with those in the SDE kit */
62 #define MTSP_SYSCALL_BASE       0
63 #define MTSP_SYSCALL_EXIT       (MTSP_SYSCALL_BASE + 0)
64 #define MTSP_SYSCALL_OPEN       (MTSP_SYSCALL_BASE + 1)
65 #define MTSP_SYSCALL_READ       (MTSP_SYSCALL_BASE + 2)
66 #define MTSP_SYSCALL_WRITE      (MTSP_SYSCALL_BASE + 3)
67 #define MTSP_SYSCALL_CLOSE      (MTSP_SYSCALL_BASE + 4)
68 #define MTSP_SYSCALL_LSEEK32    (MTSP_SYSCALL_BASE + 5)
69 #define MTSP_SYSCALL_ISATTY     (MTSP_SYSCALL_BASE + 6)
70 #define MTSP_SYSCALL_GETTIME    (MTSP_SYSCALL_BASE + 7)
71 #define MTSP_SYSCALL_PIPEFREQ   (MTSP_SYSCALL_BASE + 8)
72 #define MTSP_SYSCALL_GETTOD     (MTSP_SYSCALL_BASE + 9)
73
74 #define MTSP_O_RDONLY           0x0000
75 #define MTSP_O_WRONLY           0x0001
76 #define MTSP_O_RDWR             0x0002
77 #define MTSP_O_NONBLOCK         0x0004
78 #define MTSP_O_APPEND           0x0008
79 #define MTSP_O_SHLOCK           0x0010
80 #define MTSP_O_EXLOCK           0x0020
81 #define MTSP_O_ASYNC            0x0040
82 #define MTSP_O_FSYNC            O_SYNC
83 #define MTSP_O_NOFOLLOW         0x0100
84 #define MTSP_O_SYNC             0x0080
85 #define MTSP_O_CREAT            0x0200
86 #define MTSP_O_TRUNC            0x0400
87 #define MTSP_O_EXCL             0x0800
88 #define MTSP_O_BINARY           0x8000
89
90 #define SP_VPE 1
91
92 struct apsp_table  {
93         int sp;
94         int ap;
95 };
96
97 /* we might want to do the mode flags too */
98 struct apsp_table open_flags_table[] = {
99         { MTSP_O_RDWR, O_RDWR },
100         { MTSP_O_WRONLY, O_WRONLY },
101         { MTSP_O_CREAT, O_CREAT },
102         { MTSP_O_TRUNC, O_TRUNC },
103         { MTSP_O_NONBLOCK, O_NONBLOCK },
104         { MTSP_O_APPEND, O_APPEND },
105         { MTSP_O_NOFOLLOW, O_NOFOLLOW }
106 };
107
108 struct apsp_table syscall_command_table[] = {
109         { MTSP_SYSCALL_OPEN, __NR_open },
110         { MTSP_SYSCALL_CLOSE, __NR_close },
111         { MTSP_SYSCALL_READ, __NR_read },
112         { MTSP_SYSCALL_WRITE, __NR_write },
113         { MTSP_SYSCALL_LSEEK32, __NR_lseek }
114 };
115
116 static int sp_syscall(int num, int arg0, int arg1, int arg2, int arg3)
117 {
118         register long int _num  __asm__ ("$2") = num;
119         register long int _arg0  __asm__ ("$4") = arg0;
120         register long int _arg1  __asm__ ("$5") = arg1;
121         register long int _arg2  __asm__ ("$6") = arg2;
122         register long int _arg3  __asm__ ("$7") = arg3;
123
124         mm_segment_t old_fs;
125
126         old_fs = get_fs();
127         set_fs(KERNEL_DS);
128
129         __asm__ __volatile__ (
130         "       syscall                                 \n"
131         : "=r" (_num), "=r" (_arg3)
132         : "r" (_num), "r" (_arg0), "r" (_arg1), "r" (_arg2), "r" (_arg3));
133
134         set_fs(old_fs);
135
136         /* $a3 is error flag */
137         if (_arg3)
138                 return -_num;
139
140         return _num;
141 }
142
143 static int translate_syscall_command(int cmd)
144 {
145         int i;
146         int ret = -1;
147
148         for (i = 0; i < ARRAY_SIZE(syscall_command_table); i++) {
149                 if ((cmd == syscall_command_table[i].sp))
150                         return syscall_command_table[i].ap;
151         }
152
153         return ret;
154 }
155
156 static unsigned int translate_open_flags(int flags)
157 {
158         int i;
159         unsigned int ret = 0;
160
161         for (i = 0; i < (sizeof(open_flags_table) / sizeof(struct apsp_table));
162              i++) {
163                 if( (flags & open_flags_table[i].sp) ) {
164                         ret |= open_flags_table[i].ap;
165                 }
166         }
167
168         return ret;
169 }
170
171
172 static void sp_setfsuidgid( uid_t uid, gid_t gid)
173 {
174         current->fsuid = uid;
175         current->fsgid = gid;
176
177         key_fsuid_changed(current);
178         key_fsgid_changed(current);
179 }
180
181 /*
182  * Expects a request to be on the sysio channel. Reads it.  Decides whether
183  * its a linux syscall and runs it, or whatever.  Puts the return code back
184  * into the request and sends the whole thing back.
185  */
186 void sp_work_handle_request(void)
187 {
188         struct mtsp_syscall sc;
189         struct mtsp_syscall_generic generic;
190         struct mtsp_syscall_ret ret;
191         struct kspd_notifications *n;
192         struct timeval tv;
193         struct timezone tz;
194         int cmd;
195
196         char *vcwd;
197         mm_segment_t old_fs;
198         int size;
199
200         ret.retval = -1;
201
202         if (!rtlx_read(RTLX_CHANNEL_SYSIO, &sc, sizeof(struct mtsp_syscall), 0)) {
203                 printk(KERN_ERR "Expected request but nothing to read\n");
204                 return;
205         }
206
207         size = sc.size;
208
209         if (size) {
210                 if (!rtlx_read(RTLX_CHANNEL_SYSIO, &generic, size, 0)) {
211                         printk(KERN_ERR "Expected request but nothing to read\n");
212                         return;
213                 }
214         }
215
216         /* Run the syscall at the priviledge of the user who loaded the
217            SP program */
218
219         if (vpe_getuid(SP_VPE))
220                 sp_setfsuidgid( vpe_getuid(SP_VPE), vpe_getgid(SP_VPE));
221
222         switch (sc.cmd) {
223         /* needs the flags argument translating from SDE kit to
224            linux */
225         case MTSP_SYSCALL_PIPEFREQ:
226                 ret.retval = cpu_khz * 1000;
227                 ret.errno = 0;
228                 break;
229
230         case MTSP_SYSCALL_GETTOD:
231                 memset(&tz, 0, sizeof(tz));
232                 if ((ret.retval = sp_syscall(__NR_gettimeofday, (int)&tv,
233                                              (int)&tz, 0,0)) == 0)
234                 ret.retval = tv.tv_sec;
235
236                 ret.errno = errno;
237                 break;
238
239         case MTSP_SYSCALL_EXIT:
240                 list_for_each_entry(n, &kspd_notifylist, list)
241                         n->kspd_sp_exit(SP_VPE);
242                 sp_stopping = 1;
243
244                 printk(KERN_DEBUG "KSPD got exit syscall from SP exitcode %d\n",
245                        generic.arg0);
246                 break;
247
248         case MTSP_SYSCALL_OPEN:
249                 generic.arg1 = translate_open_flags(generic.arg1);
250
251                 vcwd = vpe_getcwd(SP_VPE);
252
253                 /* change to the cwd of the process that loaded the SP program */
254                 old_fs = get_fs();
255                 set_fs(KERNEL_DS);
256                 sys_chdir(vcwd);
257                 set_fs(old_fs);
258
259                 sc.cmd = __NR_open;
260
261                 /* fall through */
262
263         default:
264                 if ((sc.cmd >= __NR_Linux) &&
265                     (sc.cmd <= (__NR_Linux +  __NR_Linux_syscalls)) )
266                         cmd = sc.cmd;
267                 else
268                         cmd = translate_syscall_command(sc.cmd);
269
270                 if (cmd >= 0) {
271                         ret.retval = sp_syscall(cmd, generic.arg0, generic.arg1,
272                                                 generic.arg2, generic.arg3);
273                         ret.errno = errno;
274                 } else
275                         printk(KERN_WARNING
276                                "KSPD: Unknown SP syscall number %d\n", sc.cmd);
277                 break;
278         } /* switch */
279
280         if (vpe_getuid(SP_VPE))
281                 sp_setfsuidgid( 0, 0);
282
283         if ((rtlx_write(RTLX_CHANNEL_SYSIO, &ret, sizeof(struct mtsp_syscall_ret), 0))
284             < sizeof(struct mtsp_syscall_ret))
285                 printk("KSPD: sp_work_handle_request failed to send to SP\n");
286 }
287
288 static void sp_cleanup(void)
289 {
290         struct files_struct *files = current->files;
291         int i, j;
292         struct fdtable *fdt;
293
294         j = 0;
295
296         /*
297          * It is safe to dereference the fd table without RCU or
298          * ->file_lock
299          */
300         fdt = files_fdtable(files);
301         for (;;) {
302                 unsigned long set;
303                 i = j * __NFDBITS;
304                 if (i >= fdt->max_fdset || i >= fdt->max_fds)
305                         break;
306                 set = fdt->open_fds->fds_bits[j++];
307                 while (set) {
308                         if (set & 1) {
309                                 struct file * file = xchg(&fdt->fd[i], NULL);
310                                 if (file)
311                                         filp_close(file, files);
312                         }
313                         i++;
314                         set >>= 1;
315                 }
316         }
317 }
318
319 static int channel_open = 0;
320
321 /* the work handler */
322 static void sp_work(void *data)
323 {
324         if (!channel_open) {
325                 if( rtlx_open(RTLX_CHANNEL_SYSIO, 1) != 0) {
326                         printk("KSPD: unable to open sp channel\n");
327                         sp_stopping = 1;
328                 } else {
329                         channel_open++;
330                         printk(KERN_DEBUG "KSPD: SP channel opened\n");
331                 }
332         } else {
333                 /* wait for some data, allow it to sleep */
334                 rtlx_read_poll(RTLX_CHANNEL_SYSIO, 1);
335
336                 /* Check we haven't been woken because we are stopping */
337                 if (!sp_stopping)
338                         sp_work_handle_request();
339         }
340
341         if (!sp_stopping)
342                 queue_work(workqueue, &work);
343         else
344                 sp_cleanup();
345 }
346
347 static void startwork(int vpe)
348 {
349         sp_stopping = channel_open = 0;
350
351         if (workqueue == NULL) {
352                 if ((workqueue = create_singlethread_workqueue("kspd")) == NULL) {
353                         printk(KERN_ERR "unable to start kspd\n");
354                         return;
355                 }
356
357                 INIT_WORK(&work, sp_work, NULL);
358                 queue_work(workqueue, &work);
359         } else
360                 queue_work(workqueue, &work);
361
362 }
363
364 static void stopwork(int vpe)
365 {
366         sp_stopping = 1;
367
368         printk(KERN_DEBUG "KSPD: SP stopping\n");
369 }
370
371 void kspd_notify(struct kspd_notifications *notify)
372 {
373         list_add(&notify->list, &kspd_notifylist);
374 }
375
376 static struct vpe_notifications notify;
377 static int kspd_module_init(void)
378 {
379         INIT_LIST_HEAD(&kspd_notifylist);
380
381         notify.start = startwork;
382         notify.stop = stopwork;
383         vpe_notify(SP_VPE, &notify);
384
385         return 0;
386 }
387
388 static void kspd_module_exit(void)
389 {
390
391 }
392
393 module_init(kspd_module_init);
394 module_exit(kspd_module_exit);
395
396 MODULE_DESCRIPTION("MIPS KSPD");
397 MODULE_AUTHOR("Elizabeth Oldham, MIPS Technologies, Inc.");
398 MODULE_LICENSE("GPL");