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
|
/*
* This file is part of the coreboot project.
*
* Copyright 2016 MediaTek Inc.
*
* 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 <device/device.h>
#include <device/i2c.h>
#include <stdint.h>
#if ENV_RAMSTAGE
/* Return I2C operations for a bus */
static inline const struct i2c_bus_operations *ops_i2c_bus(struct bus *bus)
{
if (bus && bus->dev && bus->dev->ops)
return bus->dev->ops->ops_i2c_bus;
return NULL;
}
int i2c_dev_find_bus(struct device *dev)
{
const struct i2c_bus_operations *ops;
struct bus *pbus;
if (!dev)
return -1;
/* Locate parent bus with I2C controller ops */
pbus = dev->bus;
while (pbus && pbus->dev && !ops_i2c_bus(pbus))
if (pbus->dev->bus != pbus)
pbus = pbus->dev->bus;
/* Check if this I2C controller ops implements dev_to_bus() */
ops = ops_i2c_bus(pbus);
if (!ops || !ops->dev_to_bus)
return -1;
/* Use controller ops to determine the bus number */
return ops->dev_to_bus(pbus->dev);
}
int i2c_dev_transfer(struct device *dev, struct i2c_seg *segments, int count)
{
int bus = i2c_dev_find_bus(dev);
if (bus < 0)
return -1;
return i2c_transfer(bus, segments, count);
}
int i2c_dev_readb(struct device *dev, uint8_t reg, uint8_t *data)
{
int bus = i2c_dev_find_bus(dev);
if (bus < 0)
return -1;
return i2c_readb(bus, dev->path.i2c.device, reg, data);
}
int i2c_dev_writeb(struct device *dev, uint8_t reg, uint8_t data)
{
int bus = i2c_dev_find_bus(dev);
if (bus < 0)
return -1;
return i2c_writeb(bus, dev->path.i2c.device, reg, data);
}
int i2c_dev_read_bytes(struct device *dev, uint8_t reg, uint8_t *data, int len)
{
int bus = i2c_dev_find_bus(dev);
if (bus < 0)
return -1;
return i2c_read_bytes(bus, dev->path.i2c.device, reg, data, len);
}
int i2c_dev_read_raw(struct device *dev, uint8_t *data, int len)
{
int bus = i2c_dev_find_bus(dev);
if (bus < 0)
return -1;
return i2c_read_raw(bus, dev->path.i2c.device, data, len);
}
int i2c_dev_write_raw(struct device *dev, uint8_t *data, int len)
{
int bus = i2c_dev_find_bus(dev);
if (bus < 0)
return -1;
return i2c_write_raw(bus, dev->path.i2c.device, data, len);
}
#endif
int i2c_read_field(unsigned bus, uint8_t chip, uint8_t reg, uint8_t *data,
uint8_t mask, uint8_t shift)
{
int ret;
uint8_t buf = 0;
ret = i2c_readb(bus, chip, reg, &buf);
buf &= (mask << shift);
*data = (buf >> shift);
return ret;
}
int i2c_write_field(unsigned bus, uint8_t chip, uint8_t reg, uint8_t data,
uint8_t mask, uint8_t shift)
{
int ret;
uint8_t buf = 0;
ret = i2c_readb(bus, chip, reg, &buf);
buf &= ~(mask << shift);
buf |= (data << shift);
ret |= i2c_writeb(bus, chip, reg, buf);
return ret;
}
|
