Commit | Line | Data |
---|---|---|
a676f083 MB |
1 | /* |
2 | * Register map access API - SPI support | |
3 | * | |
4 | * Copyright 2011 Wolfson Microelectronics plc | |
5 | * | |
6 | * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/regmap.h> | |
14 | #include <linux/spi/spi.h> | |
b5ddbf46 | 15 | #include <linux/module.h> |
a676f083 | 16 | |
e0356dfe MB |
17 | #include "internal.h" |
18 | ||
19 | struct regmap_async_spi { | |
20 | struct regmap_async core; | |
21 | struct spi_message m; | |
22 | struct spi_transfer t[2]; | |
23 | }; | |
24 | ||
25 | static void regmap_spi_complete(void *data) | |
26 | { | |
27 | struct regmap_async_spi *async = data; | |
28 | ||
29 | regmap_async_complete_cb(&async->core, async->m.status); | |
30 | } | |
31 | ||
0135bbcc | 32 | static int regmap_spi_write(void *context, const void *data, size_t count) |
a676f083 | 33 | { |
0135bbcc | 34 | struct device *dev = context; |
a676f083 MB |
35 | struct spi_device *spi = to_spi_device(dev); |
36 | ||
37 | return spi_write(spi, data, count); | |
38 | } | |
39 | ||
0135bbcc | 40 | static int regmap_spi_gather_write(void *context, |
a676f083 MB |
41 | const void *reg, size_t reg_len, |
42 | const void *val, size_t val_len) | |
43 | { | |
0135bbcc | 44 | struct device *dev = context; |
a676f083 MB |
45 | struct spi_device *spi = to_spi_device(dev); |
46 | struct spi_message m; | |
47 | struct spi_transfer t[2] = { { .tx_buf = reg, .len = reg_len, }, | |
48 | { .tx_buf = val, .len = val_len, }, }; | |
49 | ||
50 | spi_message_init(&m); | |
51 | spi_message_add_tail(&t[0], &m); | |
52 | spi_message_add_tail(&t[1], &m); | |
53 | ||
54 | return spi_sync(spi, &m); | |
55 | } | |
56 | ||
e0356dfe MB |
57 | static int regmap_spi_async_write(void *context, |
58 | const void *reg, size_t reg_len, | |
59 | const void *val, size_t val_len, | |
60 | struct regmap_async *a) | |
61 | { | |
62 | struct regmap_async_spi *async = container_of(a, | |
63 | struct regmap_async_spi, | |
64 | core); | |
65 | struct device *dev = context; | |
66 | struct spi_device *spi = to_spi_device(dev); | |
67 | ||
68 | async->t[0].tx_buf = reg; | |
69 | async->t[0].len = reg_len; | |
70 | async->t[1].tx_buf = val; | |
71 | async->t[1].len = val_len; | |
72 | ||
73 | spi_message_init(&async->m); | |
74 | spi_message_add_tail(&async->t[0], &async->m); | |
cd1b9dd0 MB |
75 | if (val) |
76 | spi_message_add_tail(&async->t[1], &async->m); | |
e0356dfe MB |
77 | |
78 | async->m.complete = regmap_spi_complete; | |
79 | async->m.context = async; | |
80 | ||
81 | return spi_async(spi, &async->m); | |
82 | } | |
83 | ||
84 | static struct regmap_async *regmap_spi_async_alloc(void) | |
85 | { | |
86 | struct regmap_async_spi *async_spi; | |
87 | ||
88 | async_spi = kzalloc(sizeof(*async_spi), GFP_KERNEL); | |
95601d65 MB |
89 | if (!async_spi) |
90 | return NULL; | |
e0356dfe MB |
91 | |
92 | return &async_spi->core; | |
93 | } | |
94 | ||
0135bbcc | 95 | static int regmap_spi_read(void *context, |
a676f083 MB |
96 | const void *reg, size_t reg_size, |
97 | void *val, size_t val_size) | |
98 | { | |
0135bbcc | 99 | struct device *dev = context; |
a676f083 MB |
100 | struct spi_device *spi = to_spi_device(dev); |
101 | ||
102 | return spi_write_then_read(spi, reg, reg_size, val, val_size); | |
103 | } | |
104 | ||
105 | static struct regmap_bus regmap_spi = { | |
a676f083 MB |
106 | .write = regmap_spi_write, |
107 | .gather_write = regmap_spi_gather_write, | |
e0356dfe MB |
108 | .async_write = regmap_spi_async_write, |
109 | .async_alloc = regmap_spi_async_alloc, | |
a676f083 | 110 | .read = regmap_spi_read, |
a676f083 MB |
111 | .read_flag_mask = 0x80, |
112 | }; | |
113 | ||
114 | /** | |
115 | * regmap_init_spi(): Initialise register map | |
116 | * | |
117 | * @spi: Device that will be interacted with | |
118 | * @config: Configuration for register map | |
119 | * | |
120 | * The return value will be an ERR_PTR() on error or a valid pointer to | |
121 | * a struct regmap. | |
122 | */ | |
123 | struct regmap *regmap_init_spi(struct spi_device *spi, | |
124 | const struct regmap_config *config) | |
125 | { | |
0135bbcc | 126 | return regmap_init(&spi->dev, ®map_spi, &spi->dev, config); |
a676f083 MB |
127 | } |
128 | EXPORT_SYMBOL_GPL(regmap_init_spi); | |
b33f9cbd | 129 | |
c0eb4676 MB |
130 | /** |
131 | * devm_regmap_init_spi(): Initialise register map | |
132 | * | |
133 | * @spi: Device that will be interacted with | |
134 | * @config: Configuration for register map | |
135 | * | |
136 | * The return value will be an ERR_PTR() on error or a valid pointer | |
137 | * to a struct regmap. The map will be automatically freed by the | |
138 | * device management code. | |
139 | */ | |
140 | struct regmap *devm_regmap_init_spi(struct spi_device *spi, | |
141 | const struct regmap_config *config) | |
142 | { | |
0135bbcc | 143 | return devm_regmap_init(&spi->dev, ®map_spi, &spi->dev, config); |
c0eb4676 MB |
144 | } |
145 | EXPORT_SYMBOL_GPL(devm_regmap_init_spi); | |
146 | ||
b33f9cbd | 147 | MODULE_LICENSE("GPL"); |