1 // Code for handling calls to "post" that are resume related.
3 // Copyright (C) 2008,2009 Kevin O'Connor <kevin@koconnor.net>
5 // This file may be distributed under the terms of the GNU LGPLv3 license.
7 #include "util.h" // dprintf
8 #include "ioport.h" // outb
9 #include "pic.h" // eoi_pic2
10 #include "biosvar.h" // struct bios_data_area_s
11 #include "bregs.h" // struct bregs
12 #include "acpi.h" // find_resume_vector
14 // Reset DMA controller
18 // first reset the DMA controllers
19 outb(0, PORT_DMA1_MASTER_CLEAR);
20 outb(0, PORT_DMA2_MASTER_CLEAR);
22 // then initialize the DMA controllers
23 outb(0xc0, PORT_DMA2_MODE_REG);
24 outb(0x00, PORT_DMA2_MASK_REG);
27 // Handler for post calls that look like a resume.
29 handle_resume(u8 status)
34 dprintf(1, "In resume (status=%d)\n", status);
38 if (CONFIG_S3_RESUME) {
39 // S3 resume request. Jump to 32bit mode to handle the resume.
45 : : "i"(BUILD_S3RESUME_STACK_ADDR), "r"(0)
53 // Normal post - now that status has been cleared a reset will
54 // run regular boot code..
59 // flush keyboard (issue EOI) and jump via 40h:0067h
63 #define BDA_JUMP (((struct bios_data_area_s *)0)->jump)
64 // resume execution by jump via 40h:0067h
68 : : "m"(BDA_JUMP), "r"(SEG_BDA)
73 // resume execution via IRET via 40h:0067h
78 : : "m"(BDA_JUMP), "r"(SEG_BDA)
83 // resume execution via RETF via 40h:0067h
88 : : "m"(BDA_JUMP), "r"(SEG_BDA)
93 panic("Unimplemented shutdown status: %02x\n", status);
100 if (!CONFIG_S3_RESUME)
101 panic("S3 resume support not compiled in.\n");
103 dprintf(1, "In 32bit resume\n");
107 s3_resume_vga_init();
109 make_bios_readonly();
111 u32 s3_resume_vector = find_resume_vector();
113 // Invoke the resume vector.
115 memset(&br, 0, sizeof(br));
116 if (s3_resume_vector) {
117 dprintf(1, "Jump to resume vector (%x)\n", s3_resume_vector);
118 br.code = FLATPTR_TO_SEGOFF((void*)s3_resume_vector);
120 dprintf(1, "No resume vector set!\n");
121 // Jump to the post vector to restart with a normal boot.
122 br.code = SEGOFF(SEG_BIOS, (u32)reset_vector - BUILD_BIOS_ADDR);