Remove unecessary range check. start and num are unsigned anyway and
[dragonfly.git] / sys / platform / pc32 / i386 / sys_machdep.c
1 /*-
2  * Copyright (c) 1990 The Regents of the University of California.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. All advertising materials mentioning features or use of this software
14  *    must display the following acknowledgement:
15  *      This product includes software developed by the University of
16  *      California, Berkeley and its contributors.
17  * 4. Neither the name of the University nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  *      from: @(#)sys_machdep.c 5.5 (Berkeley) 1/19/91
34  * $FreeBSD: src/sys/i386/i386/sys_machdep.c,v 1.47.2.3 2002/10/07 17:20:00 jhb Exp $
35  * $DragonFly: src/sys/platform/pc32/i386/sys_machdep.c,v 1.15 2004/12/20 13:58:02 joerg Exp $
36  *
37  */
38
39 #include <sys/param.h>
40 #include <sys/systm.h>
41 #include <sys/sysproto.h>
42 #include <sys/malloc.h>
43 #include <sys/thread.h>
44 #include <sys/proc.h>
45 #include <sys/thread.h>
46
47 #include <vm/vm.h>
48 #include <sys/lock.h>
49 #include <vm/pmap.h>
50 #include <vm/vm_map.h>
51 #include <vm/vm_extern.h>
52
53 #include <sys/user.h>
54
55 #include <machine/cpu.h>
56 #include <machine/ipl.h>
57 #include <machine/pcb_ext.h>    /* pcb.h included by sys/user.h */
58 #include <machine/sysarch.h>
59 #ifdef SMP
60 #include <machine/smp.h>
61 #endif
62 #include <machine/globaldata.h> /* mdcpu */
63
64 #include <vm/vm_kern.h>         /* for kernel_map */
65 #include <sys/thread2.h>
66
67 #define MAX_LD 8192
68 #define LD_PER_PAGE 512
69 #define NEW_MAX_LD(num)  ((num + LD_PER_PAGE) & ~(LD_PER_PAGE-1))
70 #define SIZE_FROM_LARGEST_LD(num) (NEW_MAX_LD(num) << 3)
71
72
73
74 static int i386_get_ldt (struct proc *, char *, int *);
75 static int i386_set_ldt (struct proc *, char *, int *);
76 static int i386_get_ioperm      (struct proc *, char *);
77 static int i386_set_ioperm      (struct proc *, char *);
78 int i386_extend_pcb     (struct proc *);
79
80 /*
81  * sysarch_args(int op, char *params)
82  */
83
84 int
85 sysarch(struct sysarch_args *uap)
86 {
87         struct proc *p = curproc;
88         int error = 0;
89
90         switch(uap->op) {
91         case I386_GET_LDT:
92                 error = i386_get_ldt(p, uap->parms, &uap->sysmsg_result);
93                 break;
94
95         case I386_SET_LDT:
96                 error = i386_set_ldt(p, uap->parms, &uap->sysmsg_result);
97                 break;
98         case I386_GET_IOPERM:
99                 error = i386_get_ioperm(p, uap->parms);
100                 break;
101         case I386_SET_IOPERM:
102                 error = i386_set_ioperm(p, uap->parms);
103                 break;
104         case I386_VM86:
105                 error = vm86_sysarch(p, uap->parms);
106                 break;
107         default:
108                 error = EOPNOTSUPP;
109                 break;
110         }
111         return (error);
112 }
113
114 int
115 i386_extend_pcb(struct proc *p)
116 {
117         int i, offset;
118         u_long *addr;
119         struct pcb_ext *ext;
120         struct soft_segment_descriptor ssd = {
121                 0,                      /* segment base address (overwritten) */
122                 ctob(IOPAGES + 1) - 1,  /* length */
123                 SDT_SYS386TSS,          /* segment type */
124                 0,                      /* priority level */
125                 1,                      /* descriptor present */
126                 0, 0,
127                 0,                      /* default 32 size */
128                 0                       /* granularity */
129         };
130
131         ext = (struct pcb_ext *)kmem_alloc(kernel_map, ctob(IOPAGES+1));
132         if (ext == 0)
133                 return (ENOMEM);
134         p->p_thread->td_pcb->pcb_ext = ext;
135         bzero(ext, sizeof(struct pcb_ext)); 
136         ext->ext_tss.tss_esp0 = (unsigned)((char *)p->p_thread->td_pcb - 16);
137         ext->ext_tss.tss_ss0 = GSEL(GDATA_SEL, SEL_KPL);
138         /*
139          * The last byte of the i/o map must be followed by an 0xff byte.
140          * We arbitrarily allocate 16 bytes here, to keep the starting
141          * address on a doubleword boundary.
142          */
143         offset = PAGE_SIZE - 16;
144         ext->ext_tss.tss_ioopt = 
145             (offset - ((unsigned)&ext->ext_tss - (unsigned)ext)) << 16;
146         ext->ext_iomap = (caddr_t)ext + offset;
147         ext->ext_vm86.vm86_intmap = (caddr_t)ext + offset - 32;
148
149         addr = (u_long *)ext->ext_vm86.vm86_intmap;
150         for (i = 0; i < (ctob(IOPAGES) + 32 + 16) / sizeof(u_long); i++)
151                 *addr++ = ~0;
152
153         ssd.ssd_base = (unsigned)&ext->ext_tss;
154         ssd.ssd_limit -= ((unsigned)&ext->ext_tss - (unsigned)ext);
155         ssdtosd(&ssd, &ext->ext_tssd);
156         
157         /* switch to the new TSS after syscall completes */
158         need_user_resched();
159
160         return 0;
161 }
162
163 static int
164 i386_set_ioperm(struct proc *p, char *args)
165 {
166         int i, error;
167         struct i386_ioperm_args ua;
168         char *iomap;
169
170         if ((error = copyin(args, &ua, sizeof(struct i386_ioperm_args))) != 0)
171                 return (error);
172
173         if ((error = suser_cred(p->p_ucred, 0)) != 0)
174                 return (error);
175         if (securelevel > 0)
176                 return (EPERM);
177         /*
178          * XXX 
179          * While this is restricted to root, we should probably figure out
180          * whether any other driver is using this i/o address, as so not to
181          * cause confusion.  This probably requires a global 'usage registry'.
182          */
183
184         if (p->p_thread->td_pcb->pcb_ext == 0)
185                 if ((error = i386_extend_pcb(p)) != 0)
186                         return (error);
187         iomap = (char *)p->p_thread->td_pcb->pcb_ext->ext_iomap;
188
189         if (ua.start + ua.length > IOPAGES * PAGE_SIZE * NBBY)
190                 return (EINVAL);
191
192         for (i = ua.start; i < ua.start + ua.length; i++) {
193                 if (ua.enable) 
194                         iomap[i >> 3] &= ~(1 << (i & 7));
195                 else
196                         iomap[i >> 3] |= (1 << (i & 7));
197         }
198         return (error);
199 }
200
201 static int
202 i386_get_ioperm(struct proc *p, char *args)
203 {
204         int i, state, error;
205         struct i386_ioperm_args ua;
206         char *iomap;
207
208         if ((error = copyin(args, &ua, sizeof(struct i386_ioperm_args))) != 0)
209                 return (error);
210         if (ua.start >= IOPAGES * PAGE_SIZE * NBBY)
211                 return (EINVAL);
212
213         if (p->p_thread->td_pcb->pcb_ext == 0) {
214                 ua.length = 0;
215                 goto done;
216         }
217
218         iomap = (char *)p->p_thread->td_pcb->pcb_ext->ext_iomap;
219
220         i = ua.start;
221         state = (iomap[i >> 3] >> (i & 7)) & 1;
222         ua.enable = !state;
223         ua.length = 1;
224
225         for (i = ua.start + 1; i < IOPAGES * PAGE_SIZE * NBBY; i++) {
226                 if (state != ((iomap[i >> 3] >> (i & 7)) & 1))
227                         break;
228                 ua.length++;
229         }
230                         
231 done:
232         error = copyout(&ua, args, sizeof(struct i386_ioperm_args));
233         return (error);
234 }
235
236 /*
237  * Update the GDT entry pointing to the LDT to point to the LDT of the
238  * current process.  Do not staticize.
239  */   
240 void
241 set_user_ldt(struct pcb *pcb)
242 {
243         struct pcb_ldt *pcb_ldt;
244
245         if (pcb != curthread->td_pcb)
246                 return;
247
248         pcb_ldt = pcb->pcb_ldt;
249 #ifdef SMP
250         gdt[mycpu->gd_cpuid * NGDT + GUSERLDT_SEL].sd = pcb_ldt->ldt_sd;
251 #else
252         gdt[GUSERLDT_SEL].sd = pcb_ldt->ldt_sd;
253 #endif
254         lldt(GSEL(GUSERLDT_SEL, SEL_KPL));
255         mdcpu->gd_currentldt = GSEL(GUSERLDT_SEL, SEL_KPL);
256 }
257
258 struct pcb_ldt *
259 user_ldt_alloc(struct pcb *pcb, int len)
260 {
261         struct pcb_ldt *pcb_ldt, *new_ldt;
262
263         MALLOC(new_ldt, struct pcb_ldt *, sizeof(struct pcb_ldt),
264                 M_SUBPROC, M_WAITOK);
265         if (new_ldt == NULL)
266                 return NULL;
267
268         new_ldt->ldt_len = len = NEW_MAX_LD(len);
269         new_ldt->ldt_base = (caddr_t)kmem_alloc(kernel_map,
270                 len * sizeof(union descriptor));
271         if (new_ldt->ldt_base == NULL) {
272                 FREE(new_ldt, M_SUBPROC);
273                 return NULL;
274         }
275         new_ldt->ldt_refcnt = 1;
276         new_ldt->ldt_active = 0;
277
278         gdt_segs[GUSERLDT_SEL].ssd_base = (unsigned)new_ldt->ldt_base;
279         gdt_segs[GUSERLDT_SEL].ssd_limit = len * sizeof(union descriptor) - 1;
280         ssdtosd(&gdt_segs[GUSERLDT_SEL], &new_ldt->ldt_sd);
281
282         if ((pcb_ldt = pcb->pcb_ldt)) {
283                 if (len > pcb_ldt->ldt_len)
284                         len = pcb_ldt->ldt_len;
285                 bcopy(pcb_ldt->ldt_base, new_ldt->ldt_base,
286                         len * sizeof(union descriptor));
287         } else {
288                 bcopy(ldt, new_ldt->ldt_base, sizeof(ldt));
289         }
290         return new_ldt;
291 }
292
293 void
294 user_ldt_free(struct pcb *pcb)
295 {
296         struct pcb_ldt *pcb_ldt = pcb->pcb_ldt;
297
298         if (pcb_ldt == NULL)
299                 return;
300
301         crit_enter();
302         if (pcb == curthread->td_pcb) {
303                 lldt(_default_ldt);
304                 mdcpu->gd_currentldt = _default_ldt;
305         }
306         pcb->pcb_ldt = NULL;
307         crit_exit();
308
309         if (--pcb_ldt->ldt_refcnt == 0) {
310                 kmem_free(kernel_map, (vm_offset_t)pcb_ldt->ldt_base,
311                         pcb_ldt->ldt_len * sizeof(union descriptor));
312                 FREE(pcb_ldt, M_SUBPROC);
313         }
314 }
315
316 static int
317 i386_get_ldt(struct proc *p, char *args, int *res)
318 {
319         int error = 0;
320         struct pcb *pcb = p->p_thread->td_pcb;
321         struct pcb_ldt *pcb_ldt = pcb->pcb_ldt;
322         int nldt, num;
323         union descriptor *lp;
324         int s;
325         struct i386_ldt_args ua, *uap = &ua;
326
327         if ((error = copyin(args, uap, sizeof(struct i386_ldt_args))) < 0)
328                 return(error);
329
330 #ifdef  DEBUG
331         printf("i386_get_ldt: start=%d num=%d descs=%p\n",
332             uap->start, uap->num, (void *)uap->descs);
333 #endif
334
335         s = splhigh();
336
337         if (pcb_ldt) {
338                 nldt = pcb_ldt->ldt_len;
339                 num = min(uap->num, nldt);
340                 lp = &((union descriptor *)(pcb_ldt->ldt_base))[uap->start];
341         } else {
342                 nldt = sizeof(ldt)/sizeof(ldt[0]);
343                 num = min(uap->num, nldt);
344                 lp = &ldt[uap->start];
345         }
346         if (uap->start + num > nldt) {
347                 splx(s);
348                 return(EINVAL);
349         }
350
351         error = copyout(lp, uap->descs, num * sizeof(union descriptor));
352         if (!error)
353                 *res = num;
354         splx(s);
355         return(error);
356 }
357
358 static int
359 i386_set_ldt(struct proc *p, char *args, int *res)
360 {
361         int error = 0, i, n;
362         int largest_ld;
363         struct pcb *pcb = p->p_thread->td_pcb;
364         struct pcb_ldt *pcb_ldt = pcb->pcb_ldt;
365         union descriptor *descs;
366         int descs_size, s;
367         struct i386_ldt_args ua, *uap = &ua;
368
369         if ((error = copyin(args, uap, sizeof(struct i386_ldt_args))) < 0)
370                 return(error);
371
372 #ifdef  DEBUG
373         printf("i386_set_ldt: start=%d num=%d descs=%p\n",
374             uap->start, uap->num, (void *)uap->descs);
375 #endif
376
377         /* verify range of descriptors to modify */
378         if ((uap->start < 0) || (uap->start >= MAX_LD) || (uap->num < 0) ||
379                 (uap->num > MAX_LD))
380         {
381                 return(EINVAL);
382         }
383         largest_ld = uap->start + uap->num - 1;
384         if (largest_ld >= MAX_LD)
385                 return(EINVAL);
386
387         /* allocate user ldt */
388         if (!pcb_ldt || largest_ld >= pcb_ldt->ldt_len) {
389                 struct pcb_ldt *new_ldt = user_ldt_alloc(pcb, largest_ld);
390                 if (new_ldt == NULL)
391                         return ENOMEM;
392                 if (pcb_ldt) {
393                         pcb_ldt->ldt_sd = new_ldt->ldt_sd;
394                         kmem_free(kernel_map, (vm_offset_t)pcb_ldt->ldt_base,
395                                 pcb_ldt->ldt_len * sizeof(union descriptor));
396                         pcb_ldt->ldt_base = new_ldt->ldt_base;
397                         pcb_ldt->ldt_len = new_ldt->ldt_len;
398                         FREE(new_ldt, M_SUBPROC);
399                 } else
400                         pcb->pcb_ldt = pcb_ldt = new_ldt;
401 #ifdef SMP
402                 /* signal other cpus to reload ldt */
403                 smp_rendezvous(NULL, (void (*)(void *))set_user_ldt, NULL, pcb);
404 #else
405                 set_user_ldt(pcb);
406 #endif
407         }
408
409         descs_size = uap->num * sizeof(union descriptor);
410         descs = (union descriptor *)kmem_alloc(kernel_map, descs_size);
411         if (descs == NULL)
412                 return (ENOMEM);
413         error = copyin(&uap->descs[0], descs, descs_size);
414         if (error) {
415                 kmem_free(kernel_map, (vm_offset_t)descs, descs_size);
416                 return (error);
417         }
418         /* Check descriptors for access violations */
419         for (i = 0, n = uap->start; i < uap->num; i++, n++) {
420                 union descriptor *dp;
421                 dp = &descs[i];
422
423                 switch (dp->sd.sd_type) {
424                 case SDT_SYSNULL:       /* system null */ 
425                         dp->sd.sd_p = 0;
426                         break;
427                 case SDT_SYS286TSS: /* system 286 TSS available */
428                 case SDT_SYSLDT:    /* system local descriptor table */
429                 case SDT_SYS286BSY: /* system 286 TSS busy */
430                 case SDT_SYSTASKGT: /* system task gate */
431                 case SDT_SYS286IGT: /* system 286 interrupt gate */
432                 case SDT_SYS286TGT: /* system 286 trap gate */
433                 case SDT_SYSNULL2:  /* undefined by Intel */ 
434                 case SDT_SYS386TSS: /* system 386 TSS available */
435                 case SDT_SYSNULL3:  /* undefined by Intel */
436                 case SDT_SYS386BSY: /* system 386 TSS busy */
437                 case SDT_SYSNULL4:  /* undefined by Intel */ 
438                 case SDT_SYS386IGT: /* system 386 interrupt gate */
439                 case SDT_SYS386TGT: /* system 386 trap gate */
440                 case SDT_SYS286CGT: /* system 286 call gate */ 
441                 case SDT_SYS386CGT: /* system 386 call gate */
442                         /* I can't think of any reason to allow a user proc
443                          * to create a segment of these types.  They are
444                          * for OS use only.
445                          */
446                         kmem_free(kernel_map, (vm_offset_t)descs, descs_size);
447                         return EACCES;
448
449                 /* memory segment types */
450                 case SDT_MEMEC:   /* memory execute only conforming */
451                 case SDT_MEMEAC:  /* memory execute only accessed conforming */
452                 case SDT_MEMERC:  /* memory execute read conforming */
453                 case SDT_MEMERAC: /* memory execute read accessed conforming */
454                         /* Must be "present" if executable and conforming. */
455                         if (dp->sd.sd_p == 0) {
456                                 kmem_free(kernel_map, (vm_offset_t)descs,
457                                     descs_size);
458                                 return (EACCES);
459                         }
460                         break;
461                 case SDT_MEMRO:   /* memory read only */
462                 case SDT_MEMROA:  /* memory read only accessed */
463                 case SDT_MEMRW:   /* memory read write */
464                 case SDT_MEMRWA:  /* memory read write accessed */
465                 case SDT_MEMROD:  /* memory read only expand dwn limit */
466                 case SDT_MEMRODA: /* memory read only expand dwn lim accessed */
467                 case SDT_MEMRWD:  /* memory read write expand dwn limit */  
468                 case SDT_MEMRWDA: /* memory read write expand dwn lim acessed */
469                 case SDT_MEME:    /* memory execute only */ 
470                 case SDT_MEMEA:   /* memory execute only accessed */
471                 case SDT_MEMER:   /* memory execute read */
472                 case SDT_MEMERA:  /* memory execute read accessed */
473                         break;
474                 default:
475                         kmem_free(kernel_map, (vm_offset_t)descs, descs_size);
476                         return(EINVAL);
477                         /*NOTREACHED*/
478                 }
479
480                 /* Only user (ring-3) descriptors may be present. */
481                 if ((dp->sd.sd_p != 0) && (dp->sd.sd_dpl != SEL_UPL)) {
482                         kmem_free(kernel_map, (vm_offset_t)descs, descs_size);
483                         return (EACCES);
484                 }
485         }
486
487         s = splhigh();
488
489         /* Fill in range */
490         bcopy(descs, 
491                  &((union descriptor *)(pcb_ldt->ldt_base))[uap->start],
492                 uap->num * sizeof(union descriptor));
493         *res = uap->start;
494
495         splx(s);
496         kmem_free(kernel_map, (vm_offset_t)descs, descs_size);
497         return (0);
498 }