sys/ia64/ia64/emulate.c

   1 /*-
   2  * Copyright (c) 2006 Marcel Moolenaar
   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  *
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <sys/param.h>
  31 #include <sys/systm.h>
  32 #include <sys/proc.h>
  33
  34 #include <machine/frame.h>
  35 #include <machine/md_var.h>
  36
  37 #include <ia64/disasm/disasm.h>
  38
  39 int
  40 ia64_emulate(struct trapframe *tf, struct thread *td)
  41 {
  42         struct asm_bundle bundle;
  43         struct asm_inst *i;
  44         int slot;
  45
  46         if (!asm_decode(tf->tf_special.iip, &bundle))
  47                 return (SIGILL);
  48
  49         slot = ((tf->tf_special.psr & IA64_PSR_RI) == IA64_PSR_RI_0) ? 0 :
  50             ((tf->tf_special.psr & IA64_PSR_RI) == IA64_PSR_RI_1) ? 1 : 2;
  51         if (slot == 1 && bundle.b_templ[slot] == 'L')
  52                 slot++;
  53
  54         i = bundle.b_inst + slot;
  55         switch (i->i_op) {
  56         case ASM_OP_BRL:
  57                 /*
  58                  * We get the fault even if the predicate is false, so we
  59                  * need to check the predicate first and simply advance to
  60                  * the next bundle in that case.
  61                  */
  62                 if (!(tf->tf_special.pr & (1UL << i->i_oper[0].o_value))) {
  63                         tf->tf_special.psr &= ~IA64_PSR_RI;
  64                         tf->tf_special.iip += 16;
  65                         return (0);
  66                 }
  67                 /*
  68                  * The brl.cond is the simplest form. We only have to set
  69                  * the IP to the address in the instruction and return.
  70                  */
  71                 if (i->i_cmpltr[0].c_type == ASM_CT_COND) {
  72                         tf->tf_special.psr &= ~IA64_PSR_RI;
  73                         tf->tf_special.iip += i->i_oper[1].o_value;
  74                         return (0);
  75                 }
  76                 /* Sanity check... */
  77                 if (i->i_cmpltr[0].c_type != ASM_CT_CALL)
  78                         break;
  79                 /*
  80                  * The brl.call is more difficult as we need to set-up the
  81                  * call properly.
  82                  */
  83                 break;
  84         default:
  85                 break;
  86         }
  87
  88         return (SIGILL);
  89 }