URL
https://opencores.org/ocsvn/or1k/or1k/trunk
Subversion Repositories or1k
[/] [or1k/] [trunk/] [linux/] [linux-2.4/] [arch/] [m68k/] [kernel/] [sys_m68k.c] - Rev 1275
Go to most recent revision | Compare with Previous | Blame | View Log
/* * linux/arch/m68k/kernel/sys_m68k.c * * This file contains various random system calls that * have a non-standard calling sequence on the Linux/m68k * platform. */ #include <linux/errno.h> #include <linux/sched.h> #include <linux/mm.h> #include <linux/smp.h> #include <linux/smp_lock.h> #include <linux/sem.h> #include <linux/msg.h> #include <linux/shm.h> #include <linux/stat.h> #include <linux/mman.h> #include <linux/file.h> #include <linux/utsname.h> #include <asm/setup.h> #include <asm/uaccess.h> #include <asm/cachectl.h> #include <asm/traps.h> #include <asm/ipc.h> #include <asm/page.h> /* * sys_pipe() is the normal C calling standard for creating * a pipe. It's not the way unix traditionally does this, though. */ asmlinkage int sys_pipe(unsigned long * fildes) { int fd[2]; int error; error = do_pipe(fd); if (!error) { if (copy_to_user(fildes, fd, 2*sizeof(int))) error = -EFAULT; } return error; } /* common code for old and new mmaps */ static inline long do_mmap2( unsigned long addr, unsigned long len, unsigned long prot, unsigned long flags, unsigned long fd, unsigned long pgoff) { int error = -EBADF; struct file * file = NULL; flags &= ~(MAP_EXECUTABLE | MAP_DENYWRITE); if (!(flags & MAP_ANONYMOUS)) { file = fget(fd); if (!file) goto out; } down_write(¤t->mm->mmap_sem); error = do_mmap_pgoff(file, addr, len, prot, flags, pgoff); up_write(¤t->mm->mmap_sem); if (file) fput(file); out: return error; } asmlinkage long sys_mmap2(unsigned long addr, unsigned long len, unsigned long prot, unsigned long flags, unsigned long fd, unsigned long pgoff) { return do_mmap2(addr, len, prot, flags, fd, pgoff); } /* * Perform the select(nd, in, out, ex, tv) and mmap() system * calls. Linux/m68k cloned Linux/i386, which didn't use to be able to * handle more than 4 system call parameters, so these system calls * used a memory block for parameter passing.. */ struct mmap_arg_struct { unsigned long addr; unsigned long len; unsigned long prot; unsigned long flags; unsigned long fd; unsigned long offset; }; asmlinkage int old_mmap(struct mmap_arg_struct *arg) { struct mmap_arg_struct a; int error = -EFAULT; if (copy_from_user(&a, arg, sizeof(a))) goto out; error = -EINVAL; if (a.offset & ~PAGE_MASK) goto out; a.flags &= ~(MAP_EXECUTABLE | MAP_DENYWRITE); error = do_mmap2(a.addr, a.len, a.prot, a.flags, a.fd, a.offset >> PAGE_SHIFT); out: return error; } #if 0 struct mmap_arg_struct64 { __u32 addr; __u32 len; __u32 prot; __u32 flags; __u64 offset; /* 64 bits */ __u32 fd; }; asmlinkage long sys_mmap64(struct mmap_arg_struct64 *arg) { int error = -EFAULT; struct file * file = NULL; struct mmap_arg_struct64 a; unsigned long pgoff; if (copy_from_user(&a, arg, sizeof(a))) return -EFAULT; if ((long)a.offset & ~PAGE_MASK) return -EINVAL; pgoff = a.offset >> PAGE_SHIFT; if ((a.offset >> PAGE_SHIFT) != pgoff) return -EINVAL; if (!(a.flags & MAP_ANONYMOUS)) { error = -EBADF; file = fget(a.fd); if (!file) goto out; } a.flags &= ~(MAP_EXECUTABLE | MAP_DENYWRITE); down_write(¤t->mm->mmap_sem); error = do_mmap_pgoff(file, a.addr, a.len, a.prot, a.flags, pgoff); up_write(¤t->mm->mmap_sem); if (file) fput(file); out: return error; } #endif extern asmlinkage int sys_select(int, fd_set *, fd_set *, fd_set *, struct timeval *); struct sel_arg_struct { unsigned long n; fd_set *inp, *outp, *exp; struct timeval *tvp; }; asmlinkage int old_select(struct sel_arg_struct *arg) { struct sel_arg_struct a; if (copy_from_user(&a, arg, sizeof(a))) return -EFAULT; /* sys_select() does the appropriate kernel locking */ return sys_select(a.n, a.inp, a.outp, a.exp, a.tvp); } /* * sys_ipc() is the de-multiplexer for the SysV IPC calls.. * * This is really horribly ugly. */ asmlinkage int sys_ipc (uint call, int first, int second, int third, void *ptr, long fifth) { int version, ret; version = call >> 16; /* hack for backward compatibility */ call &= 0xffff; if (call <= SEMCTL) switch (call) { case SEMOP: return sys_semop (first, (struct sembuf *)ptr, second); case SEMGET: return sys_semget (first, second, third); case SEMCTL: { union semun fourth; if (!ptr) return -EINVAL; if (get_user(fourth.__pad, (void **) ptr)) return -EFAULT; return sys_semctl (first, second, third, fourth); } default: return -EINVAL; } if (call <= MSGCTL) switch (call) { case MSGSND: return sys_msgsnd (first, (struct msgbuf *) ptr, second, third); case MSGRCV: switch (version) { case 0: { struct ipc_kludge tmp; if (!ptr) return -EINVAL; if (copy_from_user (&tmp, (struct ipc_kludge *)ptr, sizeof (tmp))) return -EFAULT; return sys_msgrcv (first, tmp.msgp, second, tmp.msgtyp, third); } default: return sys_msgrcv (first, (struct msgbuf *) ptr, second, fifth, third); } case MSGGET: return sys_msgget ((key_t) first, second); case MSGCTL: return sys_msgctl (first, second, (struct msqid_ds *) ptr); default: return -EINVAL; } if (call <= SHMCTL) switch (call) { case SHMAT: switch (version) { default: { ulong raddr; ret = sys_shmat (first, (char *) ptr, second, &raddr); if (ret) return ret; return put_user (raddr, (ulong *) third); } } case SHMDT: return sys_shmdt ((char *)ptr); case SHMGET: return sys_shmget (first, second, third); case SHMCTL: return sys_shmctl (first, second, (struct shmid_ds *) ptr); default: return -EINVAL; } return -EINVAL; } asmlinkage int sys_ioperm(unsigned long from, unsigned long num, int on) { return -ENOSYS; } /* Convert virtual (user) address VADDR to physical address PADDR */ #define virt_to_phys_040(vaddr) \ ({ \ unsigned long _mmusr, _paddr; \ \ __asm__ __volatile__ (".chip 68040\n\t" \ "ptestr (%1)\n\t" \ "movec %%mmusr,%0\n\t" \ ".chip 68k" \ : "=r" (_mmusr) \ : "a" (vaddr)); \ _paddr = (_mmusr & MMU_R_040) ? (_mmusr & PAGE_MASK) : 0; \ _paddr; \ }) static inline int cache_flush_040 (unsigned long addr, int scope, int cache, unsigned long len) { unsigned long paddr, i; switch (scope) { case FLUSH_SCOPE_ALL: switch (cache) { case FLUSH_CACHE_DATA: /* This nop is needed for some broken versions of the 68040. */ __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpusha %dc\n\t" ".chip 68k"); break; case FLUSH_CACHE_INSN: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpusha %ic\n\t" ".chip 68k"); break; default: case FLUSH_CACHE_BOTH: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpusha %bc\n\t" ".chip 68k"); break; } break; case FLUSH_SCOPE_LINE: /* Find the physical address of the first mapped page in the address range. */ if ((paddr = virt_to_phys_040(addr))) { paddr += addr & ~(PAGE_MASK | 15); len = (len + (addr & 15) + 15) >> 4; } else { unsigned long tmp = PAGE_SIZE - (addr & ~PAGE_MASK); if (len <= tmp) return 0; addr += tmp; len -= tmp; tmp = PAGE_SIZE; for (;;) { if ((paddr = virt_to_phys_040(addr))) break; if (len <= tmp) return 0; addr += tmp; len -= tmp; } len = (len + 15) >> 4; } i = (PAGE_SIZE - (paddr & ~PAGE_MASK)) >> 4; while (len--) { switch (cache) { case FLUSH_CACHE_DATA: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpushl %%dc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; case FLUSH_CACHE_INSN: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpushl %%ic,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; default: case FLUSH_CACHE_BOTH: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpushl %%bc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; } if (!--i && len) { /* * No need to page align here since it is done by * virt_to_phys_040(). */ addr += PAGE_SIZE; i = PAGE_SIZE / 16; /* Recompute physical address when crossing a page boundary. */ for (;;) { if ((paddr = virt_to_phys_040(addr))) break; if (len <= i) return 0; len -= i; addr += PAGE_SIZE; } } else paddr += 16; } break; default: case FLUSH_SCOPE_PAGE: len += (addr & ~PAGE_MASK) + (PAGE_SIZE - 1); for (len >>= PAGE_SHIFT; len--; addr += PAGE_SIZE) { if (!(paddr = virt_to_phys_040(addr))) continue; switch (cache) { case FLUSH_CACHE_DATA: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpushp %%dc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; case FLUSH_CACHE_INSN: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpushp %%ic,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; default: case FLUSH_CACHE_BOTH: __asm__ __volatile__ ("nop\n\t" ".chip 68040\n\t" "cpushp %%bc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; } } break; } return 0; } #define virt_to_phys_060(vaddr) \ ({ \ unsigned long paddr; \ __asm__ __volatile__ (".chip 68060\n\t" \ "plpar (%0)\n\t" \ ".chip 68k" \ : "=a" (paddr) \ : "0" (vaddr)); \ (paddr); /* XXX */ \ }) static inline int cache_flush_060 (unsigned long addr, int scope, int cache, unsigned long len) { unsigned long paddr, i; /* * 68060 manual says: * cpush %dc : flush DC, remains valid (with our %cacr setup) * cpush %ic : invalidate IC * cpush %bc : flush DC + invalidate IC */ switch (scope) { case FLUSH_SCOPE_ALL: switch (cache) { case FLUSH_CACHE_DATA: __asm__ __volatile__ (".chip 68060\n\t" "cpusha %dc\n\t" ".chip 68k"); break; case FLUSH_CACHE_INSN: __asm__ __volatile__ (".chip 68060\n\t" "cpusha %ic\n\t" ".chip 68k"); break; default: case FLUSH_CACHE_BOTH: __asm__ __volatile__ (".chip 68060\n\t" "cpusha %bc\n\t" ".chip 68k"); break; } break; case FLUSH_SCOPE_LINE: /* Find the physical address of the first mapped page in the address range. */ len += addr & 15; addr &= -16; if (!(paddr = virt_to_phys_060(addr))) { unsigned long tmp = PAGE_SIZE - (addr & ~PAGE_MASK); if (len <= tmp) return 0; addr += tmp; len -= tmp; tmp = PAGE_SIZE; for (;;) { if ((paddr = virt_to_phys_060(addr))) break; if (len <= tmp) return 0; addr += tmp; len -= tmp; } } len = (len + 15) >> 4; i = (PAGE_SIZE - (paddr & ~PAGE_MASK)) >> 4; while (len--) { switch (cache) { case FLUSH_CACHE_DATA: __asm__ __volatile__ (".chip 68060\n\t" "cpushl %%dc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; case FLUSH_CACHE_INSN: __asm__ __volatile__ (".chip 68060\n\t" "cpushl %%ic,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; default: case FLUSH_CACHE_BOTH: __asm__ __volatile__ (".chip 68060\n\t" "cpushl %%bc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; } if (!--i && len) { /* * We just want to jump to the first cache line * in the next page. */ addr += PAGE_SIZE; addr &= PAGE_MASK; i = PAGE_SIZE / 16; /* Recompute physical address when crossing a page boundary. */ for (;;) { if ((paddr = virt_to_phys_060(addr))) break; if (len <= i) return 0; len -= i; addr += PAGE_SIZE; } } else paddr += 16; } break; default: case FLUSH_SCOPE_PAGE: len += (addr & ~PAGE_MASK) + (PAGE_SIZE - 1); addr &= PAGE_MASK; /* Workaround for bug in some revisions of the 68060 */ for (len >>= PAGE_SHIFT; len--; addr += PAGE_SIZE) { if (!(paddr = virt_to_phys_060(addr))) continue; switch (cache) { case FLUSH_CACHE_DATA: __asm__ __volatile__ (".chip 68060\n\t" "cpushp %%dc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; case FLUSH_CACHE_INSN: __asm__ __volatile__ (".chip 68060\n\t" "cpushp %%ic,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; default: case FLUSH_CACHE_BOTH: __asm__ __volatile__ (".chip 68060\n\t" "cpushp %%bc,(%0)\n\t" ".chip 68k" : : "a" (paddr)); break; } } break; } return 0; } /* sys_cacheflush -- flush (part of) the processor cache. */ asmlinkage int sys_cacheflush (unsigned long addr, int scope, int cache, unsigned long len) { struct vm_area_struct *vma; int ret = -EINVAL; lock_kernel(); if (scope < FLUSH_SCOPE_LINE || scope > FLUSH_SCOPE_ALL || cache & ~FLUSH_CACHE_BOTH) goto out; if (scope == FLUSH_SCOPE_ALL) { /* Only the superuser may explicitly flush the whole cache. */ ret = -EPERM; if (!capable(CAP_SYS_ADMIN)) goto out; } else { /* * Verify that the specified address region actually belongs * to this process. */ vma = find_vma (current->mm, addr); ret = -EINVAL; /* Check for overflow. */ if (addr + len < addr) goto out; if (vma == NULL || addr < vma->vm_start || addr + len > vma->vm_end) goto out; } if (CPU_IS_020_OR_030) { if (scope == FLUSH_SCOPE_LINE && len < 256) { unsigned long cacr; __asm__ ("movec %%cacr, %0" : "=r" (cacr)); if (cache & FLUSH_CACHE_INSN) cacr |= 4; if (cache & FLUSH_CACHE_DATA) cacr |= 0x400; len >>= 2; while (len--) { __asm__ __volatile__ ("movec %1, %%caar\n\t" "movec %0, %%cacr" : /* no outputs */ : "r" (cacr), "r" (addr)); addr += 4; } } else { /* Flush the whole cache, even if page granularity requested. */ unsigned long cacr; __asm__ ("movec %%cacr, %0" : "=r" (cacr)); if (cache & FLUSH_CACHE_INSN) cacr |= 8; if (cache & FLUSH_CACHE_DATA) cacr |= 0x800; __asm__ __volatile__ ("movec %0, %%cacr" : : "r" (cacr)); } ret = 0; goto out; } else { /* * 040 or 060: don't blindly trust 'scope', someone could * try to flush a few megs of memory. */ if (len>=3*PAGE_SIZE && scope<FLUSH_SCOPE_PAGE) scope=FLUSH_SCOPE_PAGE; if (len>=10*PAGE_SIZE && scope<FLUSH_SCOPE_ALL) scope=FLUSH_SCOPE_ALL; if (CPU_IS_040) { ret = cache_flush_040 (addr, scope, cache, len); } else if (CPU_IS_060) { ret = cache_flush_060 (addr, scope, cache, len); } } out: unlock_kernel(); return ret; } asmlinkage int sys_getpagesize(void) { return PAGE_SIZE; } /* * Old cruft */ asmlinkage int sys_pause(void) { current->state = TASK_INTERRUPTIBLE; schedule(); return -ERESTARTNOHAND; }
Go to most recent revision | Compare with Previous | Blame | View Log