cp/guest/intercept.c

   1 /*
   2  * (C) Copyright 2007-2011  Josef 'Jeff' Sipek <jeffpc@josefsipek.net>
   3  *
   4  * This file is released under the GPLv2.  See the COPYING file for more
   5  * details.
   6  */
   7
   8 #include <directory.h>
   9 #include <sched.h>
  10 #include <dat.h>
  11 #include <shell.h>
  12
  13 static int handle_noop(struct virt_sys *sys)
  14 {
  15         return 0;
  16 }
  17
  18 static int handle_program(struct virt_sys *sys)
  19 {
  20         con_printf(sys->con, "INTRCPT: PROG\n");
  21         sys->cpu->state = GUEST_STOPPED;
  22         return 0;
  23 }
  24
  25 static int handle_instruction_and_program(struct virt_sys *sys)
  26 {
  27         con_printf(sys->con, "INTRCPT: INST+PROG\n");
  28         sys->cpu->state = GUEST_STOPPED;
  29         return 0;
  30 }
  31
  32 static int handle_ext_req(struct virt_sys *sys)
  33 {
  34         con_printf(sys->con, "INTRCPT: EXT REQ\n");
  35         sys->cpu->state = GUEST_STOPPED;
  36         return 0;
  37 }
  38
  39 static int handle_ext_int(struct virt_sys *sys)
  40 {
  41         con_printf(sys->con, "INTRCPT: EXT INT\n");
  42         sys->cpu->state = GUEST_STOPPED;
  43         return 0;
  44 }
  45
  46 static int handle_io_req(struct virt_sys *sys)
  47 {
  48         con_printf(sys->con, "INTRCPT: IO REQ\n");
  49         sys->cpu->state = GUEST_STOPPED;
  50         return 0;
  51 }
  52
  53 static int handle_wait(struct virt_sys *sys)
  54 {
  55         con_printf(sys->con, "INTRCPT: WAIT\n");
  56         return 0;
  57 }
  58
  59 static int handle_validity(struct virt_sys *sys)
  60 {
  61         con_printf(sys->con, "INTRCPT: VALIDITY\n");
  62         sys->cpu->state = GUEST_STOPPED;
  63         return 0;
  64 }
  65
  66 static int handle_stop(struct virt_sys *sys)
  67 {
  68         atomic_clear_mask(CPUSTAT_STOP_INT, &sys->cpu->sie_cb.cpuflags);
  69         return 0;
  70 }
  71
  72 static int handle_oper_except(struct virt_sys *sys)
  73 {
  74         con_printf(sys->con, "INTRCPT: OPER EXCEPT\n");
  75         sys->cpu->state = GUEST_STOPPED;
  76         return 0;
  77 }
  78
  79 static int handle_exp_run(struct virt_sys *sys)
  80 {
  81         con_printf(sys->con, "INTRCPT: EXP RUN\n");
  82         sys->cpu->state = GUEST_STOPPED;
  83         return 0;
  84 }
  85
  86 static int handle_exp_timer(struct virt_sys *sys)
  87 {
  88         con_printf(sys->con, "INTRCPT: EXP TIMER\n");
  89         sys->cpu->state = GUEST_STOPPED;
  90         return 0;
  91 }
  92
  93 static const intercept_handler_t intercept_funcs[0x4c >> 2] = {
  94         [0x00 >> 2] = handle_noop,
  95         [0x04 >> 2] = handle_instruction,
  96         [0x08 >> 2] = handle_program,
  97         [0x0c >> 2] = handle_instruction_and_program,
  98         [0x10 >> 2] = handle_ext_req,
  99         [0x14 >> 2] = handle_ext_int,
 100         [0x18 >> 2] = handle_io_req,
 101         [0x1c >> 2] = handle_wait,
 102         [0x20 >> 2] = handle_validity,
 103         [0x28 >> 2] = handle_stop,
 104         [0x2c >> 2] = handle_oper_except,
 105         [0x44 >> 2] = handle_exp_run,
 106         [0x48 >> 2] = handle_exp_timer,
 107 };
 108
 109 void handle_interception(struct virt_sys *sys)
 110 {
 111         struct virt_cpu *cpu = sys->cpu;
 112         intercept_handler_t h;
 113         int err = -EINVAL;
 114
 115         h = intercept_funcs[cpu->sie_cb.icptcode >> 2];
 116         if (h)
 117                 err = h(sys);
 118
 119         if (err) {
 120                 cpu->state = GUEST_STOPPED;
 121                 con_printf(sys->con, "Unknown/mis-handled intercept code %02x, err = %d\n",
 122                            cpu->sie_cb.icptcode, err);
 123         }
 124 }