regmap.c 22 KB

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