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 "kern_util.h"
22 #include "registers.h"
23 #include "uml-config.h"
24 #include "sysdep/ptrace.h"
25 #include "sysdep/stub.h"
27 extern unsigned long batch_syscall_stub
, __syscall_stub_start
;
29 extern void wait_stub_done(int pid
, int sig
, char * fname
);
31 static inline unsigned long *check_init_stack(struct mm_id
* mm_idp
,
35 stack
= (unsigned long *) mm_idp
->stack
+ 2;
45 int multi_op_count
= 0;
47 static inline long do_syscall_stub(struct mm_id
* mm_idp
, void **addr
)
49 unsigned long regs
[MAX_REG_NR
];
53 unsigned long * syscall
;
54 int 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
, NULL
);
63 regs
[REGS_IP_INDEX
] = UML_CONFIG_STUB_CODE
+
64 ((unsigned long) &batch_syscall_stub
-
65 (unsigned long) &__syscall_stub_start
);
67 n
= ptrace_setregs(pid
, regs
);
69 printk("Registers - \n");
70 for(i
= 0; i
< MAX_REG_NR
; i
++)
71 printk("\t%d\t0x%lx\n", i
, regs
[i
]);
72 panic("do_syscall_stub : PTRACE_SETREGS failed, errno = %d\n",
76 wait_stub_done(pid
, 0, "do_syscall_stub");
78 /* When the stub stops, we find the following values on the
79 * beginning of the stack:
81 * (long )offset to failed sycall-data (0, if no error)
83 ret
= *((unsigned long *) mm_idp
->stack
);
84 offset
= *((unsigned long *) mm_idp
->stack
+ 1);
86 data
= (unsigned long *)(mm_idp
->stack
+
87 offset
- UML_CONFIG_STUB_DATA
);
88 printk("do_syscall_stub : ret = %ld, offset = %ld, "
89 "data = %p\n", ret
, offset
, data
);
90 syscall
= (unsigned long *)((unsigned long)data
+ data
[0]);
91 printk("do_syscall_stub: syscall %ld failed, return value = "
92 "0x%lx, expected return value = 0x%lx\n",
93 syscall
[0], ret
, syscall
[7]);
94 printk(" syscall parameters: "
95 "0x%lx 0x%lx 0x%lx 0x%lx 0x%lx 0x%lx\n",
96 syscall
[1], syscall
[2], syscall
[3],
97 syscall
[4], syscall
[5], syscall
[6]);
98 for(n
= 1; n
< data
[0]/sizeof(long); n
++) {
100 printk(" additional syscall data:");
103 printk(" 0x%lx", data
[n
]);
110 *addr
= check_init_stack(mm_idp
, NULL
);
115 long run_syscall_stub(struct mm_id
* mm_idp
, int syscall
,
116 unsigned long *args
, long expected
, void **addr
,
119 unsigned long *stack
= check_init_stack(mm_idp
, *addr
);
121 if(done
&& *addr
== NULL
)
124 *stack
+= sizeof(long);
125 stack
+= *stack
/ sizeof(long);
138 if(!done
&& ((((unsigned long) stack
) & ~PAGE_MASK
) <
139 PAGE_SIZE
- 10 * sizeof(long))){
144 return do_syscall_stub(mm_idp
, addr
);
147 long syscall_stub_data(struct mm_id
* mm_idp
,
148 unsigned long *data
, int data_count
,
149 void **addr
, void **stub_addr
)
151 unsigned long *stack
;
154 /* If *addr still is uninitialized, it *must* contain NULL.
155 * Thus in this case do_syscall_stub correctly won't be called.
157 if((((unsigned long) *addr
) & ~PAGE_MASK
) >=
158 PAGE_SIZE
- (10 + data_count
) * sizeof(long)) {
159 ret
= do_syscall_stub(mm_idp
, addr
);
160 /* in case of error, don't overwrite data on stack */
165 stack
= check_init_stack(mm_idp
, *addr
);
168 *stack
= data_count
* sizeof(long);
170 memcpy(stack
+ 1, data
, data_count
* sizeof(long));
172 *stub_addr
= (void *)(((unsigned long)(stack
+ 1) & ~PAGE_MASK
) +
173 UML_CONFIG_STUB_DATA
);
178 int map(struct mm_id
* mm_idp
, unsigned long virt
, unsigned long len
,
179 int r
, int w
, int x
, int phys_fd
, unsigned long long offset
,
180 int done
, void **data
)
184 prot
= (r
? PROT_READ
: 0) | (w
? PROT_WRITE
: 0) |
188 struct proc_mm_op map
;
189 int fd
= mm_idp
->u
.mm_fd
;
191 map
= ((struct proc_mm_op
) { .op
= MM_MMAP
,
197 .flags
= MAP_SHARED
|
202 ret
= os_write_file(fd
, &map
, sizeof(map
));
203 if(ret
!= sizeof(map
))
204 printk("map : /proc/mm map failed, err = %d\n", -ret
);
208 unsigned long args
[] = { virt
, len
, prot
,
209 MAP_SHARED
| MAP_FIXED
, phys_fd
,
210 MMAP_OFFSET(offset
) };
212 ret
= run_syscall_stub(mm_idp
, STUB_MMAP_NR
, args
, virt
,
219 int unmap(struct mm_id
* mm_idp
, void *addr
, unsigned long len
, int done
,
225 struct proc_mm_op unmap
;
226 int fd
= mm_idp
->u
.mm_fd
;
228 unmap
= ((struct proc_mm_op
) { .op
= MM_MUNMAP
,
232 (unsigned long) addr
,
234 ret
= os_write_file(fd
, &unmap
, sizeof(unmap
));
235 if(ret
!= sizeof(unmap
))
236 printk("unmap - proc_mm write returned %d\n", ret
);
240 unsigned long args
[] = { (unsigned long) addr
, len
, 0, 0, 0,
243 ret
= run_syscall_stub(mm_idp
, __NR_munmap
, args
, 0,
250 int protect(struct mm_id
* mm_idp
, unsigned long addr
, unsigned long len
,
251 int r
, int w
, int x
, int done
, void **data
)
253 struct proc_mm_op protect
;
256 prot
= (r
? PROT_READ
: 0) | (w
? PROT_WRITE
: 0) |
259 int fd
= mm_idp
->u
.mm_fd
;
261 protect
= ((struct proc_mm_op
) { .op
= MM_MPROTECT
,
265 (unsigned long) addr
,
267 .prot
= prot
} } } );
269 ret
= os_write_file(fd
, &protect
, sizeof(protect
));
270 if(ret
!= sizeof(protect
))
271 printk("protect failed, err = %d", -ret
);
275 unsigned long args
[] = { addr
, len
, prot
, 0, 0, 0 };
277 ret
= run_syscall_stub(mm_idp
, __NR_mprotect
, args
, 0,
284 void before_mem_skas(unsigned long unused
)