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
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
|
/* Copyright 2013 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
/* LM4 fan control module. */
#include "clock.h"
#include "fan.h"
#include "gpio.h"
#include "hooks.h"
#include "registers.h"
#include "util.h"
/* Maximum RPM for fan controller */
#define MAX_RPM 0x1fff
/* Maximum PWM for PWM controller */
#define MAX_PWM 0x1ff
/*
* Scaling factor for requested/actual RPM for CPU fan. We need this because
* the fan controller on Blizzard filters tach pulses that are less than 64
* 15625Hz ticks apart, which works out to ~7000rpm on an unscaled fan. By
* telling the controller we actually have twice as many edges per revolution,
* the controller can handle fans that actually go twice as fast. See
* crosbug.com/p/7718.
*/
#define RPM_SCALE 2
void fan_set_enabled(int ch, int enabled)
{
if (enabled)
LM4_FAN_FANCTL |= BIT(ch);
else
LM4_FAN_FANCTL &= ~BIT(ch);
}
int fan_get_enabled(int ch)
{
return (LM4_FAN_FANCTL & BIT(ch)) ? 1 : 0;
}
void fan_set_duty(int ch, int percent)
{
int duty;
if (percent < 0)
percent = 0;
else if (percent > 100)
percent = 100;
duty = (MAX_PWM * percent + 50) / 100;
/* Always enable the channel */
fan_set_enabled(ch, 1);
/* Set the duty cycle */
LM4_FAN_FANCMD(ch) = duty << 16;
}
int fan_get_duty(int ch)
{
return ((LM4_FAN_FANCMD(ch) >> 16) * 100 + MAX_PWM / 2) / MAX_PWM;
}
int fan_get_rpm_mode(int ch)
{
return (LM4_FAN_FANCH(ch) & 0x0001) ? 0 : 1;
}
void fan_set_rpm_mode(int ch, int rpm_mode)
{
int was_enabled = fan_get_enabled(ch);
int was_rpm = fan_get_rpm_mode(ch);
if (!was_rpm && rpm_mode) {
/* Enable RPM control */
fan_set_enabled(ch, 0);
LM4_FAN_FANCH(ch) &= ~0x0001;
fan_set_enabled(ch, was_enabled);
} else if (was_rpm && !rpm_mode) {
/* Disable RPM mode */
fan_set_enabled(ch, 0);
LM4_FAN_FANCH(ch) |= 0x0001;
fan_set_enabled(ch, was_enabled);
}
}
int fan_get_rpm_actual(int ch)
{
return (LM4_FAN_FANCST(ch) & MAX_RPM) * RPM_SCALE;
}
int fan_get_rpm_target(int ch)
{
return (LM4_FAN_FANCMD(ch) & MAX_RPM) * RPM_SCALE;
}
test_mockable void fan_set_rpm_target(int ch, int rpm)
{
/* Apply fan scaling */
if (rpm > 0)
rpm /= RPM_SCALE;
/* Treat out-of-range requests as requests for maximum fan speed */
if (rpm < 0 || rpm > MAX_RPM)
rpm = MAX_RPM;
LM4_FAN_FANCMD(ch) = rpm;
}
/* The LM4 status is the original definition of enum fan_status */
enum fan_status fan_get_status(int ch)
{
return (LM4_FAN_FANSTS >> (2 * ch)) & 0x03;
}
/**
* Return non-zero if fan is enabled but stalled.
*/
int fan_is_stalled(int ch)
{
/* Must be enabled with non-zero target to stall */
if (!fan_get_enabled(ch) || fan_get_rpm_target(ch) == 0)
return 0;
/* Check for stall condition */
return fan_get_status(ch) == FAN_STATUS_STOPPED;
}
void fan_channel_setup(int ch, unsigned int flags)
{
uint32_t init;
if (flags & FAN_USE_RPM_MODE)
/*
* Configure automatic/feedback mode:
* 0x8000 = bit 15 = auto-restart
* 0x0000 = bit 14 = slow acceleration
* 0x0000 = bits 13:11 = no hysteresis
* 0x0000 = bits 10:8 = start period (2<<0) edges
* 0x0000 = bits 7:6 = no fast start
* 0x0020 = bits 5:4 = average 4 edges when
* calculating RPM
* 0x000c = bits 3:2 = 8 pulses per revolution
* (see note at top of file)
* 0x0000 = bit 0 = automatic control
*/
init = 0x802c;
else
/*
* Configure drive-only mode:
* 0x0000 = bit 15 = no auto-restart
* 0x0000 = bit 14 = slow acceleration
* 0x0000 = bits 13:11 = no hysteresis
* 0x0000 = bits 10:8 = start period (2<<0) edges
* 0x0000 = bits 7:6 = no fast start
* 0x0000 = bits 5:4 = no RPM averaging
* 0x0000 = bits 3:2 = 1 pulses per revolution
* 0x0001 = bit 0 = manual control
*/
init = 0x0001;
if (flags & FAN_USE_FAST_START)
/*
* Configure fast-start mode
* 0x0000 = bits 10:8 = start period (2<<0) edges
* 0x0040 = bits 7:6 = fast start at 50% duty
*/
init |= 0x0040;
LM4_FAN_FANCH(ch) = init;
}
static void fan_init(void)
{
#ifdef CONFIG_FAN_DSLEEP
/* Enable the fan module and delay a few clocks */
clock_enable_peripheral(CGC_OFFSET_FAN, 0x1, CGC_MODE_ALL);
#else
/* Enable the fan module and delay a few clocks */
clock_enable_peripheral(CGC_OFFSET_FAN, 0x1,
CGC_MODE_RUN | CGC_MODE_SLEEP);
#endif
/* Disable all fans */
LM4_FAN_FANCTL = 0;
}
/* Init before PWM */
DECLARE_HOOK(HOOK_INIT, fan_init, HOOK_PRIO_INIT_FAN);
|
