1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
|
/*
* This file is part of the coreboot project.
*
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; version 2 of
* the License.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <arch/io.h>
#include <console/console.h>
#include <device/device.h>
#include <delay.h>
#include "ec.h"
#include "chip.h"
static u16 ec_data_port;
static u16 ec_cmd_port;
#define KBD_IBF (1 << 1) /* 1: input buffer full (data ready for ec) */
#define KBD_OBF (1 << 0) /* 1: output buffer full (data ready for host) */
static void ec_setports(u16 data, u16 cmd)
{
ec_data_port = data;
ec_cmd_port = cmd;
}
static int send_kbd_command(u8 command)
{
int timeout;
timeout = 0x7ff;
while ((inb(ec_cmd_port) & KBD_IBF) && --timeout) {
udelay(10);
if ((timeout & 0xff) == 0)
printk(BIOS_SPEW, ".");
}
if (!timeout) {
printk(BIOS_DEBUG, "Timeout while sending command 0x%02x to EC!\n",
command);
return -1;
}
outb(command, ec_cmd_port);
return 0;
}
static int send_kbd_data(u8 data)
{
int timeout;
timeout = 0x7ff;
while ((inb(ec_cmd_port) & KBD_IBF) && --timeout) { /* wait for IBF = 0 */
udelay(10);
if ((timeout & 0xff) == 0)
printk(BIOS_SPEW, ".");
}
if (!timeout) {
printk(BIOS_DEBUG, "Timeout while sending data 0x%02x to EC!\n",
data);
return -1;
}
outb(data, ec_data_port);
return 0;
}
/*
* kbc1126_thermalinit: initialize fan control
* The code is found in EcThermalInit of the vendor firmware.
*/
static int kbc1126_thermalinit(u8 cmd, u8 value)
{
printk(BIOS_DEBUG, "KBC1126: initialize fan control.");
if (send_kbd_command(cmd) < 0)
return -1;
if (send_kbd_data(0x27) < 0)
return -1;
if (send_kbd_data(0x01) < 0)
return -1;
/*
* The following code is needed for fan control when AC is plugged in.
*/
if (send_kbd_command(cmd) < 0)
return -1;
if (send_kbd_data(0xd5) < 0)
return -1;
if (send_kbd_data(value) < 0)
return -1;
printk(BIOS_DEBUG, "KBC1126: fan control initialized.\n");
return 0;
}
/*
* kbc1126_kbdled: set CapsLock and NumLock LEDs
* This is used in MemoryErrorReport of the vendor firmware.
*/
static void kbc1126_kbdled(u8 cmd, u8 val)
{
if (send_kbd_command(cmd) < 0)
return;
if (send_kbd_data(0xf0) < 0)
return;
if (send_kbd_data(val) < 0)
return;
}
static void kbc1126_enable(struct device *dev)
{
struct ec_hp_kbc1126_config *conf = dev->chip_info;
ec_setports(conf->ec_data_port, conf->ec_cmd_port);
kbc1126_kbdled(conf->ec_ctrl_reg, 0);
if (kbc1126_thermalinit(conf->ec_ctrl_reg, conf->ec_fan_ctrl_value) < 0)
printk(BIOS_DEBUG, "KBC1126: error when initializing fan control.\n");
}
struct chip_operations ec_hp_kbc1126_ops = {
CHIP_NAME("SMSC KBC1126 for HP laptops")
.enable_dev = kbc1126_enable
};
|
