5e0f6a98b009fbd16cb599679c8bd2f3618e7b42
[coreboot.git] / src / mainboard / lenovo / x60 / mainboard_smi.c
1 /*
2  * This file is part of the coreboot project.
3  *
4  * Copyright (C) 2008-2009 coresystems GmbH
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License as
8  * published by the Free Software Foundation; version 2 of
9  * the License.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
19  * MA 02110-1301 USA
20  */
21
22 #include <arch/io.h>
23 #include <arch/romcc_io.h>
24 #include <console/console.h>
25 #include <cpu/x86/smm.h>
26 #include "southbridge/intel/i82801gx/nvs.h"
27 #include <ec/acpi/ec.h>
28 #include "dock.h"
29 #include "smi.h"
30
31 /* The southbridge SMI handler checks whether gnvs has a
32  * valid pointer before calling the trap handler
33  */
34 extern global_nvs_t *gnvs;
35
36 static void mainboard_smm_init(void)
37 {
38         printk(BIOS_DEBUG, "initializing SMI\n");
39         /* Enable 0x1600/0x1600 register pair */
40         ec_set_bit(0x00, 0x05);
41         ec_set_ports(0x1604, 0x1600);
42 }
43
44 int mainboard_io_trap_handler(int smif)
45 {
46         static int smm_initialized;
47
48         if (!smm_initialized) {
49                 mainboard_smm_init();
50                 smm_initialized = 1;
51         }
52
53         switch (smif) {
54         case SMI_DOCK_CONNECT:
55                 dlpc_init();
56                 if (!dock_connect()) {
57                         /* set dock LED to indicate status */
58                         ec_write(0x0c, 0x88);
59                 } else {
60                         /* blink dock LED to indicate failure */
61                         ec_write(0x0c, 0xc8);
62                 }
63                 break;
64
65         case SMI_DOCK_DISCONNECT:
66                 dock_disconnect();
67                 ec_write(0x0c, 0x08);
68                 break;
69
70         default:
71                 return 1;
72         }
73
74         /* On success, the IO Trap Handler returns 0
75          * On failure, the IO Trap Handler returns a value != 0 */
76         return 0;
77 }
78