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