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
|
// SPDX-License-Identifier: GPL-2.0-or-later
/*
* Copyright (C) 2007 Sascha Hauer, Pengutronix
* 2009 Marc Kleine-Budde <mkl@pengutronix.de>
* Copyright (C) 2010 Baruch Siach <baruch@tkos.co.il>
*/
#include <common.h>
#include <driver.h>
#include <xfuncs.h>
#include <errno.h>
#include <i2c/i2c.h>
#include <mfd/mc34704.h>
#define DRIVERNAME "mc34704"
#define to_mc34704(a) container_of(a, struct mc34704, cdev)
static struct mc34704 *mc34704_dev;
struct mc34704 *mc34704_get(void)
{
if (!mc34704_dev)
return NULL;
return mc34704_dev;
}
EXPORT_SYMBOL(mc34704_get);
int mc34704_reg_read(struct mc34704 *mc34704, u8 reg, u8 *val)
{
int ret;
ret = i2c_read_reg(mc34704->client, 1 << 7 | reg, val, 1);
return ret == 1 ? 0 : ret;
}
EXPORT_SYMBOL(mc34704_reg_read);
int mc34704_reg_write(struct mc34704 *mc34704, u8 reg, u8 val)
{
int ret;
ret = i2c_write_reg(mc34704->client, reg, &val, 1);
return ret == 1 ? 0 : ret;
}
EXPORT_SYMBOL(mc34704_reg_write);
static ssize_t mc34704_read(struct cdev *cdev, void *_buf, size_t count,
loff_t offset, ulong flags)
{
struct mc34704 *priv = to_mc34704(cdev);
u8 *buf = _buf;
size_t i = count;
int err;
while (i) {
err = mc34704_reg_read(priv, offset, buf);
if (err)
return (ssize_t)err;
buf++;
i--;
offset++;
}
return count;
}
static ssize_t mc34704_write(struct cdev *cdev, const void *_buf, size_t count,
loff_t offset, ulong flags)
{
struct mc34704 *mc34704 = to_mc34704(cdev);
const u8 *buf = _buf;
size_t i = count;
int err;
while (i) {
err = mc34704_reg_write(mc34704, offset, *buf);
if (err)
return (ssize_t)err;
buf++;
i--;
offset++;
}
return count;
}
static struct cdev_operations mc34704_fops = {
.read = mc34704_read,
.write = mc34704_write,
};
static int mc34704_probe(struct device *dev)
{
if (mc34704_dev)
return -EBUSY;
mc34704_dev = xzalloc(sizeof(struct mc34704));
mc34704_dev->cdev.name = DRIVERNAME;
mc34704_dev->client = to_i2c_client(dev);
mc34704_dev->cdev.size = 128;
mc34704_dev->cdev.dev = dev;
mc34704_dev->cdev.ops = &mc34704_fops;
devfs_create(&mc34704_dev->cdev);
return 0;
}
static __maybe_unused struct of_device_id mc34704_dt_ids[] = {
{ .compatible = "fsl,mc34704", },
{ }
};
MODULE_DEVICE_TABLE(of, mc34704_dt_ids);
static struct driver mc34704_driver = {
.name = DRIVERNAME,
.probe = mc34704_probe,
.of_compatible = DRV_OF_COMPAT(mc34704_dt_ids),
};
device_i2c_driver(mc34704_driver);
|