sys/i386/i386/ptrace_machdep.c

   1 /*-
   2  * Copyright (c) 2005 Doug Rabson
   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  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  *
  26  */
  27
  28 #include <sys/cdefs.h>
  29 __FBSDID("$FreeBSD$");
  30
  31 #include "opt_cpu.h"
  32
  33 #include <sys/param.h>
  34 #include <sys/systm.h>
  35 #include <sys/malloc.h>
  36 #include <sys/proc.h>
  37 #include <sys/ptrace.h>
  38 #include <machine/md_var.h>
  39 #include <machine/pcb.h>
  40
  41 #if !defined(CPU_DISABLE_SSE) && defined(I686_CPU)
  42 #define CPU_ENABLE_SSE
  43 #endif
  44
  45 #ifdef CPU_ENABLE_SSE
  46 static int
  47 cpu_ptrace_xstate(struct thread *td, int req, void *addr, int data)
  48 {
  49         char *savefpu;
  50         int error;
  51
  52         if (!use_xsave)
  53                 return (EOPNOTSUPP);
  54
  55         switch (req) {
  56         case PT_GETXSTATE:
  57                 npxgetregs(td);
  58                 savefpu = (char *)(get_pcb_user_save_td(td) + 1);
  59                 error = copyout(savefpu, addr,
  60                     cpu_max_ext_state_size - sizeof(union savefpu));
  61                 break;
  62
  63         case PT_SETXSTATE:
  64                 if (data > cpu_max_ext_state_size - sizeof(union savefpu)) {
  65                         error = EINVAL;
  66                         break;
  67                 }
  68                 savefpu = malloc(data, M_TEMP, M_WAITOK);
  69                 error = copyin(addr, savefpu, data);
  70                 if (error == 0) {
  71                         npxgetregs(td);
  72                         error = npxsetxstate(td, savefpu, data);
  73                 }
  74                 free(savefpu, M_TEMP);
  75                 break;
  76
  77         default:
  78                 error = EINVAL;
  79                 break;
  80         }
  81
  82         return (error);
  83 }
  84 #endif
  85
  86 int
  87 cpu_ptrace(struct thread *td, int req, void *addr, int data)
  88 {
  89 #ifdef CPU_ENABLE_SSE
  90         struct savexmm *fpstate;
  91         int error;
  92
  93         if (!cpu_fxsr)
  94                 return (EINVAL);
  95
  96         fpstate = &get_pcb_user_save_td(td)->sv_xmm;
  97         switch (req) {
  98         case PT_GETXMMREGS:
  99                 npxgetregs(td);
 100                 error = copyout(fpstate, addr, sizeof(*fpstate));
 101                 break;
 102
 103         case PT_SETXMMREGS:
 104                 npxgetregs(td);
 105                 error = copyin(addr, fpstate, sizeof(*fpstate));
 106                 fpstate->sv_env.en_mxcsr &= cpu_mxcsr_mask;
 107                 break;
 108
 109         case PT_GETXSTATE:
 110         case PT_SETXSTATE:
 111                 error = cpu_ptrace_xstate(td, req, addr, data);
 112                 break;
 113
 114         default:
 115                 return (EINVAL);
 116         }
 117
 118         return (error);
 119 #else
 120         return (EINVAL);
 121 #endif
 122 }