blob: 357294905793c840aea6826262bbab4dda2d3660 [file] [log] [blame]
Mark Brownb83a3132011-05-11 19:59:58 +02001/*
2 * Register map access API
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
Stephen Warrenf5d6eba2012-03-09 13:17:28 -070013#include <linux/device.h>
Mark Brownb83a3132011-05-11 19:59:58 +020014#include <linux/slab.h>
Paul Gortmaker19694b52012-02-28 19:28:02 -050015#include <linux/export.h>
Mark Brownb83a3132011-05-11 19:59:58 +020016#include <linux/mutex.h>
17#include <linux/err.h>
18
Mark Brownfb2736b2011-07-24 21:30:55 +010019#define CREATE_TRACE_POINTS
20#include <trace/events/regmap.h>
21
Mark Brown93de9122011-07-20 22:35:37 +010022#include "internal.h"
Mark Brownb83a3132011-05-11 19:59:58 +020023
Mark Brown8de2f082011-08-10 17:14:41 +090024bool regmap_writeable(struct regmap *map, unsigned int reg)
25{
26 if (map->max_register && reg > map->max_register)
27 return false;
28
29 if (map->writeable_reg)
30 return map->writeable_reg(map->dev, reg);
31
32 return true;
33}
34
35bool regmap_readable(struct regmap *map, unsigned int reg)
36{
37 if (map->max_register && reg > map->max_register)
38 return false;
39
Wolfram Sang4191f192012-01-30 15:08:16 +010040 if (map->format.format_write)
41 return false;
42
Mark Brown8de2f082011-08-10 17:14:41 +090043 if (map->readable_reg)
44 return map->readable_reg(map->dev, reg);
45
46 return true;
47}
48
49bool regmap_volatile(struct regmap *map, unsigned int reg)
50{
Wolfram Sang4191f192012-01-30 15:08:16 +010051 if (!regmap_readable(map, reg))
Mark Brown8de2f082011-08-10 17:14:41 +090052 return false;
53
54 if (map->volatile_reg)
55 return map->volatile_reg(map->dev, reg);
56
57 return true;
58}
59
60bool regmap_precious(struct regmap *map, unsigned int reg)
61{
Wolfram Sang4191f192012-01-30 15:08:16 +010062 if (!regmap_readable(map, reg))
Mark Brown8de2f082011-08-10 17:14:41 +090063 return false;
64
65 if (map->precious_reg)
66 return map->precious_reg(map->dev, reg);
67
68 return false;
69}
70
Lars-Peter Clausen82cd9962011-11-08 18:37:25 +010071static bool regmap_volatile_range(struct regmap *map, unsigned int reg,
72 unsigned int num)
73{
74 unsigned int i;
75
76 for (i = 0; i < num; i++)
77 if (!regmap_volatile(map, reg + i))
78 return false;
79
80 return true;
81}
82
Wolfram Sang9aa50752012-01-27 16:10:22 +010083static void regmap_format_2_6_write(struct regmap *map,
84 unsigned int reg, unsigned int val)
85{
86 u8 *out = map->work_buf;
87
88 *out = (reg << 6) | val;
89}
90
Mark Brownb83a3132011-05-11 19:59:58 +020091static void regmap_format_4_12_write(struct regmap *map,
92 unsigned int reg, unsigned int val)
93{
94 __be16 *out = map->work_buf;
95 *out = cpu_to_be16((reg << 12) | val);
96}
97
98static void regmap_format_7_9_write(struct regmap *map,
99 unsigned int reg, unsigned int val)
100{
101 __be16 *out = map->work_buf;
102 *out = cpu_to_be16((reg << 9) | val);
103}
104
Lars-Peter Clausen7e5ec632011-11-16 16:28:21 +0100105static void regmap_format_10_14_write(struct regmap *map,
106 unsigned int reg, unsigned int val)
107{
108 u8 *out = map->work_buf;
109
110 out[2] = val;
111 out[1] = (val >> 8) | (reg << 6);
112 out[0] = reg >> 2;
113}
114
Marc Reillyd939fb92012-03-16 12:11:43 +1100115static void regmap_format_8(void *buf, unsigned int val, unsigned int shift)
Mark Brownb83a3132011-05-11 19:59:58 +0200116{
117 u8 *b = buf;
118
Marc Reillyd939fb92012-03-16 12:11:43 +1100119 b[0] = val << shift;
Mark Brownb83a3132011-05-11 19:59:58 +0200120}
121
Marc Reillyd939fb92012-03-16 12:11:43 +1100122static void regmap_format_16(void *buf, unsigned int val, unsigned int shift)
Mark Brownb83a3132011-05-11 19:59:58 +0200123{
124 __be16 *b = buf;
125
Marc Reillyd939fb92012-03-16 12:11:43 +1100126 b[0] = cpu_to_be16(val << shift);
Mark Brownb83a3132011-05-11 19:59:58 +0200127}
128
Marc Reillyd939fb92012-03-16 12:11:43 +1100129static void regmap_format_24(void *buf, unsigned int val, unsigned int shift)
Marc Reillyea279fc2012-03-16 12:11:42 +1100130{
131 u8 *b = buf;
132
Marc Reillyd939fb92012-03-16 12:11:43 +1100133 val <<= shift;
134
Marc Reillyea279fc2012-03-16 12:11:42 +1100135 b[0] = val >> 16;
136 b[1] = val >> 8;
137 b[2] = val;
138}
139
Marc Reillyd939fb92012-03-16 12:11:43 +1100140static void regmap_format_32(void *buf, unsigned int val, unsigned int shift)
Mark Brown7d5e5252012-02-17 15:58:25 -0800141{
142 __be32 *b = buf;
143
Marc Reillyd939fb92012-03-16 12:11:43 +1100144 b[0] = cpu_to_be32(val << shift);
Mark Brown7d5e5252012-02-17 15:58:25 -0800145}
146
Mark Brownb83a3132011-05-11 19:59:58 +0200147static unsigned int regmap_parse_8(void *buf)
148{
149 u8 *b = buf;
150
151 return b[0];
152}
153
154static unsigned int regmap_parse_16(void *buf)
155{
156 __be16 *b = buf;
157
158 b[0] = be16_to_cpu(b[0]);
159
160 return b[0];
161}
162
Marc Reillyea279fc2012-03-16 12:11:42 +1100163static unsigned int regmap_parse_24(void *buf)
164{
165 u8 *b = buf;
166 unsigned int ret = b[2];
167 ret |= ((unsigned int)b[1]) << 8;
168 ret |= ((unsigned int)b[0]) << 16;
169
170 return ret;
171}
172
Mark Brown7d5e5252012-02-17 15:58:25 -0800173static unsigned int regmap_parse_32(void *buf)
174{
175 __be32 *b = buf;
176
177 b[0] = be32_to_cpu(b[0]);
178
179 return b[0];
180}
181
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600182static void regmap_lock_mutex(struct regmap *map)
183{
184 mutex_lock(&map->mutex);
185}
186
187static void regmap_unlock_mutex(struct regmap *map)
188{
189 mutex_unlock(&map->mutex);
190}
191
192static void regmap_lock_spinlock(struct regmap *map)
193{
194 spin_lock(&map->spinlock);
195}
196
197static void regmap_unlock_spinlock(struct regmap *map)
198{
199 spin_unlock(&map->spinlock);
200}
201
Mark Brownb83a3132011-05-11 19:59:58 +0200202/**
203 * regmap_init(): Initialise register map
204 *
205 * @dev: Device that will be interacted with
206 * @bus: Bus-specific callbacks to use with device
Stephen Warren0135bbc2012-04-04 15:48:30 -0600207 * @bus_context: Data passed to bus-specific callbacks
Mark Brownb83a3132011-05-11 19:59:58 +0200208 * @config: Configuration for register map
209 *
210 * The return value will be an ERR_PTR() on error or a valid pointer to
211 * a struct regmap. This function should generally not be called
212 * directly, it should be called by bus-specific init functions.
213 */
214struct regmap *regmap_init(struct device *dev,
215 const struct regmap_bus *bus,
Stephen Warren0135bbc2012-04-04 15:48:30 -0600216 void *bus_context,
Mark Brownb83a3132011-05-11 19:59:58 +0200217 const struct regmap_config *config)
218{
219 struct regmap *map;
220 int ret = -EINVAL;
221
222 if (!bus || !config)
Lars-Peter Clausenabbb18f2011-11-14 10:40:15 +0100223 goto err;
Mark Brownb83a3132011-05-11 19:59:58 +0200224
225 map = kzalloc(sizeof(*map), GFP_KERNEL);
226 if (map == NULL) {
227 ret = -ENOMEM;
228 goto err;
229 }
230
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600231 if (bus->fast_io) {
232 spin_lock_init(&map->spinlock);
233 map->lock = regmap_lock_spinlock;
234 map->unlock = regmap_unlock_spinlock;
235 } else {
236 mutex_init(&map->mutex);
237 map->lock = regmap_lock_mutex;
238 map->unlock = regmap_unlock_mutex;
239 }
Mark Brownb83a3132011-05-11 19:59:58 +0200240 map->format.buf_size = (config->reg_bits + config->val_bits) / 8;
Wolfram Sangc212acc2012-01-28 02:16:41 +0100241 map->format.reg_bytes = DIV_ROUND_UP(config->reg_bits, 8);
Mark Brown82159ba2012-01-18 10:52:25 +0000242 map->format.pad_bytes = config->pad_bits / 8;
Wolfram Sangc212acc2012-01-28 02:16:41 +0100243 map->format.val_bytes = DIV_ROUND_UP(config->val_bits, 8);
Mark Brown82159ba2012-01-18 10:52:25 +0000244 map->format.buf_size += map->format.pad_bytes;
Marc Reillyd939fb92012-03-16 12:11:43 +1100245 map->reg_shift = config->pad_bits % 8;
Stephen Warrenf01ee602012-04-09 13:40:24 -0600246 if (config->reg_stride)
247 map->reg_stride = config->reg_stride;
248 else
249 map->reg_stride = 1;
Ashish Jangam2e33caf2012-04-30 23:23:40 +0100250 map->use_single_rw = config->use_single_rw;
Mark Brownb83a3132011-05-11 19:59:58 +0200251 map->dev = dev;
252 map->bus = bus;
Stephen Warren0135bbc2012-04-04 15:48:30 -0600253 map->bus_context = bus_context;
Mark Brown2e2ae662011-07-20 22:33:39 +0100254 map->max_register = config->max_register;
255 map->writeable_reg = config->writeable_reg;
256 map->readable_reg = config->readable_reg;
257 map->volatile_reg = config->volatile_reg;
Mark Brown2efe1642011-08-08 15:41:46 +0900258 map->precious_reg = config->precious_reg;
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100259 map->cache_type = config->cache_type;
Mark Brownb83a3132011-05-11 19:59:58 +0200260
Lars-Peter Clausen6f306442011-09-05 20:46:32 +0200261 if (config->read_flag_mask || config->write_flag_mask) {
262 map->read_flag_mask = config->read_flag_mask;
263 map->write_flag_mask = config->write_flag_mask;
264 } else {
265 map->read_flag_mask = bus->read_flag_mask;
266 }
267
Marc Reillyd939fb92012-03-16 12:11:43 +1100268 switch (config->reg_bits + map->reg_shift) {
Wolfram Sang9aa50752012-01-27 16:10:22 +0100269 case 2:
270 switch (config->val_bits) {
271 case 6:
272 map->format.format_write = regmap_format_2_6_write;
273 break;
274 default:
275 goto err_map;
276 }
277 break;
278
Mark Brownb83a3132011-05-11 19:59:58 +0200279 case 4:
280 switch (config->val_bits) {
281 case 12:
282 map->format.format_write = regmap_format_4_12_write;
283 break;
284 default:
285 goto err_map;
286 }
287 break;
288
289 case 7:
290 switch (config->val_bits) {
291 case 9:
292 map->format.format_write = regmap_format_7_9_write;
293 break;
294 default:
295 goto err_map;
296 }
297 break;
298
Lars-Peter Clausen7e5ec632011-11-16 16:28:21 +0100299 case 10:
300 switch (config->val_bits) {
301 case 14:
302 map->format.format_write = regmap_format_10_14_write;
303 break;
304 default:
305 goto err_map;
306 }
307 break;
308
Mark Brownb83a3132011-05-11 19:59:58 +0200309 case 8:
310 map->format.format_reg = regmap_format_8;
311 break;
312
313 case 16:
314 map->format.format_reg = regmap_format_16;
315 break;
316
Mark Brown7d5e5252012-02-17 15:58:25 -0800317 case 32:
318 map->format.format_reg = regmap_format_32;
319 break;
320
Mark Brownb83a3132011-05-11 19:59:58 +0200321 default:
322 goto err_map;
323 }
324
325 switch (config->val_bits) {
326 case 8:
327 map->format.format_val = regmap_format_8;
328 map->format.parse_val = regmap_parse_8;
329 break;
330 case 16:
331 map->format.format_val = regmap_format_16;
332 map->format.parse_val = regmap_parse_16;
333 break;
Marc Reillyea279fc2012-03-16 12:11:42 +1100334 case 24:
335 map->format.format_val = regmap_format_24;
336 map->format.parse_val = regmap_parse_24;
337 break;
Mark Brown7d5e5252012-02-17 15:58:25 -0800338 case 32:
339 map->format.format_val = regmap_format_32;
340 map->format.parse_val = regmap_parse_32;
341 break;
Mark Brownb83a3132011-05-11 19:59:58 +0200342 }
343
Mark Brown7a647612012-04-30 23:26:32 +0100344 if (map->format.format_write)
345 map->use_single_rw = true;
346
Mark Brownb83a3132011-05-11 19:59:58 +0200347 if (!map->format.format_write &&
348 !(map->format.format_reg && map->format.format_val))
349 goto err_map;
350
Mark Brown82159ba2012-01-18 10:52:25 +0000351 map->work_buf = kzalloc(map->format.buf_size, GFP_KERNEL);
Mark Brownb83a3132011-05-11 19:59:58 +0200352 if (map->work_buf == NULL) {
353 ret = -ENOMEM;
Mark Brown5204f5e2011-09-05 08:07:47 -0700354 goto err_map;
Mark Brownb83a3132011-05-11 19:59:58 +0200355 }
356
Stephen Warrend3c242e2012-04-04 15:48:29 -0600357 regmap_debugfs_init(map, config->name);
Mark Brown052d2cd2011-11-21 19:05:13 +0000358
Lars-Peter Clausene5e3b8a2011-11-16 16:28:16 +0100359 ret = regcache_init(map, config);
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100360 if (ret < 0)
Lars-Peter Clausen58072cb2011-11-10 18:15:15 +0100361 goto err_free_workbuf;
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100362
Mark Brownb83a3132011-05-11 19:59:58 +0200363 return map;
364
Lars-Peter Clausen58072cb2011-11-10 18:15:15 +0100365err_free_workbuf:
366 kfree(map->work_buf);
Mark Brownb83a3132011-05-11 19:59:58 +0200367err_map:
368 kfree(map);
369err:
370 return ERR_PTR(ret);
371}
372EXPORT_SYMBOL_GPL(regmap_init);
373
Mark Brownc0eb4672012-01-30 19:56:52 +0000374static void devm_regmap_release(struct device *dev, void *res)
375{
376 regmap_exit(*(struct regmap **)res);
377}
378
379/**
380 * devm_regmap_init(): Initialise managed register map
381 *
382 * @dev: Device that will be interacted with
383 * @bus: Bus-specific callbacks to use with device
Stephen Warren0135bbc2012-04-04 15:48:30 -0600384 * @bus_context: Data passed to bus-specific callbacks
Mark Brownc0eb4672012-01-30 19:56:52 +0000385 * @config: Configuration for register map
386 *
387 * The return value will be an ERR_PTR() on error or a valid pointer
388 * to a struct regmap. This function should generally not be called
389 * directly, it should be called by bus-specific init functions. The
390 * map will be automatically freed by the device management code.
391 */
392struct regmap *devm_regmap_init(struct device *dev,
393 const struct regmap_bus *bus,
Stephen Warren0135bbc2012-04-04 15:48:30 -0600394 void *bus_context,
Mark Brownc0eb4672012-01-30 19:56:52 +0000395 const struct regmap_config *config)
396{
397 struct regmap **ptr, *regmap;
398
399 ptr = devres_alloc(devm_regmap_release, sizeof(*ptr), GFP_KERNEL);
400 if (!ptr)
401 return ERR_PTR(-ENOMEM);
402
Stephen Warren0135bbc2012-04-04 15:48:30 -0600403 regmap = regmap_init(dev, bus, bus_context, config);
Mark Brownc0eb4672012-01-30 19:56:52 +0000404 if (!IS_ERR(regmap)) {
405 *ptr = regmap;
406 devres_add(dev, ptr);
407 } else {
408 devres_free(ptr);
409 }
410
411 return regmap;
412}
413EXPORT_SYMBOL_GPL(devm_regmap_init);
414
Mark Brownb83a3132011-05-11 19:59:58 +0200415/**
Mark Brownbf315172011-12-03 17:06:20 +0000416 * regmap_reinit_cache(): Reinitialise the current register cache
417 *
418 * @map: Register map to operate on.
419 * @config: New configuration. Only the cache data will be used.
420 *
421 * Discard any existing register cache for the map and initialize a
422 * new cache. This can be used to restore the cache to defaults or to
423 * update the cache configuration to reflect runtime discovery of the
424 * hardware.
425 */
426int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
427{
428 int ret;
429
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600430 map->lock(map);
Mark Brownbf315172011-12-03 17:06:20 +0000431
432 regcache_exit(map);
Mark Browna24f64a2012-01-26 18:30:16 +0000433 regmap_debugfs_exit(map);
Mark Brownbf315172011-12-03 17:06:20 +0000434
435 map->max_register = config->max_register;
436 map->writeable_reg = config->writeable_reg;
437 map->readable_reg = config->readable_reg;
438 map->volatile_reg = config->volatile_reg;
439 map->precious_reg = config->precious_reg;
440 map->cache_type = config->cache_type;
441
Stephen Warrend3c242e2012-04-04 15:48:29 -0600442 regmap_debugfs_init(map, config->name);
Mark Browna24f64a2012-01-26 18:30:16 +0000443
Mark Brown421e8d22012-01-20 13:39:37 +0000444 map->cache_bypass = false;
445 map->cache_only = false;
446
Mark Brownbf315172011-12-03 17:06:20 +0000447 ret = regcache_init(map, config);
448
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600449 map->unlock(map);
Mark Brownbf315172011-12-03 17:06:20 +0000450
451 return ret;
452}
453
454/**
Mark Brownb83a3132011-05-11 19:59:58 +0200455 * regmap_exit(): Free a previously allocated register map
456 */
457void regmap_exit(struct regmap *map)
458{
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100459 regcache_exit(map);
Mark Brown31244e32011-07-20 22:56:53 +0100460 regmap_debugfs_exit(map);
Stephen Warren0135bbc2012-04-04 15:48:30 -0600461 if (map->bus->free_context)
462 map->bus->free_context(map->bus_context);
Mark Brownb83a3132011-05-11 19:59:58 +0200463 kfree(map->work_buf);
Mark Brownb83a3132011-05-11 19:59:58 +0200464 kfree(map);
465}
466EXPORT_SYMBOL_GPL(regmap_exit);
467
468static int _regmap_raw_write(struct regmap *map, unsigned int reg,
469 const void *val, size_t val_len)
470{
Lars-Peter Clausen6f306442011-09-05 20:46:32 +0200471 u8 *u8 = map->work_buf;
Mark Brownb83a3132011-05-11 19:59:58 +0200472 void *buf;
473 int ret = -ENOTSUPP;
474 size_t len;
Mark Brown73304782011-07-24 11:46:20 +0100475 int i;
476
477 /* Check for unwritable registers before we start */
478 if (map->writeable_reg)
479 for (i = 0; i < val_len / map->format.val_bytes; i++)
Stephen Warrenf01ee602012-04-09 13:40:24 -0600480 if (!map->writeable_reg(map->dev,
481 reg + (i * map->reg_stride)))
Mark Brown73304782011-07-24 11:46:20 +0100482 return -EINVAL;
Mark Brownb83a3132011-05-11 19:59:58 +0200483
Laxman Dewanganc9157192012-02-10 21:30:27 +0530484 if (!map->cache_bypass && map->format.parse_val) {
485 unsigned int ival;
486 int val_bytes = map->format.val_bytes;
487 for (i = 0; i < val_len / val_bytes; i++) {
488 memcpy(map->work_buf, val + (i * val_bytes), val_bytes);
489 ival = map->format.parse_val(map->work_buf);
Stephen Warrenf01ee602012-04-09 13:40:24 -0600490 ret = regcache_write(map, reg + (i * map->reg_stride),
491 ival);
Laxman Dewanganc9157192012-02-10 21:30:27 +0530492 if (ret) {
493 dev_err(map->dev,
494 "Error in caching of register: %u ret: %d\n",
495 reg + i, ret);
496 return ret;
497 }
498 }
499 if (map->cache_only) {
500 map->cache_dirty = true;
501 return 0;
502 }
503 }
504
Marc Reillyd939fb92012-03-16 12:11:43 +1100505 map->format.format_reg(map->work_buf, reg, map->reg_shift);
Mark Brownb83a3132011-05-11 19:59:58 +0200506
Lars-Peter Clausen6f306442011-09-05 20:46:32 +0200507 u8[0] |= map->write_flag_mask;
508
Mark Brownfb2736b2011-07-24 21:30:55 +0100509 trace_regmap_hw_write_start(map->dev, reg,
510 val_len / map->format.val_bytes);
511
Mark Brown2547e202011-07-20 21:47:22 +0100512 /* If we're doing a single register write we can probably just
513 * send the work_buf directly, otherwise try to do a gather
514 * write.
515 */
Mark Brown82159ba2012-01-18 10:52:25 +0000516 if (val == (map->work_buf + map->format.pad_bytes +
517 map->format.reg_bytes))
Stephen Warren0135bbc2012-04-04 15:48:30 -0600518 ret = map->bus->write(map->bus_context, map->work_buf,
Mark Brown82159ba2012-01-18 10:52:25 +0000519 map->format.reg_bytes +
520 map->format.pad_bytes +
521 val_len);
Mark Brown2547e202011-07-20 21:47:22 +0100522 else if (map->bus->gather_write)
Stephen Warren0135bbc2012-04-04 15:48:30 -0600523 ret = map->bus->gather_write(map->bus_context, map->work_buf,
Mark Brown82159ba2012-01-18 10:52:25 +0000524 map->format.reg_bytes +
525 map->format.pad_bytes,
Mark Brownb83a3132011-05-11 19:59:58 +0200526 val, val_len);
527
Mark Brown2547e202011-07-20 21:47:22 +0100528 /* If that didn't work fall back on linearising by hand. */
Mark Brownb83a3132011-05-11 19:59:58 +0200529 if (ret == -ENOTSUPP) {
Mark Brown82159ba2012-01-18 10:52:25 +0000530 len = map->format.reg_bytes + map->format.pad_bytes + val_len;
531 buf = kzalloc(len, GFP_KERNEL);
Mark Brownb83a3132011-05-11 19:59:58 +0200532 if (!buf)
533 return -ENOMEM;
534
535 memcpy(buf, map->work_buf, map->format.reg_bytes);
Mark Brown82159ba2012-01-18 10:52:25 +0000536 memcpy(buf + map->format.reg_bytes + map->format.pad_bytes,
537 val, val_len);
Stephen Warren0135bbc2012-04-04 15:48:30 -0600538 ret = map->bus->write(map->bus_context, buf, len);
Mark Brownb83a3132011-05-11 19:59:58 +0200539
540 kfree(buf);
541 }
542
Mark Brownfb2736b2011-07-24 21:30:55 +0100543 trace_regmap_hw_write_done(map->dev, reg,
544 val_len / map->format.val_bytes);
545
Mark Brownb83a3132011-05-11 19:59:58 +0200546 return ret;
547}
548
Dimitris Papastamos4d2dc092011-09-29 10:39:07 +0100549int _regmap_write(struct regmap *map, unsigned int reg,
550 unsigned int val)
Mark Brownb83a3132011-05-11 19:59:58 +0200551{
Mark Brownfb2736b2011-07-24 21:30:55 +0100552 int ret;
Mark Brownb83a3132011-05-11 19:59:58 +0200553 BUG_ON(!map->format.format_write && !map->format.format_val);
554
Laxman Dewanganc9157192012-02-10 21:30:27 +0530555 if (!map->cache_bypass && map->format.format_write) {
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100556 ret = regcache_write(map, reg, val);
557 if (ret != 0)
558 return ret;
Mark Brown8ae0d7e2011-10-26 10:34:22 +0200559 if (map->cache_only) {
560 map->cache_dirty = true;
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100561 return 0;
Mark Brown8ae0d7e2011-10-26 10:34:22 +0200562 }
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100563 }
564
Mark Brownfb2736b2011-07-24 21:30:55 +0100565 trace_regmap_reg_write(map->dev, reg, val);
566
Mark Brownb83a3132011-05-11 19:59:58 +0200567 if (map->format.format_write) {
568 map->format.format_write(map, reg, val);
569
Mark Brownfb2736b2011-07-24 21:30:55 +0100570 trace_regmap_hw_write_start(map->dev, reg, 1);
571
Stephen Warren0135bbc2012-04-04 15:48:30 -0600572 ret = map->bus->write(map->bus_context, map->work_buf,
Mark Brownfb2736b2011-07-24 21:30:55 +0100573 map->format.buf_size);
574
575 trace_regmap_hw_write_done(map->dev, reg, 1);
576
577 return ret;
Mark Brownb83a3132011-05-11 19:59:58 +0200578 } else {
Mark Brown82159ba2012-01-18 10:52:25 +0000579 map->format.format_val(map->work_buf + map->format.reg_bytes
Marc Reillyd939fb92012-03-16 12:11:43 +1100580 + map->format.pad_bytes, val, 0);
Mark Brownb83a3132011-05-11 19:59:58 +0200581 return _regmap_raw_write(map, reg,
Mark Brown82159ba2012-01-18 10:52:25 +0000582 map->work_buf +
583 map->format.reg_bytes +
584 map->format.pad_bytes,
Mark Brownb83a3132011-05-11 19:59:58 +0200585 map->format.val_bytes);
586 }
587}
588
589/**
590 * regmap_write(): Write a value to a single register
591 *
592 * @map: Register map to write to
593 * @reg: Register to write to
594 * @val: Value to be written
595 *
596 * A value of zero will be returned on success, a negative errno will
597 * be returned in error cases.
598 */
599int regmap_write(struct regmap *map, unsigned int reg, unsigned int val)
600{
601 int ret;
602
Stephen Warrenf01ee602012-04-09 13:40:24 -0600603 if (reg % map->reg_stride)
604 return -EINVAL;
605
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600606 map->lock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200607
608 ret = _regmap_write(map, reg, val);
609
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600610 map->unlock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200611
612 return ret;
613}
614EXPORT_SYMBOL_GPL(regmap_write);
615
616/**
617 * regmap_raw_write(): Write raw values to one or more registers
618 *
619 * @map: Register map to write to
620 * @reg: Initial register to write to
621 * @val: Block of data to be written, laid out for direct transmission to the
622 * device
623 * @val_len: Length of data pointed to by val.
624 *
625 * This function is intended to be used for things like firmware
626 * download where a large block of data needs to be transferred to the
627 * device. No formatting will be done on the data provided.
628 *
629 * A value of zero will be returned on success, a negative errno will
630 * be returned in error cases.
631 */
632int regmap_raw_write(struct regmap *map, unsigned int reg,
633 const void *val, size_t val_len)
634{
635 int ret;
636
Stephen Warren851960b2012-04-06 15:16:03 -0600637 if (val_len % map->format.val_bytes)
638 return -EINVAL;
Stephen Warrenf01ee602012-04-09 13:40:24 -0600639 if (reg % map->reg_stride)
640 return -EINVAL;
Stephen Warren851960b2012-04-06 15:16:03 -0600641
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600642 map->lock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200643
644 ret = _regmap_raw_write(map, reg, val, val_len);
645
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600646 map->unlock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200647
648 return ret;
649}
650EXPORT_SYMBOL_GPL(regmap_raw_write);
651
Laxman Dewangan8eaeb212012-02-12 19:49:43 +0530652/*
653 * regmap_bulk_write(): Write multiple registers to the device
654 *
655 * @map: Register map to write to
656 * @reg: First register to be write from
657 * @val: Block of data to be written, in native register size for device
658 * @val_count: Number of registers to write
659 *
660 * This function is intended to be used for writing a large block of
661 * data to be device either in single transfer or multiple transfer.
662 *
663 * A value of zero will be returned on success, a negative errno will
664 * be returned in error cases.
665 */
666int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
667 size_t val_count)
668{
669 int ret = 0, i;
670 size_t val_bytes = map->format.val_bytes;
671 void *wval;
672
673 if (!map->format.parse_val)
674 return -EINVAL;
Stephen Warrenf01ee602012-04-09 13:40:24 -0600675 if (reg % map->reg_stride)
676 return -EINVAL;
Laxman Dewangan8eaeb212012-02-12 19:49:43 +0530677
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600678 map->lock(map);
Laxman Dewangan8eaeb212012-02-12 19:49:43 +0530679
680 /* No formatting is require if val_byte is 1 */
681 if (val_bytes == 1) {
682 wval = (void *)val;
683 } else {
684 wval = kmemdup(val, val_count * val_bytes, GFP_KERNEL);
685 if (!wval) {
686 ret = -ENOMEM;
687 dev_err(map->dev, "Error in memory allocation\n");
688 goto out;
689 }
690 for (i = 0; i < val_count * val_bytes; i += val_bytes)
691 map->format.parse_val(wval + i);
692 }
Ashish Jangam2e33caf2012-04-30 23:23:40 +0100693 /*
694 * Some devices does not support bulk write, for
695 * them we have a series of single write operations.
696 */
697 if (map->use_single_rw) {
698 for (i = 0; i < val_count; i++) {
699 ret = regmap_raw_write(map,
700 reg + (i * map->reg_stride),
701 val + (i * val_bytes),
702 val_bytes);
703 if (ret != 0)
704 return ret;
705 }
706 } else {
707 ret = _regmap_raw_write(map, reg, wval, val_bytes * val_count);
708 }
Laxman Dewangan8eaeb212012-02-12 19:49:43 +0530709
710 if (val_bytes != 1)
711 kfree(wval);
712
713out:
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600714 map->unlock(map);
Laxman Dewangan8eaeb212012-02-12 19:49:43 +0530715 return ret;
716}
717EXPORT_SYMBOL_GPL(regmap_bulk_write);
718
Mark Brownb83a3132011-05-11 19:59:58 +0200719static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
720 unsigned int val_len)
721{
722 u8 *u8 = map->work_buf;
723 int ret;
724
Marc Reillyd939fb92012-03-16 12:11:43 +1100725 map->format.format_reg(map->work_buf, reg, map->reg_shift);
Mark Brownb83a3132011-05-11 19:59:58 +0200726
727 /*
Lars-Peter Clausen6f306442011-09-05 20:46:32 +0200728 * Some buses or devices flag reads by setting the high bits in the
Mark Brownb83a3132011-05-11 19:59:58 +0200729 * register addresss; since it's always the high bits for all
730 * current formats we can do this here rather than in
731 * formatting. This may break if we get interesting formats.
732 */
Lars-Peter Clausen6f306442011-09-05 20:46:32 +0200733 u8[0] |= map->read_flag_mask;
Mark Brownb83a3132011-05-11 19:59:58 +0200734
Mark Brownfb2736b2011-07-24 21:30:55 +0100735 trace_regmap_hw_read_start(map->dev, reg,
736 val_len / map->format.val_bytes);
737
Stephen Warren0135bbc2012-04-04 15:48:30 -0600738 ret = map->bus->read(map->bus_context, map->work_buf,
Mark Brown82159ba2012-01-18 10:52:25 +0000739 map->format.reg_bytes + map->format.pad_bytes,
Mark Brown40c5cc22011-07-24 22:39:12 +0100740 val, val_len);
Mark Brownb83a3132011-05-11 19:59:58 +0200741
Mark Brownfb2736b2011-07-24 21:30:55 +0100742 trace_regmap_hw_read_done(map->dev, reg,
743 val_len / map->format.val_bytes);
744
745 return ret;
Mark Brownb83a3132011-05-11 19:59:58 +0200746}
747
748static int _regmap_read(struct regmap *map, unsigned int reg,
749 unsigned int *val)
750{
751 int ret;
752
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100753 if (!map->cache_bypass) {
754 ret = regcache_read(map, reg, val);
755 if (ret == 0)
756 return 0;
757 }
758
Lars-Peter Clausen19254412011-11-16 16:28:19 +0100759 if (!map->format.parse_val)
760 return -EINVAL;
761
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100762 if (map->cache_only)
763 return -EBUSY;
764
Mark Brownb83a3132011-05-11 19:59:58 +0200765 ret = _regmap_raw_read(map, reg, map->work_buf, map->format.val_bytes);
Mark Brownfb2736b2011-07-24 21:30:55 +0100766 if (ret == 0) {
Mark Brownb83a3132011-05-11 19:59:58 +0200767 *val = map->format.parse_val(map->work_buf);
Mark Brownfb2736b2011-07-24 21:30:55 +0100768 trace_regmap_reg_read(map->dev, reg, *val);
769 }
Mark Brownb83a3132011-05-11 19:59:58 +0200770
771 return ret;
772}
773
774/**
775 * regmap_read(): Read a value from a single register
776 *
777 * @map: Register map to write to
778 * @reg: Register to be read from
779 * @val: Pointer to store read value
780 *
781 * A value of zero will be returned on success, a negative errno will
782 * be returned in error cases.
783 */
784int regmap_read(struct regmap *map, unsigned int reg, unsigned int *val)
785{
786 int ret;
787
Stephen Warrenf01ee602012-04-09 13:40:24 -0600788 if (reg % map->reg_stride)
789 return -EINVAL;
790
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600791 map->lock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200792
793 ret = _regmap_read(map, reg, val);
794
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600795 map->unlock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200796
797 return ret;
798}
799EXPORT_SYMBOL_GPL(regmap_read);
800
801/**
802 * regmap_raw_read(): Read raw data from the device
803 *
804 * @map: Register map to write to
805 * @reg: First register to be read from
806 * @val: Pointer to store read value
807 * @val_len: Size of data to read
808 *
809 * A value of zero will be returned on success, a negative errno will
810 * be returned in error cases.
811 */
812int regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
813 size_t val_len)
814{
Mark Brownb8fb5ab2012-02-21 19:12:47 +0000815 size_t val_bytes = map->format.val_bytes;
816 size_t val_count = val_len / val_bytes;
817 unsigned int v;
818 int ret, i;
Mark Brown04e016a2011-10-09 13:35:43 +0100819
Stephen Warren851960b2012-04-06 15:16:03 -0600820 if (val_len % map->format.val_bytes)
821 return -EINVAL;
Stephen Warrenf01ee602012-04-09 13:40:24 -0600822 if (reg % map->reg_stride)
823 return -EINVAL;
Stephen Warren851960b2012-04-06 15:16:03 -0600824
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600825 map->lock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200826
Mark Brownb8fb5ab2012-02-21 19:12:47 +0000827 if (regmap_volatile_range(map, reg, val_count) || map->cache_bypass ||
828 map->cache_type == REGCACHE_NONE) {
829 /* Physical block read if there's no cache involved */
830 ret = _regmap_raw_read(map, reg, val, val_len);
Mark Brownb83a3132011-05-11 19:59:58 +0200831
Mark Brownb8fb5ab2012-02-21 19:12:47 +0000832 } else {
833 /* Otherwise go word by word for the cache; should be low
834 * cost as we expect to hit the cache.
835 */
836 for (i = 0; i < val_count; i++) {
Stephen Warrenf01ee602012-04-09 13:40:24 -0600837 ret = _regmap_read(map, reg + (i * map->reg_stride),
838 &v);
Mark Brownb8fb5ab2012-02-21 19:12:47 +0000839 if (ret != 0)
840 goto out;
841
Marc Reillyd939fb92012-03-16 12:11:43 +1100842 map->format.format_val(val + (i * val_bytes), v, 0);
Mark Brownb8fb5ab2012-02-21 19:12:47 +0000843 }
844 }
845
846 out:
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600847 map->unlock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200848
849 return ret;
850}
851EXPORT_SYMBOL_GPL(regmap_raw_read);
852
853/**
854 * regmap_bulk_read(): Read multiple registers from the device
855 *
856 * @map: Register map to write to
857 * @reg: First register to be read from
858 * @val: Pointer to store read value, in native register size for device
859 * @val_count: Number of registers to read
860 *
861 * A value of zero will be returned on success, a negative errno will
862 * be returned in error cases.
863 */
864int regmap_bulk_read(struct regmap *map, unsigned int reg, void *val,
865 size_t val_count)
866{
867 int ret, i;
868 size_t val_bytes = map->format.val_bytes;
Lars-Peter Clausen82cd9962011-11-08 18:37:25 +0100869 bool vol = regmap_volatile_range(map, reg, val_count);
Dimitris Papastamos5d1729e2011-09-19 14:34:05 +0100870
Mark Brownb83a3132011-05-11 19:59:58 +0200871 if (!map->format.parse_val)
872 return -EINVAL;
Stephen Warrenf01ee602012-04-09 13:40:24 -0600873 if (reg % map->reg_stride)
874 return -EINVAL;
Mark Brownb83a3132011-05-11 19:59:58 +0200875
Mark Brownde2d8082011-10-10 13:24:52 +0100876 if (vol || map->cache_type == REGCACHE_NONE) {
Ashish Jangam2e33caf2012-04-30 23:23:40 +0100877 /*
878 * Some devices does not support bulk read, for
879 * them we have a series of single read operations.
880 */
881 if (map->use_single_rw) {
882 for (i = 0; i < val_count; i++) {
883 ret = regmap_raw_read(map,
884 reg + (i * map->reg_stride),
885 val + (i * val_bytes),
886 val_bytes);
887 if (ret != 0)
888 return ret;
889 }
890 } else {
891 ret = regmap_raw_read(map, reg, val,
892 val_bytes * val_count);
893 if (ret != 0)
894 return ret;
895 }
Mark Brownde2d8082011-10-10 13:24:52 +0100896
897 for (i = 0; i < val_count * val_bytes; i += val_bytes)
898 map->format.parse_val(val + i);
899 } else {
900 for (i = 0; i < val_count; i++) {
Laxman Dewangan6560ffd2012-05-09 17:43:12 +0530901 unsigned int ival;
Stephen Warrenf01ee602012-04-09 13:40:24 -0600902 ret = regmap_read(map, reg + (i * map->reg_stride),
Mark Brown25061d22012-05-12 13:06:08 +0100903 &ival);
Mark Brownde2d8082011-10-10 13:24:52 +0100904 if (ret != 0)
905 return ret;
Laxman Dewangan6560ffd2012-05-09 17:43:12 +0530906 memcpy(val + (i * val_bytes), &ival, val_bytes);
Mark Brownde2d8082011-10-10 13:24:52 +0100907 }
908 }
Mark Brownb83a3132011-05-11 19:59:58 +0200909
910 return 0;
911}
912EXPORT_SYMBOL_GPL(regmap_bulk_read);
913
Mark Brown018690d2011-11-29 20:10:36 +0000914static int _regmap_update_bits(struct regmap *map, unsigned int reg,
915 unsigned int mask, unsigned int val,
916 bool *change)
Mark Brownb83a3132011-05-11 19:59:58 +0200917{
918 int ret;
Mark Brownd91e8db2011-11-18 16:03:50 +0000919 unsigned int tmp, orig;
Mark Brownb83a3132011-05-11 19:59:58 +0200920
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600921 map->lock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200922
Mark Brownd91e8db2011-11-18 16:03:50 +0000923 ret = _regmap_read(map, reg, &orig);
Mark Brownb83a3132011-05-11 19:59:58 +0200924 if (ret != 0)
925 goto out;
926
Mark Brownd91e8db2011-11-18 16:03:50 +0000927 tmp = orig & ~mask;
Mark Brownb83a3132011-05-11 19:59:58 +0200928 tmp |= val & mask;
929
Mark Brown018690d2011-11-29 20:10:36 +0000930 if (tmp != orig) {
Mark Brownd91e8db2011-11-18 16:03:50 +0000931 ret = _regmap_write(map, reg, tmp);
Mark Brown018690d2011-11-29 20:10:36 +0000932 *change = true;
933 } else {
934 *change = false;
935 }
Mark Brownb83a3132011-05-11 19:59:58 +0200936
937out:
Stephen Warrenbacdbe02012-04-04 15:48:28 -0600938 map->unlock(map);
Mark Brownb83a3132011-05-11 19:59:58 +0200939
940 return ret;
941}
Mark Brown018690d2011-11-29 20:10:36 +0000942
943/**
944 * regmap_update_bits: Perform a read/modify/write cycle on the register map
945 *
946 * @map: Register map to update
947 * @reg: Register to update
948 * @mask: Bitmask to change
949 * @val: New value for bitmask
950 *
951 * Returns zero for success, a negative number on error.
952 */
953int regmap_update_bits(struct regmap *map, unsigned int reg,
954 unsigned int mask, unsigned int val)
955{
956 bool change;
957 return _regmap_update_bits(map, reg, mask, val, &change);
958}
Mark Brownb83a3132011-05-11 19:59:58 +0200959EXPORT_SYMBOL_GPL(regmap_update_bits);
Mark Brown31244e32011-07-20 22:56:53 +0100960
Mark Brown018690d2011-11-29 20:10:36 +0000961/**
962 * regmap_update_bits_check: Perform a read/modify/write cycle on the
963 * register map and report if updated
964 *
965 * @map: Register map to update
966 * @reg: Register to update
967 * @mask: Bitmask to change
968 * @val: New value for bitmask
969 * @change: Boolean indicating if a write was done
970 *
971 * Returns zero for success, a negative number on error.
972 */
973int regmap_update_bits_check(struct regmap *map, unsigned int reg,
974 unsigned int mask, unsigned int val,
975 bool *change)
976{
977 return _regmap_update_bits(map, reg, mask, val, change);
978}
979EXPORT_SYMBOL_GPL(regmap_update_bits_check);
980
Mark Brown22f0d902012-01-21 12:01:14 +0000981/**
982 * regmap_register_patch: Register and apply register updates to be applied
983 * on device initialistion
984 *
985 * @map: Register map to apply updates to.
986 * @regs: Values to update.
987 * @num_regs: Number of entries in regs.
988 *
989 * Register a set of register updates to be applied to the device
990 * whenever the device registers are synchronised with the cache and
991 * apply them immediately. Typically this is used to apply
992 * corrections to be applied to the device defaults on startup, such
993 * as the updates some vendors provide to undocumented registers.
994 */
995int regmap_register_patch(struct regmap *map, const struct reg_default *regs,
996 int num_regs)
997{
998 int i, ret;
999 bool bypass;
1000
1001 /* If needed the implementation can be extended to support this */
1002 if (map->patch)
1003 return -EBUSY;
1004
Stephen Warrenbacdbe02012-04-04 15:48:28 -06001005 map->lock(map);
Mark Brown22f0d902012-01-21 12:01:14 +00001006
1007 bypass = map->cache_bypass;
1008
1009 map->cache_bypass = true;
1010
1011 /* Write out first; it's useful to apply even if we fail later. */
1012 for (i = 0; i < num_regs; i++) {
1013 ret = _regmap_write(map, regs[i].reg, regs[i].def);
1014 if (ret != 0) {
1015 dev_err(map->dev, "Failed to write %x = %x: %d\n",
1016 regs[i].reg, regs[i].def, ret);
1017 goto out;
1018 }
1019 }
1020
Axel Lin2a14d7d2012-02-10 19:29:55 +08001021 map->patch = kcalloc(num_regs, sizeof(struct reg_default), GFP_KERNEL);
Mark Brown22f0d902012-01-21 12:01:14 +00001022 if (map->patch != NULL) {
1023 memcpy(map->patch, regs,
1024 num_regs * sizeof(struct reg_default));
1025 map->patch_regs = num_regs;
1026 } else {
1027 ret = -ENOMEM;
1028 }
1029
1030out:
1031 map->cache_bypass = bypass;
1032
Stephen Warrenbacdbe02012-04-04 15:48:28 -06001033 map->unlock(map);
Mark Brown22f0d902012-01-21 12:01:14 +00001034
1035 return ret;
1036}
1037EXPORT_SYMBOL_GPL(regmap_register_patch);
1038
Mark Browneae4b512012-03-14 13:15:03 +00001039/*
Mark Browna6539c32012-02-17 14:20:14 -08001040 * regmap_get_val_bytes(): Report the size of a register value
1041 *
1042 * Report the size of a register value, mainly intended to for use by
1043 * generic infrastructure built on top of regmap.
1044 */
1045int regmap_get_val_bytes(struct regmap *map)
1046{
1047 if (map->format.format_write)
1048 return -EINVAL;
1049
1050 return map->format.val_bytes;
1051}
1052EXPORT_SYMBOL_GPL(regmap_get_val_bytes);
1053
Mark Brown31244e32011-07-20 22:56:53 +01001054static int __init regmap_initcall(void)
1055{
1056 regmap_debugfs_initcall();
1057
1058 return 0;
1059}
1060postcore_initcall(regmap_initcall);