regmap: Use pad_bits and reg_bits when determining register format.
[deliverable/linux.git] / drivers / base / regmap / regmap.c
CommitLineData
b83a313b
MB
1/*
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
f5d6eba7 13#include <linux/device.h>
b83a313b 14#include <linux/slab.h>
19694b5e 15#include <linux/export.h>
b83a313b
MB
16#include <linux/mutex.h>
17#include <linux/err.h>
18
fb2736bb
MB
19#define CREATE_TRACE_POINTS
20#include <trace/events/regmap.h>
21
93de9124 22#include "internal.h"
b83a313b 23
8de2f081
MB
24bool 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
4191f197
WS
40 if (map->format.format_write)
41 return false;
42
8de2f081
MB
43 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{
4191f197 51 if (!regmap_readable(map, reg))
8de2f081
MB
52 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{
4191f197 62 if (!regmap_readable(map, reg))
8de2f081
MB
63 return false;
64
65 if (map->precious_reg)
66 return map->precious_reg(map->dev, reg);
67
68 return false;
69}
70
82cd9965
LPC
71static 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
9aa50750
WS
83static 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
b83a313b
MB
91static 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
7e5ec63e
LPC
105static 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
d939fb9a 115static void regmap_format_8(void *buf, unsigned int val, unsigned int shift)
b83a313b
MB
116{
117 u8 *b = buf;
118
d939fb9a 119 b[0] = val << shift;
b83a313b
MB
120}
121
d939fb9a 122static void regmap_format_16(void *buf, unsigned int val, unsigned int shift)
b83a313b
MB
123{
124 __be16 *b = buf;
125
d939fb9a 126 b[0] = cpu_to_be16(val << shift);
b83a313b
MB
127}
128
d939fb9a 129static void regmap_format_24(void *buf, unsigned int val, unsigned int shift)
ea279fc5
MR
130{
131 u8 *b = buf;
132
d939fb9a
MR
133 val <<= shift;
134
ea279fc5
MR
135 b[0] = val >> 16;
136 b[1] = val >> 8;
137 b[2] = val;
138}
139
d939fb9a 140static void regmap_format_32(void *buf, unsigned int val, unsigned int shift)
7d5e525b
MB
141{
142 __be32 *b = buf;
143
d939fb9a 144 b[0] = cpu_to_be32(val << shift);
7d5e525b
MB
145}
146
b83a313b
MB
147static 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
ea279fc5
MR
163static 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
7d5e525b
MB
173static 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
b83a313b
MB
182/**
183 * regmap_init(): Initialise register map
184 *
185 * @dev: Device that will be interacted with
186 * @bus: Bus-specific callbacks to use with device
187 * @config: Configuration for register map
188 *
189 * The return value will be an ERR_PTR() on error or a valid pointer to
190 * a struct regmap. This function should generally not be called
191 * directly, it should be called by bus-specific init functions.
192 */
193struct regmap *regmap_init(struct device *dev,
194 const struct regmap_bus *bus,
195 const struct regmap_config *config)
196{
197 struct regmap *map;
198 int ret = -EINVAL;
199
200 if (!bus || !config)
abbb18fb 201 goto err;
b83a313b
MB
202
203 map = kzalloc(sizeof(*map), GFP_KERNEL);
204 if (map == NULL) {
205 ret = -ENOMEM;
206 goto err;
207 }
208
209 mutex_init(&map->lock);
210 map->format.buf_size = (config->reg_bits + config->val_bits) / 8;
c212accc 211 map->format.reg_bytes = DIV_ROUND_UP(config->reg_bits, 8);
82159ba8 212 map->format.pad_bytes = config->pad_bits / 8;
c212accc 213 map->format.val_bytes = DIV_ROUND_UP(config->val_bits, 8);
82159ba8 214 map->format.buf_size += map->format.pad_bytes;
d939fb9a 215 map->reg_shift = config->pad_bits % 8;
b83a313b
MB
216 map->dev = dev;
217 map->bus = bus;
2e2ae66d
MB
218 map->max_register = config->max_register;
219 map->writeable_reg = config->writeable_reg;
220 map->readable_reg = config->readable_reg;
221 map->volatile_reg = config->volatile_reg;
2efe1642 222 map->precious_reg = config->precious_reg;
5d1729e7 223 map->cache_type = config->cache_type;
b83a313b 224
6f306441
LPC
225 if (config->read_flag_mask || config->write_flag_mask) {
226 map->read_flag_mask = config->read_flag_mask;
227 map->write_flag_mask = config->write_flag_mask;
228 } else {
229 map->read_flag_mask = bus->read_flag_mask;
230 }
231
d939fb9a 232 switch (config->reg_bits + map->reg_shift) {
9aa50750
WS
233 case 2:
234 switch (config->val_bits) {
235 case 6:
236 map->format.format_write = regmap_format_2_6_write;
237 break;
238 default:
239 goto err_map;
240 }
241 break;
242
b83a313b
MB
243 case 4:
244 switch (config->val_bits) {
245 case 12:
246 map->format.format_write = regmap_format_4_12_write;
247 break;
248 default:
249 goto err_map;
250 }
251 break;
252
253 case 7:
254 switch (config->val_bits) {
255 case 9:
256 map->format.format_write = regmap_format_7_9_write;
257 break;
258 default:
259 goto err_map;
260 }
261 break;
262
7e5ec63e
LPC
263 case 10:
264 switch (config->val_bits) {
265 case 14:
266 map->format.format_write = regmap_format_10_14_write;
267 break;
268 default:
269 goto err_map;
270 }
271 break;
272
b83a313b
MB
273 case 8:
274 map->format.format_reg = regmap_format_8;
275 break;
276
277 case 16:
278 map->format.format_reg = regmap_format_16;
279 break;
280
7d5e525b
MB
281 case 32:
282 map->format.format_reg = regmap_format_32;
283 break;
284
b83a313b
MB
285 default:
286 goto err_map;
287 }
288
289 switch (config->val_bits) {
290 case 8:
291 map->format.format_val = regmap_format_8;
292 map->format.parse_val = regmap_parse_8;
293 break;
294 case 16:
295 map->format.format_val = regmap_format_16;
296 map->format.parse_val = regmap_parse_16;
297 break;
ea279fc5
MR
298 case 24:
299 map->format.format_val = regmap_format_24;
300 map->format.parse_val = regmap_parse_24;
301 break;
7d5e525b
MB
302 case 32:
303 map->format.format_val = regmap_format_32;
304 map->format.parse_val = regmap_parse_32;
305 break;
b83a313b
MB
306 }
307
308 if (!map->format.format_write &&
309 !(map->format.format_reg && map->format.format_val))
310 goto err_map;
311
82159ba8 312 map->work_buf = kzalloc(map->format.buf_size, GFP_KERNEL);
b83a313b
MB
313 if (map->work_buf == NULL) {
314 ret = -ENOMEM;
5204f5e3 315 goto err_map;
b83a313b
MB
316 }
317
052d2cd1
MB
318 regmap_debugfs_init(map);
319
e5e3b8ab 320 ret = regcache_init(map, config);
5d1729e7 321 if (ret < 0)
58072cbf 322 goto err_free_workbuf;
5d1729e7 323
b83a313b
MB
324 return map;
325
58072cbf
LPC
326err_free_workbuf:
327 kfree(map->work_buf);
b83a313b
MB
328err_map:
329 kfree(map);
330err:
331 return ERR_PTR(ret);
332}
333EXPORT_SYMBOL_GPL(regmap_init);
334
c0eb4676
MB
335static void devm_regmap_release(struct device *dev, void *res)
336{
337 regmap_exit(*(struct regmap **)res);
338}
339
340/**
341 * devm_regmap_init(): Initialise managed register map
342 *
343 * @dev: Device that will be interacted with
344 * @bus: Bus-specific callbacks to use with device
345 * @config: Configuration for register map
346 *
347 * The return value will be an ERR_PTR() on error or a valid pointer
348 * to a struct regmap. This function should generally not be called
349 * directly, it should be called by bus-specific init functions. The
350 * map will be automatically freed by the device management code.
351 */
352struct regmap *devm_regmap_init(struct device *dev,
353 const struct regmap_bus *bus,
354 const struct regmap_config *config)
355{
356 struct regmap **ptr, *regmap;
357
358 ptr = devres_alloc(devm_regmap_release, sizeof(*ptr), GFP_KERNEL);
359 if (!ptr)
360 return ERR_PTR(-ENOMEM);
361
362 regmap = regmap_init(dev, bus, config);
363 if (!IS_ERR(regmap)) {
364 *ptr = regmap;
365 devres_add(dev, ptr);
366 } else {
367 devres_free(ptr);
368 }
369
370 return regmap;
371}
372EXPORT_SYMBOL_GPL(devm_regmap_init);
373
bf315173
MB
374/**
375 * regmap_reinit_cache(): Reinitialise the current register cache
376 *
377 * @map: Register map to operate on.
378 * @config: New configuration. Only the cache data will be used.
379 *
380 * Discard any existing register cache for the map and initialize a
381 * new cache. This can be used to restore the cache to defaults or to
382 * update the cache configuration to reflect runtime discovery of the
383 * hardware.
384 */
385int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
386{
387 int ret;
388
389 mutex_lock(&map->lock);
390
391 regcache_exit(map);
a24f64a6 392 regmap_debugfs_exit(map);
bf315173
MB
393
394 map->max_register = config->max_register;
395 map->writeable_reg = config->writeable_reg;
396 map->readable_reg = config->readable_reg;
397 map->volatile_reg = config->volatile_reg;
398 map->precious_reg = config->precious_reg;
399 map->cache_type = config->cache_type;
400
a24f64a6
MB
401 regmap_debugfs_init(map);
402
421e8d2d
MB
403 map->cache_bypass = false;
404 map->cache_only = false;
405
bf315173
MB
406 ret = regcache_init(map, config);
407
408 mutex_unlock(&map->lock);
409
410 return ret;
411}
412
b83a313b
MB
413/**
414 * regmap_exit(): Free a previously allocated register map
415 */
416void regmap_exit(struct regmap *map)
417{
5d1729e7 418 regcache_exit(map);
31244e39 419 regmap_debugfs_exit(map);
b83a313b 420 kfree(map->work_buf);
b83a313b
MB
421 kfree(map);
422}
423EXPORT_SYMBOL_GPL(regmap_exit);
424
425static int _regmap_raw_write(struct regmap *map, unsigned int reg,
426 const void *val, size_t val_len)
427{
6f306441 428 u8 *u8 = map->work_buf;
b83a313b
MB
429 void *buf;
430 int ret = -ENOTSUPP;
431 size_t len;
73304781
MB
432 int i;
433
434 /* Check for unwritable registers before we start */
435 if (map->writeable_reg)
436 for (i = 0; i < val_len / map->format.val_bytes; i++)
437 if (!map->writeable_reg(map->dev, reg + i))
438 return -EINVAL;
b83a313b 439
c9157198
LD
440 if (!map->cache_bypass && map->format.parse_val) {
441 unsigned int ival;
442 int val_bytes = map->format.val_bytes;
443 for (i = 0; i < val_len / val_bytes; i++) {
444 memcpy(map->work_buf, val + (i * val_bytes), val_bytes);
445 ival = map->format.parse_val(map->work_buf);
446 ret = regcache_write(map, reg + i, ival);
447 if (ret) {
448 dev_err(map->dev,
449 "Error in caching of register: %u ret: %d\n",
450 reg + i, ret);
451 return ret;
452 }
453 }
454 if (map->cache_only) {
455 map->cache_dirty = true;
456 return 0;
457 }
458 }
459
d939fb9a 460 map->format.format_reg(map->work_buf, reg, map->reg_shift);
b83a313b 461
6f306441
LPC
462 u8[0] |= map->write_flag_mask;
463
fb2736bb
MB
464 trace_regmap_hw_write_start(map->dev, reg,
465 val_len / map->format.val_bytes);
466
2547e201
MB
467 /* If we're doing a single register write we can probably just
468 * send the work_buf directly, otherwise try to do a gather
469 * write.
470 */
82159ba8
MB
471 if (val == (map->work_buf + map->format.pad_bytes +
472 map->format.reg_bytes))
2547e201 473 ret = map->bus->write(map->dev, map->work_buf,
82159ba8
MB
474 map->format.reg_bytes +
475 map->format.pad_bytes +
476 val_len);
2547e201 477 else if (map->bus->gather_write)
b83a313b 478 ret = map->bus->gather_write(map->dev, map->work_buf,
82159ba8
MB
479 map->format.reg_bytes +
480 map->format.pad_bytes,
b83a313b
MB
481 val, val_len);
482
2547e201 483 /* If that didn't work fall back on linearising by hand. */
b83a313b 484 if (ret == -ENOTSUPP) {
82159ba8
MB
485 len = map->format.reg_bytes + map->format.pad_bytes + val_len;
486 buf = kzalloc(len, GFP_KERNEL);
b83a313b
MB
487 if (!buf)
488 return -ENOMEM;
489
490 memcpy(buf, map->work_buf, map->format.reg_bytes);
82159ba8
MB
491 memcpy(buf + map->format.reg_bytes + map->format.pad_bytes,
492 val, val_len);
b83a313b
MB
493 ret = map->bus->write(map->dev, buf, len);
494
495 kfree(buf);
496 }
497
fb2736bb
MB
498 trace_regmap_hw_write_done(map->dev, reg,
499 val_len / map->format.val_bytes);
500
b83a313b
MB
501 return ret;
502}
503
4d2dc095
DP
504int _regmap_write(struct regmap *map, unsigned int reg,
505 unsigned int val)
b83a313b 506{
fb2736bb 507 int ret;
b83a313b
MB
508 BUG_ON(!map->format.format_write && !map->format.format_val);
509
c9157198 510 if (!map->cache_bypass && map->format.format_write) {
5d1729e7
DP
511 ret = regcache_write(map, reg, val);
512 if (ret != 0)
513 return ret;
8ae0d7e8
MB
514 if (map->cache_only) {
515 map->cache_dirty = true;
5d1729e7 516 return 0;
8ae0d7e8 517 }
5d1729e7
DP
518 }
519
fb2736bb
MB
520 trace_regmap_reg_write(map->dev, reg, val);
521
b83a313b
MB
522 if (map->format.format_write) {
523 map->format.format_write(map, reg, val);
524
fb2736bb
MB
525 trace_regmap_hw_write_start(map->dev, reg, 1);
526
527 ret = map->bus->write(map->dev, map->work_buf,
528 map->format.buf_size);
529
530 trace_regmap_hw_write_done(map->dev, reg, 1);
531
532 return ret;
b83a313b 533 } else {
82159ba8 534 map->format.format_val(map->work_buf + map->format.reg_bytes
d939fb9a 535 + map->format.pad_bytes, val, 0);
b83a313b 536 return _regmap_raw_write(map, reg,
82159ba8
MB
537 map->work_buf +
538 map->format.reg_bytes +
539 map->format.pad_bytes,
b83a313b
MB
540 map->format.val_bytes);
541 }
542}
543
544/**
545 * regmap_write(): Write a value to a single register
546 *
547 * @map: Register map to write to
548 * @reg: Register to write to
549 * @val: Value to be written
550 *
551 * A value of zero will be returned on success, a negative errno will
552 * be returned in error cases.
553 */
554int regmap_write(struct regmap *map, unsigned int reg, unsigned int val)
555{
556 int ret;
557
558 mutex_lock(&map->lock);
559
560 ret = _regmap_write(map, reg, val);
561
562 mutex_unlock(&map->lock);
563
564 return ret;
565}
566EXPORT_SYMBOL_GPL(regmap_write);
567
568/**
569 * regmap_raw_write(): Write raw values to one or more registers
570 *
571 * @map: Register map to write to
572 * @reg: Initial register to write to
573 * @val: Block of data to be written, laid out for direct transmission to the
574 * device
575 * @val_len: Length of data pointed to by val.
576 *
577 * This function is intended to be used for things like firmware
578 * download where a large block of data needs to be transferred to the
579 * device. No formatting will be done on the data provided.
580 *
581 * A value of zero will be returned on success, a negative errno will
582 * be returned in error cases.
583 */
584int regmap_raw_write(struct regmap *map, unsigned int reg,
585 const void *val, size_t val_len)
586{
587 int ret;
588
589 mutex_lock(&map->lock);
590
591 ret = _regmap_raw_write(map, reg, val, val_len);
592
593 mutex_unlock(&map->lock);
594
595 return ret;
596}
597EXPORT_SYMBOL_GPL(regmap_raw_write);
598
8eaeb219
LD
599/*
600 * regmap_bulk_write(): Write multiple registers to the device
601 *
602 * @map: Register map to write to
603 * @reg: First register to be write from
604 * @val: Block of data to be written, in native register size for device
605 * @val_count: Number of registers to write
606 *
607 * This function is intended to be used for writing a large block of
608 * data to be device either in single transfer or multiple transfer.
609 *
610 * A value of zero will be returned on success, a negative errno will
611 * be returned in error cases.
612 */
613int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
614 size_t val_count)
615{
616 int ret = 0, i;
617 size_t val_bytes = map->format.val_bytes;
618 void *wval;
619
620 if (!map->format.parse_val)
621 return -EINVAL;
622
623 mutex_lock(&map->lock);
624
625 /* No formatting is require if val_byte is 1 */
626 if (val_bytes == 1) {
627 wval = (void *)val;
628 } else {
629 wval = kmemdup(val, val_count * val_bytes, GFP_KERNEL);
630 if (!wval) {
631 ret = -ENOMEM;
632 dev_err(map->dev, "Error in memory allocation\n");
633 goto out;
634 }
635 for (i = 0; i < val_count * val_bytes; i += val_bytes)
636 map->format.parse_val(wval + i);
637 }
638 ret = _regmap_raw_write(map, reg, wval, val_bytes * val_count);
639
640 if (val_bytes != 1)
641 kfree(wval);
642
643out:
644 mutex_unlock(&map->lock);
645 return ret;
646}
647EXPORT_SYMBOL_GPL(regmap_bulk_write);
648
b83a313b
MB
649static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
650 unsigned int val_len)
651{
652 u8 *u8 = map->work_buf;
653 int ret;
654
d939fb9a 655 map->format.format_reg(map->work_buf, reg, map->reg_shift);
b83a313b
MB
656
657 /*
6f306441 658 * Some buses or devices flag reads by setting the high bits in the
b83a313b
MB
659 * register addresss; since it's always the high bits for all
660 * current formats we can do this here rather than in
661 * formatting. This may break if we get interesting formats.
662 */
6f306441 663 u8[0] |= map->read_flag_mask;
b83a313b 664
fb2736bb
MB
665 trace_regmap_hw_read_start(map->dev, reg,
666 val_len / map->format.val_bytes);
667
82159ba8
MB
668 ret = map->bus->read(map->dev, map->work_buf,
669 map->format.reg_bytes + map->format.pad_bytes,
40c5cc26 670 val, val_len);
b83a313b 671
fb2736bb
MB
672 trace_regmap_hw_read_done(map->dev, reg,
673 val_len / map->format.val_bytes);
674
675 return ret;
b83a313b
MB
676}
677
678static int _regmap_read(struct regmap *map, unsigned int reg,
679 unsigned int *val)
680{
681 int ret;
682
5d1729e7
DP
683 if (!map->cache_bypass) {
684 ret = regcache_read(map, reg, val);
685 if (ret == 0)
686 return 0;
687 }
688
19254411
LPC
689 if (!map->format.parse_val)
690 return -EINVAL;
691
5d1729e7
DP
692 if (map->cache_only)
693 return -EBUSY;
694
b83a313b 695 ret = _regmap_raw_read(map, reg, map->work_buf, map->format.val_bytes);
fb2736bb 696 if (ret == 0) {
b83a313b 697 *val = map->format.parse_val(map->work_buf);
fb2736bb
MB
698 trace_regmap_reg_read(map->dev, reg, *val);
699 }
b83a313b
MB
700
701 return ret;
702}
703
704/**
705 * regmap_read(): Read a value from a single register
706 *
707 * @map: Register map to write to
708 * @reg: Register to be read from
709 * @val: Pointer to store read value
710 *
711 * A value of zero will be returned on success, a negative errno will
712 * be returned in error cases.
713 */
714int regmap_read(struct regmap *map, unsigned int reg, unsigned int *val)
715{
716 int ret;
717
718 mutex_lock(&map->lock);
719
720 ret = _regmap_read(map, reg, val);
721
722 mutex_unlock(&map->lock);
723
724 return ret;
725}
726EXPORT_SYMBOL_GPL(regmap_read);
727
728/**
729 * regmap_raw_read(): Read raw data from the device
730 *
731 * @map: Register map to write to
732 * @reg: First register to be read from
733 * @val: Pointer to store read value
734 * @val_len: Size of data to read
735 *
736 * A value of zero will be returned on success, a negative errno will
737 * be returned in error cases.
738 */
739int regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
740 size_t val_len)
741{
b8fb5ab1
MB
742 size_t val_bytes = map->format.val_bytes;
743 size_t val_count = val_len / val_bytes;
744 unsigned int v;
745 int ret, i;
04e016ad 746
b83a313b
MB
747 mutex_lock(&map->lock);
748
b8fb5ab1
MB
749 if (regmap_volatile_range(map, reg, val_count) || map->cache_bypass ||
750 map->cache_type == REGCACHE_NONE) {
751 /* Physical block read if there's no cache involved */
752 ret = _regmap_raw_read(map, reg, val, val_len);
753
754 } else {
755 /* Otherwise go word by word for the cache; should be low
756 * cost as we expect to hit the cache.
757 */
758 for (i = 0; i < val_count; i++) {
759 ret = _regmap_read(map, reg + i, &v);
760 if (ret != 0)
761 goto out;
762
d939fb9a 763 map->format.format_val(val + (i * val_bytes), v, 0);
b8fb5ab1
MB
764 }
765 }
b83a313b 766
b8fb5ab1 767 out:
b83a313b
MB
768 mutex_unlock(&map->lock);
769
770 return ret;
771}
772EXPORT_SYMBOL_GPL(regmap_raw_read);
773
774/**
775 * regmap_bulk_read(): Read multiple registers from the device
776 *
777 * @map: Register map to write to
778 * @reg: First register to be read from
779 * @val: Pointer to store read value, in native register size for device
780 * @val_count: Number of registers to read
781 *
782 * A value of zero will be returned on success, a negative errno will
783 * be returned in error cases.
784 */
785int regmap_bulk_read(struct regmap *map, unsigned int reg, void *val,
786 size_t val_count)
787{
788 int ret, i;
789 size_t val_bytes = map->format.val_bytes;
82cd9965 790 bool vol = regmap_volatile_range(map, reg, val_count);
5d1729e7 791
b83a313b
MB
792 if (!map->format.parse_val)
793 return -EINVAL;
794
de2d808f
MB
795 if (vol || map->cache_type == REGCACHE_NONE) {
796 ret = regmap_raw_read(map, reg, val, val_bytes * val_count);
797 if (ret != 0)
798 return ret;
799
800 for (i = 0; i < val_count * val_bytes; i += val_bytes)
801 map->format.parse_val(val + i);
802 } else {
803 for (i = 0; i < val_count; i++) {
804 ret = regmap_read(map, reg + i, val + (i * val_bytes));
805 if (ret != 0)
806 return ret;
807 }
808 }
b83a313b
MB
809
810 return 0;
811}
812EXPORT_SYMBOL_GPL(regmap_bulk_read);
813
018690d3
MB
814static int _regmap_update_bits(struct regmap *map, unsigned int reg,
815 unsigned int mask, unsigned int val,
816 bool *change)
b83a313b
MB
817{
818 int ret;
d91e8db2 819 unsigned int tmp, orig;
b83a313b
MB
820
821 mutex_lock(&map->lock);
822
d91e8db2 823 ret = _regmap_read(map, reg, &orig);
b83a313b
MB
824 if (ret != 0)
825 goto out;
826
d91e8db2 827 tmp = orig & ~mask;
b83a313b
MB
828 tmp |= val & mask;
829
018690d3 830 if (tmp != orig) {
d91e8db2 831 ret = _regmap_write(map, reg, tmp);
018690d3
MB
832 *change = true;
833 } else {
834 *change = false;
835 }
b83a313b
MB
836
837out:
838 mutex_unlock(&map->lock);
839
840 return ret;
841}
018690d3
MB
842
843/**
844 * regmap_update_bits: Perform a read/modify/write cycle on the register map
845 *
846 * @map: Register map to update
847 * @reg: Register to update
848 * @mask: Bitmask to change
849 * @val: New value for bitmask
850 *
851 * Returns zero for success, a negative number on error.
852 */
853int regmap_update_bits(struct regmap *map, unsigned int reg,
854 unsigned int mask, unsigned int val)
855{
856 bool change;
857 return _regmap_update_bits(map, reg, mask, val, &change);
858}
b83a313b 859EXPORT_SYMBOL_GPL(regmap_update_bits);
31244e39 860
018690d3
MB
861/**
862 * regmap_update_bits_check: Perform a read/modify/write cycle on the
863 * register map and report if updated
864 *
865 * @map: Register map to update
866 * @reg: Register to update
867 * @mask: Bitmask to change
868 * @val: New value for bitmask
869 * @change: Boolean indicating if a write was done
870 *
871 * Returns zero for success, a negative number on error.
872 */
873int regmap_update_bits_check(struct regmap *map, unsigned int reg,
874 unsigned int mask, unsigned int val,
875 bool *change)
876{
877 return _regmap_update_bits(map, reg, mask, val, change);
878}
879EXPORT_SYMBOL_GPL(regmap_update_bits_check);
880
22f0d90a
MB
881/**
882 * regmap_register_patch: Register and apply register updates to be applied
883 * on device initialistion
884 *
885 * @map: Register map to apply updates to.
886 * @regs: Values to update.
887 * @num_regs: Number of entries in regs.
888 *
889 * Register a set of register updates to be applied to the device
890 * whenever the device registers are synchronised with the cache and
891 * apply them immediately. Typically this is used to apply
892 * corrections to be applied to the device defaults on startup, such
893 * as the updates some vendors provide to undocumented registers.
894 */
895int regmap_register_patch(struct regmap *map, const struct reg_default *regs,
896 int num_regs)
897{
898 int i, ret;
899 bool bypass;
900
901 /* If needed the implementation can be extended to support this */
902 if (map->patch)
903 return -EBUSY;
904
905 mutex_lock(&map->lock);
906
907 bypass = map->cache_bypass;
908
909 map->cache_bypass = true;
910
911 /* Write out first; it's useful to apply even if we fail later. */
912 for (i = 0; i < num_regs; i++) {
913 ret = _regmap_write(map, regs[i].reg, regs[i].def);
914 if (ret != 0) {
915 dev_err(map->dev, "Failed to write %x = %x: %d\n",
916 regs[i].reg, regs[i].def, ret);
917 goto out;
918 }
919 }
920
2a14d7d9 921 map->patch = kcalloc(num_regs, sizeof(struct reg_default), GFP_KERNEL);
22f0d90a
MB
922 if (map->patch != NULL) {
923 memcpy(map->patch, regs,
924 num_regs * sizeof(struct reg_default));
925 map->patch_regs = num_regs;
926 } else {
927 ret = -ENOMEM;
928 }
929
930out:
931 map->cache_bypass = bypass;
932
933 mutex_unlock(&map->lock);
934
935 return ret;
936}
937EXPORT_SYMBOL_GPL(regmap_register_patch);
938
eae4b51b 939/*
a6539c32
MB
940 * regmap_get_val_bytes(): Report the size of a register value
941 *
942 * Report the size of a register value, mainly intended to for use by
943 * generic infrastructure built on top of regmap.
944 */
945int regmap_get_val_bytes(struct regmap *map)
946{
947 if (map->format.format_write)
948 return -EINVAL;
949
950 return map->format.val_bytes;
951}
952EXPORT_SYMBOL_GPL(regmap_get_val_bytes);
953
31244e39
MB
954static int __init regmap_initcall(void)
955{
956 regmap_debugfs_initcall();
957
958 return 0;
959}
960postcore_initcall(regmap_initcall);
This page took 0.112469 seconds and 5 git commands to generate.