| // Code for handling calls to "post" that are resume related. |
| // |
| // Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net> |
| // |
| // This file may be distributed under the terms of the GNU GPLv3 license. |
| |
| #include "util.h" // dprintf |
| #include "ioport.h" // outb |
| #include "pic.h" // eoi_pic2 |
| #include "biosvar.h" // struct bios_data_area_s |
| |
| // Reset DMA controller |
| void |
| init_dma() |
| { |
| // first reset the DMA controllers |
| outb(0, PORT_DMA1_MASTER_CLEAR); |
| outb(0, PORT_DMA2_MASTER_CLEAR); |
| |
| // then initialize the DMA controllers |
| outb(0xc0, PORT_DMA2_MODE_REG); |
| outb(0x00, PORT_DMA2_MASK_REG); |
| } |
| |
| // Handler for post calls that look like a resume. |
| void VISIBLE16 |
| handle_resume(u8 status) |
| { |
| init_dma(); |
| |
| debug_serial_setup(); |
| dprintf(1, "In resume (status=%d)\n", status); |
| |
| switch (status) { |
| case 0x00: |
| case 0x09: |
| case 0x0d ... 0xff: |
| // Normal post - now that status has been cleared a reset will |
| // run regular boot code.. |
| reset_vector(); |
| break; |
| |
| case 0x05: |
| // flush keyboard (issue EOI) and jump via 40h:0067h |
| eoi_pic2(); |
| // NO BREAK |
| case 0x0a: |
| // resume execution by jump via 40h:0067h |
| #define bda ((struct bios_data_area_s *)0) |
| asm volatile( |
| "movw %%ax, %%ds\n" |
| "ljmpw *%0\n" |
| : : "m"(bda->jump_ip), "a"(SEG_BDA) |
| ); |
| break; |
| |
| case 0x0b: |
| // resume execution via IRET via 40h:0067h |
| asm volatile( |
| "movw %%ax, %%ds\n" |
| "movw %0, %%sp\n" |
| "movw %1, %%ss\n" |
| "iretw\n" |
| : : "m"(bda->jump_ip), "m"(bda->jump_cs), "a"(SEG_BDA) |
| ); |
| break; |
| |
| case 0x0c: |
| // resume execution via RETF via 40h:0067h |
| asm volatile( |
| "movw %%ax, %%ds\n" |
| "movw %0, %%sp\n" |
| "movw %1, %%ss\n" |
| "lretw\n" |
| : : "m"(bda->jump_ip), "m"(bda->jump_cs), "a"(SEG_BDA) |
| ); |
| break; |
| } |
| |
| BX_PANIC("Unimplemented shutdown status: %02x\n", status); |
| } |