2 * Copyright (C) 2002 Jeff Dike (jdike@karaya.com)
3 * Licensed under the GPL
12 #include <asm/unistd.h>
19 #include "ptrace_user.h"
20 #include "user_util.h"
21 #include "kern_util.h"
23 #include "registers.h"
24 #include "uml-config.h"
25 #include "sysdep/ptrace.h"
26 #include "sysdep/stub.h"
28 extern unsigned long batch_syscall_stub
, __syscall_stub_start
;
30 extern void wait_stub_done(int pid
, int sig
, char * fname
);
32 static inline unsigned long *check_init_stack(struct mm_id
* mm_idp
,
36 stack
= (unsigned long *) mm_idp
->stack
+ 2;
46 int multi_op_count
= 0;
48 static long do_syscall_stub(struct mm_id
*mm_idp
, void **addr
)
50 unsigned long regs
[MAX_REG_NR
];
52 unsigned long *syscall
;
54 int n
, pid
= mm_idp
->u
.pid
;
57 #warning Need to look up userspace_pid by cpu
58 pid
= userspace_pid
[0];
62 get_safe_registers(regs
);
63 regs
[REGS_IP_INDEX
] = UML_CONFIG_STUB_CODE
+
64 ((unsigned long) &batch_syscall_stub
-
65 (unsigned long) &__syscall_stub_start
);
66 n
= ptrace_setregs(pid
, regs
);
68 panic("do_syscall_stub : PTRACE_SETREGS failed, errno = %d\n",
71 wait_stub_done(pid
, 0, "do_syscall_stub");
73 /* When the stub stops, we find the following values on the
74 * beginning of the stack:
76 * (long )offset to failed sycall-data (0, if no error)
78 ret
= *((unsigned long *) mm_idp
->stack
);
79 offset
= *((unsigned long *) mm_idp
->stack
+ 1);
81 data
= (unsigned long *)(mm_idp
->stack
+
82 offset
- UML_CONFIG_STUB_DATA
);
83 syscall
= (unsigned long *)((unsigned long)data
+ data
[0]);
84 printk("do_syscall_stub: syscall %ld failed, return value = "
85 "0x%lx, expected return value = 0x%lx\n",
86 syscall
[0], ret
, syscall
[7]);
87 printk(" syscall parameters: "
88 "0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx\n",
89 syscall
[1], syscall
[2], syscall
[3],
90 syscall
[4], syscall
[5], syscall
[6]);
91 for(n
= 1; n
< data
[0]/sizeof(long); n
++) {
93 printk(" additional syscall data:");
96 printk(" 0x%lx", data
[n
]);
103 *addr
= check_init_stack(mm_idp
, NULL
);
108 long run_syscall_stub(struct mm_id
* mm_idp
, int syscall
,
109 unsigned long *args
, long expected
, void **addr
,
112 unsigned long *stack
= check_init_stack(mm_idp
, *addr
);
114 if(done
&& *addr
== NULL
)
117 *stack
+= sizeof(long);
118 stack
+= *stack
/ sizeof(long);
131 if(!done
&& ((((unsigned long) stack
) & ~PAGE_MASK
) <
132 PAGE_SIZE
- 10 * sizeof(long))){
137 return do_syscall_stub(mm_idp
, addr
);
140 long syscall_stub_data(struct mm_id
* mm_idp
,
141 unsigned long *data
, int data_count
,
142 void **addr
, void **stub_addr
)
144 unsigned long *stack
;
147 /* If *addr still is uninitialized, it *must* contain NULL.
148 * Thus in this case do_syscall_stub correctly won't be called.
150 if((((unsigned long) *addr
) & ~PAGE_MASK
) >=
151 PAGE_SIZE
- (10 + data_count
) * sizeof(long)) {
152 ret
= do_syscall_stub(mm_idp
, addr
);
153 /* in case of error, don't overwrite data on stack */
158 stack
= check_init_stack(mm_idp
, *addr
);
161 *stack
= data_count
* sizeof(long);
163 memcpy(stack
+ 1, data
, data_count
* sizeof(long));
165 *stub_addr
= (void *)(((unsigned long)(stack
+ 1) & ~PAGE_MASK
) +
166 UML_CONFIG_STUB_DATA
);
171 int map(struct mm_id
* mm_idp
, unsigned long virt
, unsigned long len
,
172 int r
, int w
, int x
, int phys_fd
, unsigned long long offset
,
173 int done
, void **data
)
177 prot
= (r
? PROT_READ
: 0) | (w
? PROT_WRITE
: 0) |
181 struct proc_mm_op map
;
182 int fd
= mm_idp
->u
.mm_fd
;
184 map
= ((struct proc_mm_op
) { .op
= MM_MMAP
,
190 .flags
= MAP_SHARED
|
195 ret
= os_write_file(fd
, &map
, sizeof(map
));
196 if(ret
!= sizeof(map
))
197 printk("map : /proc/mm map failed, err = %d\n", -ret
);
201 unsigned long args
[] = { virt
, len
, prot
,
202 MAP_SHARED
| MAP_FIXED
, phys_fd
,
203 MMAP_OFFSET(offset
) };
205 ret
= run_syscall_stub(mm_idp
, STUB_MMAP_NR
, args
, virt
,
212 int unmap(struct mm_id
* mm_idp
, void *addr
, unsigned long len
, int done
,
218 struct proc_mm_op unmap
;
219 int fd
= mm_idp
->u
.mm_fd
;
221 unmap
= ((struct proc_mm_op
) { .op
= MM_MUNMAP
,
225 (unsigned long) addr
,
227 ret
= os_write_file(fd
, &unmap
, sizeof(unmap
));
228 if(ret
!= sizeof(unmap
))
229 printk("unmap - proc_mm write returned %d\n", ret
);
233 unsigned long args
[] = { (unsigned long) addr
, len
, 0, 0, 0,
236 ret
= run_syscall_stub(mm_idp
, __NR_munmap
, args
, 0,
239 printk("munmap stub failed, errno = %d\n", ret
);
245 int protect(struct mm_id
* mm_idp
, unsigned long addr
, unsigned long len
,
246 int r
, int w
, int x
, int done
, void **data
)
248 struct proc_mm_op protect
;
251 prot
= (r
? PROT_READ
: 0) | (w
? PROT_WRITE
: 0) |
255 int fd
= mm_idp
->u
.mm_fd
;
256 protect
= ((struct proc_mm_op
) { .op
= MM_MPROTECT
,
260 (unsigned long) addr
,
262 .prot
= prot
} } } );
264 ret
= os_write_file(fd
, &protect
, sizeof(protect
));
265 if(ret
!= sizeof(protect
))
266 printk("protect failed, err = %d", -ret
);
270 unsigned long args
[] = { addr
, len
, prot
, 0, 0, 0 };
272 ret
= run_syscall_stub(mm_idp
, __NR_mprotect
, args
, 0,
279 void before_mem_skas(unsigned long unused
)