git.mutantstargoat.com Git - com32/blob - src/intr.c

   1 /*
   2 pcboot - bootable PC demo/game kernel
   3 Copyright (C) 2018  John Tsiombikas <nuclear@member.fsf.org>
   4
   5 This program is free software: you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation, either version 3 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful,
  11 but WITHOUT ANY WARRANTY, without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 GNU General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program.  If not, see <https://www.gnu.org/licenses/>.
  17 */
  18 #include <stdio.h>
  19 #include "config.h"
  20 #include "intr.h"
  21 #include "desc.h"
  22 #include "segm.h"
  23 #include "asmops.h"
  24 #include "panic.h"
  25
  26 #define SYSCALL_INT             0x80
  27
  28 /* IDT gate descriptor bits */
  29 #define GATE_TASK               (5 << 8)
  30 #define GATE_INTR               (6 << 8)
  31 #define GATE_TRAP               (7 << 8)
  32 #define GATE_DEFAULT    (1 << 11)
  33 #define GATE_PRESENT    (1 << 15)
  34
  35 /* PIC command and data ports */
  36 #define PIC1_CMD        0x20
  37 #define PIC1_DATA       0x21
  38 #define PIC2_CMD        0xa0
  39 #define PIC2_DATA       0xa1
  40
  41 /* PIC initialization command word 1 bits */
  42 #define ICW1_ICW4_NEEDED        (1 << 0)
  43 #define ICW1_SINGLE                     (1 << 1)
  44 #define ICW1_INTERVAL4          (1 << 2)
  45 #define ICW1_LEVEL                      (1 << 3)
  46 #define ICW1_INIT                       (1 << 4)
  47 /* PIC initialization command word 4 bits */
  48 #define ICW4_8086                       (1 << 0)
  49 #define ICW4_AUTO_EOI           (1 << 1)
  50 #define ICW4_BUF_SLAVE          (1 << 3) /* 1000 */
  51 #define ICW4_BUF_MASTER         (3 << 2) /* 1100 */
  52 #define ICW4_SPECIAL            (1 << 4)
  53
  54 /* PIC operation command word 2 bits */
  55 #define OCW2_EOI        (1 << 5)
  56
  57
  58 void init_pic(void);
  59 static void gate_desc(desc_t *desc, uint16_t sel, uint32_t addr, int dpl, int type);
  60
  61 /* defined in intr_asm.S */
  62 void set_idt(uint32_t addr, uint16_t limit);
  63 void intr_entry_default(void);
  64 void irq7_entry_check_spurious(void);
  65 void irq15_entry_check_spurious(void);
  66
  67 /* the IDT (interrupt descriptor table) */
  68 static desc_t idt[256] __attribute__((aligned(8)));
  69
  70 /* table of handler functions for all interrupts */
  71 static intr_func_t intr_func[256];
  72
  73 static struct intr_frame *cur_intr_frame;
  74 static int eoi_pending;
  75
  76 #define INTR_ENTRY_EC(n, name)          \
  77         void intr_entry_##name(void);   \
  78         set_intr_entry(n, intr_entry_##name);
  79 #define INTR_ENTRY_NOEC(n, name)        INTR_ENTRY_EC(n, name)
  80
  81 void init_intr(void)
  82 {
  83         int i;
  84
  85         set_idt((uint32_t)idt, sizeof idt - 1);
  86
  87         /* initialize all entry points and interrupt handlers */
  88         for(i=0; i<256; i++) {
  89                 set_intr_entry(i, intr_entry_default);
  90                 interrupt(i, 0);
  91         }
  92
  93         /* by including intrtab.h here the series of INTR_ENTRY_* macros will be
  94          * expanded to a series of function prototypes for all interrupt entry
  95          * points and the corresponding calls to set_intr_entry to set up the IDT
  96          * slots
  97          */
  98 #include "intrtab.h"
  99
 100         /* change irq7 and irq15 to special entry points which first
 101          * make sure we didn't get a spurious interrupt before proceeding
 102          */
 103         set_intr_entry(IRQ_TO_INTR(7), irq7_entry_check_spurious);
 104         set_intr_entry(IRQ_TO_INTR(15), irq15_entry_check_spurious);
 105
 106         /* initialize the programmable interrupt controller
 107          * setting up the maping of IRQs [0, 15] to interrupts [32, 47]
 108          */
 109         init_pic();
 110         eoi_pending = 0;
 111 }
 112
 113 /* retrieve the current interrupt frame.
 114  * returns 0 when called during init.
 115  */
 116 struct intr_frame *get_intr_frame(void)
 117 {
 118         return cur_intr_frame;
 119 }
 120
 121 /* set an interrupt handler function for a particular interrupt */
 122 void interrupt(int intr_num, intr_func_t func)
 123 {
 124         int iflag = get_intr_flag();
 125         disable_intr();
 126         intr_func[intr_num] = func;
 127         set_intr_flag(iflag);
 128 }
 129
 130 /* this function is called from all interrupt entry points
 131  * it calls the appropriate interrupt handlers if available and handles
 132  * sending an end-of-interrupt command to the PICs when finished.
 133  */
 134 void dispatch_intr(struct intr_frame frm)
 135 {
 136         cur_intr_frame = &frm;
 137
 138         if(IS_IRQ(frm.inum)) {
 139                 eoi_pending = frm.inum;
 140         }
 141
 142         if(intr_func[frm.inum]) {
 143                 intr_func[frm.inum](frm.inum);
 144         } else {
 145                 if(frm.inum < 32) {
 146                         panic("unhandled exception %d, error code: %d\n", frm.inum, frm.err);
 147                 }
 148                 printf("unhandled interrupt %d\n", frm.inum);
 149         }
 150
 151         disable_intr();
 152         if(eoi_pending) {
 153                 end_of_irq(INTR_TO_IRQ(eoi_pending));
 154         }
 155 }
 156
 157 void init_pic(void)
 158 {
 159         prog_pic(IRQ_OFFSET);
 160 }
 161
 162 void prog_pic(int offs)
 163 {
 164         /* send ICW1 saying we'll follow with ICW4 later on */
 165         outp(PIC1_CMD, ICW1_INIT | ICW1_ICW4_NEEDED);
 166         outp(PIC2_CMD, ICW1_INIT | ICW1_ICW4_NEEDED);
 167         /* send ICW2 with IRQ remapping */
 168         outp(PIC1_DATA, offs);
 169         outp(PIC2_DATA, offs + 8);
 170         /* send ICW3 to setup the master/slave relationship */
 171         /* ... set bit3 = 3rd interrupt input has a slave */
 172         outp(PIC1_DATA, 4);
 173         /* ... set slave ID to 2 */
 174         outp(PIC2_DATA, 2);
 175         /* send ICW4 to set 8086 mode (no calls generated) */
 176         outp(PIC1_DATA, ICW4_8086);
 177         outp(PIC2_DATA, ICW4_8086);
 178         /* done, just reset the data port to 0 */
 179         outp(PIC1_DATA, 0);
 180         outp(PIC2_DATA, 0);
 181 }
 182
 183 static void gate_desc(desc_t *desc, uint16_t sel, uint32_t addr, int dpl, int type)
 184 {
 185         /* first 16bit part is the low 16bits of the entry address */
 186         desc->d[0] = addr & 0xffff;
 187         /* second 16bit part is the segment selector for the entry code */
 188         desc->d[1] = sel;
 189         /* third 16bit part has the privilege level, type, and present bit */
 190         desc->d[2] = ((dpl & 3) << 13) | type | GATE_DEFAULT | GATE_PRESENT;
 191         /* last 16bit part is the high 16bits of the entry address */
 192         desc->d[3] = (addr & 0xffff0000) >> 16;
 193 }
 194
 195 #define IS_TRAP(n)      ((n) >= 32 && !IS_IRQ(n))
 196 void set_intr_entry(int num, void (*handler)(void))
 197 {
 198         int type = IS_TRAP(num) ? GATE_TRAP : GATE_INTR;
 199
 200         /* the syscall interrupt has to have a dpl of 3 otherwise calling it from
 201          * user space will raise a general protection exception. All the rest should
 202          * have a dpl of 0 to disallow user programs to execute critical interrupt
 203          * handlers and possibly crashing the system.
 204          */
 205         int dpl = (num == SYSCALL_INT) ? 3 : 0;
 206
 207         gate_desc(idt + num, selector(SEGM_KCODE, 0), (uint32_t)handler, dpl, type);
 208 }
 209
 210 void set_pic_mask(int pic, unsigned char mask)
 211 {
 212         outp(pic > 0 ? PIC2_DATA : PIC1_DATA, mask);
 213 }
 214
 215 unsigned char get_pic_mask(int pic)
 216 {
 217         return inp(pic > 0 ? PIC2_DATA : PIC1_DATA);
 218 }
 219
 220 void mask_irq(int irq)
 221 {
 222         int port;
 223         unsigned char mask;
 224
 225         if(irq < 8) {
 226                 port = PIC1_DATA;
 227         } else {
 228                 port = PIC2_DATA;
 229                 irq -= 8;
 230         }
 231
 232         mask = inp(port) | (1 << irq);
 233         outp(port, mask);
 234 }
 235
 236 void unmask_irq(int irq)
 237 {
 238         int port;
 239         unsigned char mask;
 240
 241         if(irq < 8) {
 242                 port = PIC1_DATA;
 243         } else {
 244                 port = PIC2_DATA;
 245                 irq -= 8;
 246         }
 247
 248         mask = inp(port) & ~(1 << irq);
 249         outp(port, mask);
 250 }
 251
 252
 253 void end_of_irq(int irq)
 254 {
 255         int intr_state = get_intr_flag();
 256         disable_intr();
 257
 258         if(!eoi_pending) {
 259                 set_intr_flag(intr_state);
 260                 return;
 261         }
 262         eoi_pending = 0;
 263
 264         if(irq > 7) {
 265                 outp(PIC2_CMD, OCW2_EOI);
 266         }
 267         outp(PIC1_CMD, OCW2_EOI);
 268
 269         set_intr_flag(intr_state);
 270 }
 271
 272 #ifdef ENABLE_GDB_STUB
 273 void exceptionHandler(int id, void (*func)())
 274 {
 275         set_intr_entry(id, func);
 276 }
 277 #endif