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
|
/* Copyright 2017 The ChromiumOS Authors
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
/* MCHP MEC fan control module. */
/* This assumes 2-pole fan. For each rotation, 5 edges are measured. */
#include "fan.h"
#include "registers.h"
#include "tfdp_chip.h"
#include "util.h"
/* Maximum fan driver setting value */
#define MAX_FAN_DRIVER_SETTING 0x3ff
/* Fan driver setting data in bit[15:6] of hardware register */
#define FAN_DRIVER_SETTING_SHIFT 6
/* Maximum tach reading/target value */
#define MAX_TACH 0x1fff
/* Tach target value for disable fan */
#define FAN_OFF_TACH 0xfff8
/*
* RPM = (n - 1) * m * f * 60 / poles / TACH
* n = number of edges = 5
* m = multiplier defined by RANGE = 2 in our case
* f = 32.768K
* poles = 2
*/
#define RPM_TO_TACH(rpm) MIN((7864320 / MAX((rpm), 1)), MAX_TACH)
#define TACH_TO_RPM(tach) (7864320 / MAX((tach), 1))
static int rpm_setting;
static int duty_setting;
static int in_rpm_mode = 1;
static void clear_status(void)
{
/* Clear DRIVE_FAIL, FAN_SPIN, and FAN_STALL bits */
MCHP_FAN_STATUS(0) = 0x23;
}
void fan_set_enabled(int ch, int enabled)
{
if (in_rpm_mode) {
if (enabled)
fan_set_rpm_target(ch, rpm_setting);
else
MCHP_FAN_TARGET(0) = FAN_OFF_TACH;
} else {
if (enabled)
fan_set_duty(ch, duty_setting);
else
MCHP_FAN_SETTING(0) = 0;
}
clear_status();
}
int fan_get_enabled(int ch)
{
if (in_rpm_mode)
return (MCHP_FAN_TARGET(0) & 0xff00) != 0xff00;
else
return !!MCHP_FAN_SETTING(0);
}
void fan_set_duty(int ch, int percent)
{
if (percent < 0)
percent = 0;
else if (percent > 100)
percent = 100;
duty_setting = percent;
MCHP_FAN_SETTING(0) = (percent * MAX_FAN_DRIVER_SETTING / 100)
<< FAN_DRIVER_SETTING_SHIFT;
clear_status();
}
int fan_get_duty(int ch)
{
duty_setting = (MCHP_FAN_SETTING(0) >> FAN_DRIVER_SETTING_SHIFT) * 100 /
MAX_FAN_DRIVER_SETTING;
return duty_setting;
}
int fan_get_rpm_mode(int ch)
{
return !!(MCHP_FAN_CFG1(0) & BIT(7));
}
void fan_set_rpm_mode(int ch, int rpm_mode)
{
if (rpm_mode)
MCHP_FAN_CFG1(0) |= BIT(7);
else
MCHP_FAN_CFG1(0) &= ~BIT(7);
clear_status();
}
int fan_get_rpm_actual(int ch)
{
if ((MCHP_FAN_READING(0) >> 8) == 0xff)
return 0;
else
return TACH_TO_RPM(MCHP_FAN_READING(0) >> 3);
}
int fan_get_rpm_target(int ch)
{
return rpm_setting;
}
void fan_set_rpm_target(int ch, int rpm)
{
rpm_setting = rpm;
MCHP_FAN_TARGET(0) = RPM_TO_TACH(rpm) << 3;
clear_status();
}
enum fan_status fan_get_status(int ch)
{
uint8_t sts = MCHP_FAN_STATUS(0);
if (sts & (BIT(5) | BIT(1)))
return FAN_STATUS_FRUSTRATED;
if (fan_get_rpm_actual(ch) == 0)
return FAN_STATUS_STOPPED;
return FAN_STATUS_LOCKED;
}
int fan_is_stalled(int ch)
{
uint8_t sts = MCHP_FAN_STATUS(0);
if (fan_get_rpm_actual(ch)) {
MCHP_FAN_STATUS(0) = 0x1;
return 0;
}
return sts & 0x1;
}
void fan_channel_setup(int ch, unsigned int flags)
{
/* Clear PCR sleep enable for RPM2FAN0 */
MCHP_PCR_SLP_DIS_DEV(MCHP_PCR_RPMPWM0);
/* Configure PWM Min drive */
MCHP_FAN_MIN_DRV(0) = 0x0A;
/*
* Fan configuration 1 register:
* 0x80 = bit 7 = RPM mode (0x00 if FAN_USE_RPM_MODE not set)
* 0x20 = bits 6:5 = min 1000 RPM, multiplier = 2
* 0x08 = bits 4:3 = 5 edges, 2 poles
* 0x03 = bits 2:0 = 400 ms update time
*
* Fan configuration 2 register:
* 0x00 = bit 7 = Ramp control disabled
* 0x00 = bit 6 = Glitch filter enabled
* 0x30 = bits 5:4 = Using both derivative options
* 0x04 = bits 3:2 = error range is 50 RPM
* 0x00 = bits 1 = normal polarity
* 0x00 = bit 0 = Reserved
*/
if (flags & FAN_USE_RPM_MODE)
MCHP_FAN_CFG1(0) = 0xab;
else
MCHP_FAN_CFG1(0) = 0x2b;
MCHP_FAN_CFG2(0) = 0x34;
clear_status();
}
|
