x86: fix pci-gart failure handling
[wrt350n-kernel.git] / arch / m68k / kernel / sys_m68k.c
blobe892f17ba3fac4984a84bbdd7d5e501cab80fe90
1 /*
2 * linux/arch/m68k/kernel/sys_m68k.c
4 * This file contains various random system calls that
5 * have a non-standard calling sequence on the Linux/m68k
6 * platform.
7 */
9 #include <linux/capability.h>
10 #include <linux/errno.h>
11 #include <linux/sched.h>
12 #include <linux/mm.h>
13 #include <linux/fs.h>
14 #include <linux/smp.h>
15 #include <linux/smp_lock.h>
16 #include <linux/sem.h>
17 #include <linux/msg.h>
18 #include <linux/shm.h>
19 #include <linux/stat.h>
20 #include <linux/syscalls.h>
21 #include <linux/mman.h>
22 #include <linux/file.h>
23 #include <linux/utsname.h>
24 #include <linux/ipc.h>
26 #include <asm/setup.h>
27 #include <asm/uaccess.h>
28 #include <asm/cachectl.h>
29 #include <asm/traps.h>
30 #include <asm/page.h>
31 #include <asm/unistd.h>
34 * sys_pipe() is the normal C calling standard for creating
35 * a pipe. It's not the way unix traditionally does this, though.
37 asmlinkage int sys_pipe(unsigned long __user * fildes)
39 int fd[2];
40 int error;
42 error = do_pipe(fd);
43 if (!error) {
44 if (copy_to_user(fildes, fd, 2*sizeof(int)))
45 error = -EFAULT;
47 return error;
50 /* common code for old and new mmaps */
51 static inline long do_mmap2(
52 unsigned long addr, unsigned long len,
53 unsigned long prot, unsigned long flags,
54 unsigned long fd, unsigned long pgoff)
56 int error = -EBADF;
57 struct file * file = NULL;
59 flags &= ~(MAP_EXECUTABLE | MAP_DENYWRITE);
60 if (!(flags & MAP_ANONYMOUS)) {
61 file = fget(fd);
62 if (!file)
63 goto out;
66 down_write(&current->mm->mmap_sem);
67 error = do_mmap_pgoff(file, addr, len, prot, flags, pgoff);
68 up_write(&current->mm->mmap_sem);
70 if (file)
71 fput(file);
72 out:
73 return error;
76 asmlinkage long sys_mmap2(unsigned long addr, unsigned long len,
77 unsigned long prot, unsigned long flags,
78 unsigned long fd, unsigned long pgoff)
80 return do_mmap2(addr, len, prot, flags, fd, pgoff);
84 * Perform the select(nd, in, out, ex, tv) and mmap() system
85 * calls. Linux/m68k cloned Linux/i386, which didn't use to be able to
86 * handle more than 4 system call parameters, so these system calls
87 * used a memory block for parameter passing..
90 struct mmap_arg_struct {
91 unsigned long addr;
92 unsigned long len;
93 unsigned long prot;
94 unsigned long flags;
95 unsigned long fd;
96 unsigned long offset;
99 asmlinkage int old_mmap(struct mmap_arg_struct __user *arg)
101 struct mmap_arg_struct a;
102 int error = -EFAULT;
104 if (copy_from_user(&a, arg, sizeof(a)))
105 goto out;
107 error = -EINVAL;
108 if (a.offset & ~PAGE_MASK)
109 goto out;
111 a.flags &= ~(MAP_EXECUTABLE | MAP_DENYWRITE);
113 error = do_mmap2(a.addr, a.len, a.prot, a.flags, a.fd, a.offset >> PAGE_SHIFT);
114 out:
115 return error;
118 #if 0
119 struct mmap_arg_struct64 {
120 __u32 addr;
121 __u32 len;
122 __u32 prot;
123 __u32 flags;
124 __u64 offset; /* 64 bits */
125 __u32 fd;
128 asmlinkage long sys_mmap64(struct mmap_arg_struct64 *arg)
130 int error = -EFAULT;
131 struct file * file = NULL;
132 struct mmap_arg_struct64 a;
133 unsigned long pgoff;
135 if (copy_from_user(&a, arg, sizeof(a)))
136 return -EFAULT;
138 if ((long)a.offset & ~PAGE_MASK)
139 return -EINVAL;
141 pgoff = a.offset >> PAGE_SHIFT;
142 if ((a.offset >> PAGE_SHIFT) != pgoff)
143 return -EINVAL;
145 if (!(a.flags & MAP_ANONYMOUS)) {
146 error = -EBADF;
147 file = fget(a.fd);
148 if (!file)
149 goto out;
151 a.flags &= ~(MAP_EXECUTABLE | MAP_DENYWRITE);
153 down_write(&current->mm->mmap_sem);
154 error = do_mmap_pgoff(file, a.addr, a.len, a.prot, a.flags, pgoff);
155 up_write(&current->mm->mmap_sem);
156 if (file)
157 fput(file);
158 out:
159 return error;
161 #endif
163 struct sel_arg_struct {
164 unsigned long n;
165 fd_set __user *inp, *outp, *exp;
166 struct timeval __user *tvp;
169 asmlinkage int old_select(struct sel_arg_struct __user *arg)
171 struct sel_arg_struct a;
173 if (copy_from_user(&a, arg, sizeof(a)))
174 return -EFAULT;
175 /* sys_select() does the appropriate kernel locking */
176 return sys_select(a.n, a.inp, a.outp, a.exp, a.tvp);
180 * sys_ipc() is the de-multiplexer for the SysV IPC calls..
182 * This is really horribly ugly.
184 asmlinkage int sys_ipc (uint call, int first, int second,
185 int third, void __user *ptr, long fifth)
187 int version, ret;
189 version = call >> 16; /* hack for backward compatibility */
190 call &= 0xffff;
192 if (call <= SEMCTL)
193 switch (call) {
194 case SEMOP:
195 return sys_semop (first, ptr, second);
196 case SEMGET:
197 return sys_semget (first, second, third);
198 case SEMCTL: {
199 union semun fourth;
200 if (!ptr)
201 return -EINVAL;
202 if (get_user(fourth.__pad, (void __user *__user *) ptr))
203 return -EFAULT;
204 return sys_semctl (first, second, third, fourth);
206 default:
207 return -ENOSYS;
209 if (call <= MSGCTL)
210 switch (call) {
211 case MSGSND:
212 return sys_msgsnd (first, ptr, second, third);
213 case MSGRCV:
214 switch (version) {
215 case 0: {
216 struct ipc_kludge tmp;
217 if (!ptr)
218 return -EINVAL;
219 if (copy_from_user (&tmp, ptr, sizeof (tmp)))
220 return -EFAULT;
221 return sys_msgrcv (first, tmp.msgp, second,
222 tmp.msgtyp, third);
224 default:
225 return sys_msgrcv (first, ptr,
226 second, fifth, third);
228 case MSGGET:
229 return sys_msgget ((key_t) first, second);
230 case MSGCTL:
231 return sys_msgctl (first, second, ptr);
232 default:
233 return -ENOSYS;
235 if (call <= SHMCTL)
236 switch (call) {
237 case SHMAT:
238 switch (version) {
239 default: {
240 ulong raddr;
241 ret = do_shmat (first, ptr, second, &raddr);
242 if (ret)
243 return ret;
244 return put_user (raddr, (ulong __user *) third);
247 case SHMDT:
248 return sys_shmdt (ptr);
249 case SHMGET:
250 return sys_shmget (first, second, third);
251 case SHMCTL:
252 return sys_shmctl (first, second, ptr);
253 default:
254 return -ENOSYS;
257 return -EINVAL;
260 /* Convert virtual (user) address VADDR to physical address PADDR */
261 #define virt_to_phys_040(vaddr) \
262 ({ \
263 unsigned long _mmusr, _paddr; \
265 __asm__ __volatile__ (".chip 68040\n\t" \
266 "ptestr (%1)\n\t" \
267 "movec %%mmusr,%0\n\t" \
268 ".chip 68k" \
269 : "=r" (_mmusr) \
270 : "a" (vaddr)); \
271 _paddr = (_mmusr & MMU_R_040) ? (_mmusr & PAGE_MASK) : 0; \
272 _paddr; \
275 static inline int
276 cache_flush_040 (unsigned long addr, int scope, int cache, unsigned long len)
278 unsigned long paddr, i;
280 switch (scope)
282 case FLUSH_SCOPE_ALL:
283 switch (cache)
285 case FLUSH_CACHE_DATA:
286 /* This nop is needed for some broken versions of the 68040. */
287 __asm__ __volatile__ ("nop\n\t"
288 ".chip 68040\n\t"
289 "cpusha %dc\n\t"
290 ".chip 68k");
291 break;
292 case FLUSH_CACHE_INSN:
293 __asm__ __volatile__ ("nop\n\t"
294 ".chip 68040\n\t"
295 "cpusha %ic\n\t"
296 ".chip 68k");
297 break;
298 default:
299 case FLUSH_CACHE_BOTH:
300 __asm__ __volatile__ ("nop\n\t"
301 ".chip 68040\n\t"
302 "cpusha %bc\n\t"
303 ".chip 68k");
304 break;
306 break;
308 case FLUSH_SCOPE_LINE:
309 /* Find the physical address of the first mapped page in the
310 address range. */
311 if ((paddr = virt_to_phys_040(addr))) {
312 paddr += addr & ~(PAGE_MASK | 15);
313 len = (len + (addr & 15) + 15) >> 4;
314 } else {
315 unsigned long tmp = PAGE_SIZE - (addr & ~PAGE_MASK);
317 if (len <= tmp)
318 return 0;
319 addr += tmp;
320 len -= tmp;
321 tmp = PAGE_SIZE;
322 for (;;)
324 if ((paddr = virt_to_phys_040(addr)))
325 break;
326 if (len <= tmp)
327 return 0;
328 addr += tmp;
329 len -= tmp;
331 len = (len + 15) >> 4;
333 i = (PAGE_SIZE - (paddr & ~PAGE_MASK)) >> 4;
334 while (len--)
336 switch (cache)
338 case FLUSH_CACHE_DATA:
339 __asm__ __volatile__ ("nop\n\t"
340 ".chip 68040\n\t"
341 "cpushl %%dc,(%0)\n\t"
342 ".chip 68k"
343 : : "a" (paddr));
344 break;
345 case FLUSH_CACHE_INSN:
346 __asm__ __volatile__ ("nop\n\t"
347 ".chip 68040\n\t"
348 "cpushl %%ic,(%0)\n\t"
349 ".chip 68k"
350 : : "a" (paddr));
351 break;
352 default:
353 case FLUSH_CACHE_BOTH:
354 __asm__ __volatile__ ("nop\n\t"
355 ".chip 68040\n\t"
356 "cpushl %%bc,(%0)\n\t"
357 ".chip 68k"
358 : : "a" (paddr));
359 break;
361 if (!--i && len)
364 * No need to page align here since it is done by
365 * virt_to_phys_040().
367 addr += PAGE_SIZE;
368 i = PAGE_SIZE / 16;
369 /* Recompute physical address when crossing a page
370 boundary. */
371 for (;;)
373 if ((paddr = virt_to_phys_040(addr)))
374 break;
375 if (len <= i)
376 return 0;
377 len -= i;
378 addr += PAGE_SIZE;
381 else
382 paddr += 16;
384 break;
386 default:
387 case FLUSH_SCOPE_PAGE:
388 len += (addr & ~PAGE_MASK) + (PAGE_SIZE - 1);
389 for (len >>= PAGE_SHIFT; len--; addr += PAGE_SIZE)
391 if (!(paddr = virt_to_phys_040(addr)))
392 continue;
393 switch (cache)
395 case FLUSH_CACHE_DATA:
396 __asm__ __volatile__ ("nop\n\t"
397 ".chip 68040\n\t"
398 "cpushp %%dc,(%0)\n\t"
399 ".chip 68k"
400 : : "a" (paddr));
401 break;
402 case FLUSH_CACHE_INSN:
403 __asm__ __volatile__ ("nop\n\t"
404 ".chip 68040\n\t"
405 "cpushp %%ic,(%0)\n\t"
406 ".chip 68k"
407 : : "a" (paddr));
408 break;
409 default:
410 case FLUSH_CACHE_BOTH:
411 __asm__ __volatile__ ("nop\n\t"
412 ".chip 68040\n\t"
413 "cpushp %%bc,(%0)\n\t"
414 ".chip 68k"
415 : : "a" (paddr));
416 break;
419 break;
421 return 0;
424 #define virt_to_phys_060(vaddr) \
425 ({ \
426 unsigned long paddr; \
427 __asm__ __volatile__ (".chip 68060\n\t" \
428 "plpar (%0)\n\t" \
429 ".chip 68k" \
430 : "=a" (paddr) \
431 : "0" (vaddr)); \
432 (paddr); /* XXX */ \
435 static inline int
436 cache_flush_060 (unsigned long addr, int scope, int cache, unsigned long len)
438 unsigned long paddr, i;
441 * 68060 manual says:
442 * cpush %dc : flush DC, remains valid (with our %cacr setup)
443 * cpush %ic : invalidate IC
444 * cpush %bc : flush DC + invalidate IC
446 switch (scope)
448 case FLUSH_SCOPE_ALL:
449 switch (cache)
451 case FLUSH_CACHE_DATA:
452 __asm__ __volatile__ (".chip 68060\n\t"
453 "cpusha %dc\n\t"
454 ".chip 68k");
455 break;
456 case FLUSH_CACHE_INSN:
457 __asm__ __volatile__ (".chip 68060\n\t"
458 "cpusha %ic\n\t"
459 ".chip 68k");
460 break;
461 default:
462 case FLUSH_CACHE_BOTH:
463 __asm__ __volatile__ (".chip 68060\n\t"
464 "cpusha %bc\n\t"
465 ".chip 68k");
466 break;
468 break;
470 case FLUSH_SCOPE_LINE:
471 /* Find the physical address of the first mapped page in the
472 address range. */
473 len += addr & 15;
474 addr &= -16;
475 if (!(paddr = virt_to_phys_060(addr))) {
476 unsigned long tmp = PAGE_SIZE - (addr & ~PAGE_MASK);
478 if (len <= tmp)
479 return 0;
480 addr += tmp;
481 len -= tmp;
482 tmp = PAGE_SIZE;
483 for (;;)
485 if ((paddr = virt_to_phys_060(addr)))
486 break;
487 if (len <= tmp)
488 return 0;
489 addr += tmp;
490 len -= tmp;
493 len = (len + 15) >> 4;
494 i = (PAGE_SIZE - (paddr & ~PAGE_MASK)) >> 4;
495 while (len--)
497 switch (cache)
499 case FLUSH_CACHE_DATA:
500 __asm__ __volatile__ (".chip 68060\n\t"
501 "cpushl %%dc,(%0)\n\t"
502 ".chip 68k"
503 : : "a" (paddr));
504 break;
505 case FLUSH_CACHE_INSN:
506 __asm__ __volatile__ (".chip 68060\n\t"
507 "cpushl %%ic,(%0)\n\t"
508 ".chip 68k"
509 : : "a" (paddr));
510 break;
511 default:
512 case FLUSH_CACHE_BOTH:
513 __asm__ __volatile__ (".chip 68060\n\t"
514 "cpushl %%bc,(%0)\n\t"
515 ".chip 68k"
516 : : "a" (paddr));
517 break;
519 if (!--i && len)
523 * We just want to jump to the first cache line
524 * in the next page.
526 addr += PAGE_SIZE;
527 addr &= PAGE_MASK;
529 i = PAGE_SIZE / 16;
530 /* Recompute physical address when crossing a page
531 boundary. */
532 for (;;)
534 if ((paddr = virt_to_phys_060(addr)))
535 break;
536 if (len <= i)
537 return 0;
538 len -= i;
539 addr += PAGE_SIZE;
542 else
543 paddr += 16;
545 break;
547 default:
548 case FLUSH_SCOPE_PAGE:
549 len += (addr & ~PAGE_MASK) + (PAGE_SIZE - 1);
550 addr &= PAGE_MASK; /* Workaround for bug in some
551 revisions of the 68060 */
552 for (len >>= PAGE_SHIFT; len--; addr += PAGE_SIZE)
554 if (!(paddr = virt_to_phys_060(addr)))
555 continue;
556 switch (cache)
558 case FLUSH_CACHE_DATA:
559 __asm__ __volatile__ (".chip 68060\n\t"
560 "cpushp %%dc,(%0)\n\t"
561 ".chip 68k"
562 : : "a" (paddr));
563 break;
564 case FLUSH_CACHE_INSN:
565 __asm__ __volatile__ (".chip 68060\n\t"
566 "cpushp %%ic,(%0)\n\t"
567 ".chip 68k"
568 : : "a" (paddr));
569 break;
570 default:
571 case FLUSH_CACHE_BOTH:
572 __asm__ __volatile__ (".chip 68060\n\t"
573 "cpushp %%bc,(%0)\n\t"
574 ".chip 68k"
575 : : "a" (paddr));
576 break;
579 break;
581 return 0;
584 /* sys_cacheflush -- flush (part of) the processor cache. */
585 asmlinkage int
586 sys_cacheflush (unsigned long addr, int scope, int cache, unsigned long len)
588 struct vm_area_struct *vma;
589 int ret = -EINVAL;
591 lock_kernel();
592 if (scope < FLUSH_SCOPE_LINE || scope > FLUSH_SCOPE_ALL ||
593 cache & ~FLUSH_CACHE_BOTH)
594 goto out;
596 if (scope == FLUSH_SCOPE_ALL) {
597 /* Only the superuser may explicitly flush the whole cache. */
598 ret = -EPERM;
599 if (!capable(CAP_SYS_ADMIN))
600 goto out;
601 } else {
603 * Verify that the specified address region actually belongs
604 * to this process.
606 vma = find_vma (current->mm, addr);
607 ret = -EINVAL;
608 /* Check for overflow. */
609 if (addr + len < addr)
610 goto out;
611 if (vma == NULL || addr < vma->vm_start || addr + len > vma->vm_end)
612 goto out;
615 if (CPU_IS_020_OR_030) {
616 if (scope == FLUSH_SCOPE_LINE && len < 256) {
617 unsigned long cacr;
618 __asm__ ("movec %%cacr, %0" : "=r" (cacr));
619 if (cache & FLUSH_CACHE_INSN)
620 cacr |= 4;
621 if (cache & FLUSH_CACHE_DATA)
622 cacr |= 0x400;
623 len >>= 2;
624 while (len--) {
625 __asm__ __volatile__ ("movec %1, %%caar\n\t"
626 "movec %0, %%cacr"
627 : /* no outputs */
628 : "r" (cacr), "r" (addr));
629 addr += 4;
631 } else {
632 /* Flush the whole cache, even if page granularity requested. */
633 unsigned long cacr;
634 __asm__ ("movec %%cacr, %0" : "=r" (cacr));
635 if (cache & FLUSH_CACHE_INSN)
636 cacr |= 8;
637 if (cache & FLUSH_CACHE_DATA)
638 cacr |= 0x800;
639 __asm__ __volatile__ ("movec %0, %%cacr" : : "r" (cacr));
641 ret = 0;
642 goto out;
643 } else {
645 * 040 or 060: don't blindly trust 'scope', someone could
646 * try to flush a few megs of memory.
649 if (len>=3*PAGE_SIZE && scope<FLUSH_SCOPE_PAGE)
650 scope=FLUSH_SCOPE_PAGE;
651 if (len>=10*PAGE_SIZE && scope<FLUSH_SCOPE_ALL)
652 scope=FLUSH_SCOPE_ALL;
653 if (CPU_IS_040) {
654 ret = cache_flush_040 (addr, scope, cache, len);
655 } else if (CPU_IS_060) {
656 ret = cache_flush_060 (addr, scope, cache, len);
659 out:
660 unlock_kernel();
661 return ret;
664 asmlinkage int sys_getpagesize(void)
666 return PAGE_SIZE;
670 * Do a system call from kernel instead of calling sys_execve so we
671 * end up with proper pt_regs.
673 int kernel_execve(const char *filename, char *const argv[], char *const envp[])
675 register long __res asm ("%d0") = __NR_execve;
676 register long __a asm ("%d1") = (long)(filename);
677 register long __b asm ("%d2") = (long)(argv);
678 register long __c asm ("%d3") = (long)(envp);
679 asm volatile ("trap #0" : "+d" (__res)
680 : "d" (__a), "d" (__b), "d" (__c));
681 return __res;