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
|
/* Copyright 2014 The ChromiumOS Authors
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*
* TI INA219/231 Current/Power monitor driver.
*/
#include "console.h"
#include "hooks.h"
#include "i2c.h"
#include "ina2xx.h"
#include "system.h"
#include "timer.h"
#include "util.h"
/* Console output macros */
#define CPRINTS(format, args...) cprints(CC_USBCHARGE, format, ##args)
/* I2C base address */
#define INA2XX_I2C_ADDR_FLAGS 0x40
uint16_t ina2xx_read(uint8_t idx, uint8_t reg)
{
int res;
int val;
res = i2c_read16(I2C_PORT_MASTER, INA2XX_I2C_ADDR_FLAGS | idx, reg,
&val);
if (res) {
CPRINTS("INA2XX I2C read failed");
return 0x0bad;
}
return (val >> 8) | ((val & 0xff) << 8);
}
int ina2xx_write(uint8_t idx, uint8_t reg, uint16_t val)
{
int res;
uint16_t be_val = (val >> 8) | ((val & 0xff) << 8);
res = i2c_write16(I2C_PORT_MASTER, INA2XX_I2C_ADDR_FLAGS | idx, reg,
be_val);
if (res)
CPRINTS("INA2XX I2C write failed");
return res;
}
int ina2xx_init(uint8_t idx, uint16_t config, uint16_t calib)
{
int res;
res = ina2xx_write(idx, INA2XX_REG_CONFIG, config);
/* TODO(crosbug.com/p/29730): assume 1mA/LSB, revisit later */
res |= ina2xx_write(idx, INA2XX_REG_CALIB, calib);
return res;
}
int ina2xx_get_voltage(uint8_t idx)
{
uint16_t bv = ina2xx_read(idx, INA2XX_REG_BUS_VOLT);
return INA2XX_BUS_MV((int)bv);
}
int ina2xx_get_current(uint8_t idx)
{
int16_t curr = ina2xx_read(idx, INA2XX_REG_CURRENT);
/* Current calibration: LSB = 1mA/bit */
return (int)curr;
}
int ina2xx_get_power(uint8_t idx)
{
uint16_t pow = ina2xx_read(idx, INA2XX_REG_POWER);
return INA2XX_POW_MW((int)pow);
}
int ina2xx_get_mask(uint8_t idx)
{
return ina2xx_read(idx, INA2XX_REG_MASK);
}
int ina2xx_set_mask(uint8_t idx, uint16_t mask)
{
return ina2xx_write(idx, INA2XX_REG_MASK, mask);
}
int ina2xx_get_alert(uint8_t idx)
{
return ina2xx_read(idx, INA2XX_REG_ALERT);
}
int ina2xx_set_alert(uint8_t idx, uint16_t alert)
{
return ina2xx_write(idx, INA2XX_REG_ALERT, alert);
}
#ifdef CONFIG_CMD_INA
static void ina2xx_dump(uint8_t idx)
{
uint16_t cfg = ina2xx_read(idx, INA2XX_REG_CONFIG);
int16_t sv = ina2xx_read(idx, INA2XX_REG_SHUNT_VOLT);
uint16_t bv = ina2xx_read(idx, INA2XX_REG_BUS_VOLT);
uint16_t pow = ina2xx_read(idx, INA2XX_REG_POWER);
int16_t curr = ina2xx_read(idx, INA2XX_REG_CURRENT);
uint16_t calib = ina2xx_read(idx, INA2XX_REG_CALIB);
uint16_t mask = ina2xx_read(idx, INA2XX_REG_MASK);
uint16_t alert = ina2xx_read(idx, INA2XX_REG_ALERT);
ccprintf("Configuration: %04x\n", cfg);
ccprintf("Shunt voltage: %04x => %d uV\n", sv,
INA2XX_SHUNT_UV((int)sv));
ccprintf("Bus voltage : %04x => %d mV\n", bv, INA2XX_BUS_MV((int)bv));
ccprintf("Power : %04x => %d mW\n", pow,
INA2XX_POW_MW((int)pow));
ccprintf("Current : %04x => %d mA\n", curr, curr);
ccprintf("Calibration : %04x\n", calib);
ccprintf("Mask/Enable : %04x\n", mask);
ccprintf("Alert limit : %04x\n", alert);
}
/*****************************************************************************/
/* Console commands */
static int command_ina(int argc, const char **argv)
{
char *e;
int idx;
uint16_t val;
if (argc < 2)
return EC_ERROR_PARAM_COUNT;
idx = strtoi(argv[1], &e, 10);
if (*e)
return EC_ERROR_PARAM1;
if (2 == argc) { /* dump all registers */
ina2xx_dump(idx);
return EC_SUCCESS;
} else if (4 == argc) {
val = strtoi(argv[3], &e, 16);
if (*e)
return EC_ERROR_PARAM3;
if (!strcasecmp(argv[2], "config")) {
ina2xx_write(idx, INA2XX_REG_CONFIG, val);
} else if (!strcasecmp(argv[2], "calib")) {
ina2xx_write(idx, INA2XX_REG_CALIB, val);
} else if (!strcasecmp(argv[2], "mask")) {
ina2xx_write(idx, INA2XX_REG_MASK, val);
} else if (!strcasecmp(argv[2], "alert")) {
ina2xx_write(idx, INA2XX_REG_ALERT, val);
} else { /* read one register */
ccprintf("Invalid register: %s\n", argv[1]);
return EC_ERROR_INVAL;
}
return EC_SUCCESS;
}
return EC_ERROR_INVAL;
}
DECLARE_CONSOLE_COMMAND(ina, command_ina,
"<index> [config|calib|mask|alert <val>]",
"INA2XX power/current sensing");
#endif
|
