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
|
/* Copyright 2018 The ChromiumOS Authors
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
/* F75303 temperature sensor module for Chrome EC */
#include "common.h"
#include "console.h"
#include "f75303.h"
#include "hooks.h"
#include "i2c.h"
#include "math_util.h"
#include "util.h"
#ifdef CONFIG_ZEPHYR
#include "temp_sensor/temp_sensor.h"
#endif
#define F75303_RESOLUTION 11
#define F75303_SHIFT1 (16 - F75303_RESOLUTION)
#define F75303_SHIFT2 (F75303_RESOLUTION - 8)
static int temps[F75303_IDX_COUNT];
static int8_t fake_temp[F75303_IDX_COUNT];
/**
* Read 8 bits register from temp sensor.
*/
static int raw_read8(const int offset, int *data)
{
return i2c_read8(I2C_PORT_THERMAL, F75303_I2C_ADDR_FLAGS, offset, data);
}
static int get_temp(const int offset, int *temp)
{
int rv;
int temp_raw = 0;
rv = raw_read8(offset, &temp_raw);
if (rv != 0)
return rv;
*temp = C_TO_K(temp_raw);
return EC_SUCCESS;
}
int f75303_get_val(int idx, int *temp)
{
if (idx < 0 || F75303_IDX_COUNT <= idx)
return EC_ERROR_INVAL;
if (fake_temp[idx] != -1) {
*temp = C_TO_K(fake_temp[idx]);
return EC_SUCCESS;
}
*temp = temps[idx];
return EC_SUCCESS;
}
static inline int f75303_reg_to_mk(int16_t reg)
{
int temp_mc;
temp_mc = (((reg >> F75303_SHIFT1) * 1000) >> F75303_SHIFT2);
return MILLI_CELSIUS_TO_MILLI_KELVIN(temp_mc);
}
int f75303_get_val_k(int idx, int *temp_k_ptr)
{
if (idx >= F75303_IDX_COUNT)
return EC_ERROR_INVAL;
*temp_k_ptr = MILLI_KELVIN_TO_KELVIN(temps[idx]);
return EC_SUCCESS;
}
int f75303_get_val_mk(int idx, int *temp_mk_ptr)
{
if (idx >= F75303_IDX_COUNT)
return EC_ERROR_INVAL;
*temp_mk_ptr = temps[idx];
return EC_SUCCESS;
}
#ifndef CONFIG_ZEPHYR
static void f75303_sensor_poll(void)
{
get_temp(F75303_TEMP_LOCAL, &temps[F75303_IDX_LOCAL]);
get_temp(F75303_TEMP_REMOTE1, &temps[F75303_IDX_REMOTE1]);
get_temp(F75303_TEMP_REMOTE2, &temps[F75303_IDX_REMOTE2]);
}
DECLARE_HOOK(HOOK_SECOND, f75303_sensor_poll, HOOK_PRIO_TEMP_SENSOR);
#else
void f75303_update_temperature(int idx)
{
int temp_reg = 0;
if (idx >= F75303_IDX_COUNT)
return;
if (get_temp(idx, &temp_reg) == EC_SUCCESS)
temps[idx] = f75303_reg_to_mk(temp_reg);
}
#endif /* CONFIG_ZEPHYR */
static int f75303_set_fake_temp(int argc, const char **argv)
{
int index;
int value;
char *e;
if (argc != 3)
return EC_ERROR_PARAM_COUNT;
index = strtoi(argv[1], &e, 0);
if ((*e) || (index < 0) || (index >= F75303_IDX_COUNT))
return EC_ERROR_PARAM1;
if (!strcasecmp(argv[2], "off")) {
fake_temp[index] = -1;
ccprintf("Turn off fake temp mode for sensor %u.\n", index);
return EC_SUCCESS;
}
value = strtoi(argv[2], &e, 0);
if ((*e) || (value < 0) || (value > 100))
return EC_ERROR_PARAM2;
fake_temp[index] = value;
ccprintf("Force sensor %u = %uC.\n", index, value);
return EC_SUCCESS;
}
DECLARE_CONSOLE_COMMAND(f75303, f75303_set_fake_temp, "<index> <value>|off",
"Set fake temperature of sensor f75303.");
static void f75303_init(void)
{
int index;
for (index = 0; index < F75303_IDX_COUNT; index++)
fake_temp[index] = -1;
}
DECLARE_HOOK(HOOK_INIT, f75303_init, HOOK_PRIO_TEMP_SENSOR);
|
