sys/sparc64/sparc64/rwindow.c

   1 /*-
   2  * Copyright (c) 1997 Berkeley Software Design, Inc. All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions
   6  * are met:
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  * 3. Berkeley Software Design Inc's name may not be used to endorse or
  13  *    promote products derived from this software without specific prior
  14  *    written permission.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY BERKELEY SOFTWARE DESIGN INC ``AS IS'' AND
  17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED.  IN NO EVENT SHALL BERKELEY SOFTWARE DESIGN INC BE LIABLE
  20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  *      from: BSDI: trap.c,v 1.17.2.9 1999/10/19 15:29:52 cp Exp
  29  * $FreeBSD$
  30  */
  31
  32 #include <sys/param.h>
  33 #include <sys/systm.h>
  34 #include <sys/ktr.h>
  35 #include <sys/proc.h>
  36
  37 #include <machine/frame.h>
  38 #include <machine/pcb.h>
  39
  40 CTASSERT((1 << RW_SHIFT) == sizeof(struct rwindow));
  41
  42 int
  43 rwindow_load(struct thread *td, struct trapframe *tf, int n)
  44 {
  45         struct rwindow rw;
  46         u_long usp;
  47         int error;
  48         int i;
  49
  50         CTR3(KTR_TRAP, "rwindow_load: td=%p (%s) n=%d",
  51             td, td->td_proc->p_comm, n);
  52
  53         /*
  54          * In case current window is still only on-chip, push it out;
  55          * if it cannot get all the way out, we cannot continue either.
  56          */
  57         if ((error = rwindow_save(td)) != 0)
  58                 return (error);
  59         usp = tf->tf_out[6];
  60         for (i = 0; i < n; i++) {
  61                 CTR1(KTR_TRAP, "rwindow_load: usp=%#lx", usp);
  62                 usp += SPOFF;
  63                 if ((error = (usp & 0x7)) != 0)
  64                         break;
  65                 error = copyin((void *)usp, &rw, sizeof rw);
  66                 usp = rw.rw_in[6];
  67         }
  68         CTR1(KTR_TRAP, "rwindow_load: error=%d", error);
  69         return (error == 0 ? 0 : SIGILL);
  70 }
  71
  72 int
  73 rwindow_save(struct thread *td)
  74 {
  75         struct rwindow *rw;
  76         struct pcb *pcb;
  77         u_long *ausp;
  78         u_long usp;
  79         int error;
  80         int i;
  81
  82         pcb = td->td_pcb;
  83         CTR3(KTR_TRAP, "rwindow_save: td=%p (%s) nsaved=%d", td,
  84             td->td_proc->p_comm, pcb->pcb_nsaved);
  85
  86         flushw();
  87         KASSERT(pcb->pcb_nsaved < MAXWIN,
  88             ("rwindow_save: pcb_nsaved > MAXWIN"));
  89         if ((i = pcb->pcb_nsaved) == 0)
  90                 return (0);
  91         ausp = pcb->pcb_rwsp;
  92         rw = pcb->pcb_rw;
  93         error = 0;
  94         do {
  95                 usp = *ausp;
  96                 CTR1(KTR_TRAP, "rwindow_save: usp=%#lx", usp);
  97                 usp += SPOFF;
  98                 if ((error = (usp & 0x7)) != 0)
  99                         break;
 100                 error = copyout(rw, (void *)usp, sizeof *rw);
 101                 if (error)
 102                         break;
 103                 ausp++;
 104                 rw++;
 105         } while (--i > 0);
 106         CTR1(KTR_TRAP, "rwindow_save: error=%d", error);
 107         if (error == 0)
 108                 pcb->pcb_nsaved = 0;
 109         return (error == 0 ? 0 : SIGILL);
 110 }