Tom Rini | 83d290c | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 2 | /* |
| 3 | * Copyright (c) 2015 Google, Inc |
| 4 | * Written by Simon Glass <sjg@chromium.org> |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <common.h> |
| 8 | #include <dm.h> |
| 9 | #include <errno.h> |
Masahiro Yamada | b08c8c4 | 2018-03-05 01:20:11 +0900 | [diff] [blame] | 10 | #include <linux/libfdt.h> |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 11 | #include <malloc.h> |
| 12 | #include <mapmem.h> |
| 13 | #include <regmap.h> |
Paul Burton | 3bfb8cb | 2016-09-08 07:47:35 +0100 | [diff] [blame] | 14 | #include <asm/io.h> |
Simon Glass | 23d6326 | 2017-05-18 20:09:10 -0600 | [diff] [blame] | 15 | #include <dm/of_addr.h> |
| 16 | #include <linux/ioport.h> |
Paul Burton | 3bfb8cb | 2016-09-08 07:47:35 +0100 | [diff] [blame] | 17 | |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 18 | DECLARE_GLOBAL_DATA_PTR; |
| 19 | |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 20 | static struct regmap *regmap_alloc(int count) |
Simon Glass | a951431 | 2016-07-04 11:58:21 -0600 | [diff] [blame] | 21 | { |
| 22 | struct regmap *map; |
| 23 | |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 24 | map = malloc(sizeof(*map) + sizeof(map->ranges[0]) * count); |
Simon Glass | a951431 | 2016-07-04 11:58:21 -0600 | [diff] [blame] | 25 | if (!map) |
| 26 | return NULL; |
Simon Glass | a951431 | 2016-07-04 11:58:21 -0600 | [diff] [blame] | 27 | map->range_count = count; |
| 28 | |
| 29 | return map; |
| 30 | } |
| 31 | |
Simon Glass | 3b2a29e | 2016-07-04 11:57:59 -0600 | [diff] [blame] | 32 | #if CONFIG_IS_ENABLED(OF_PLATDATA) |
Simon Glass | c20ee0e | 2017-08-29 14:15:50 -0600 | [diff] [blame] | 33 | int regmap_init_mem_platdata(struct udevice *dev, fdt_val_t *reg, int count, |
Simon Glass | 3b2a29e | 2016-07-04 11:57:59 -0600 | [diff] [blame] | 34 | struct regmap **mapp) |
| 35 | { |
Simon Glass | 1e6ca1a | 2016-07-04 11:58:22 -0600 | [diff] [blame] | 36 | struct regmap_range *range; |
| 37 | struct regmap *map; |
| 38 | |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 39 | map = regmap_alloc(count); |
Simon Glass | 1e6ca1a | 2016-07-04 11:58:22 -0600 | [diff] [blame] | 40 | if (!map) |
| 41 | return -ENOMEM; |
| 42 | |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 43 | for (range = map->ranges; count > 0; reg += 2, range++, count--) { |
Simon Glass | 1e6ca1a | 2016-07-04 11:58:22 -0600 | [diff] [blame] | 44 | range->start = *reg; |
| 45 | range->size = reg[1]; |
| 46 | } |
| 47 | |
| 48 | *mapp = map; |
| 49 | |
Simon Glass | 3b2a29e | 2016-07-04 11:57:59 -0600 | [diff] [blame] | 50 | return 0; |
| 51 | } |
| 52 | #else |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 53 | int regmap_init_mem(struct udevice *dev, struct regmap **mapp) |
| 54 | { |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 55 | struct regmap_range *range; |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 56 | struct regmap *map; |
| 57 | int count; |
| 58 | int addr_len, size_len, both_len; |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 59 | int len; |
Jean-Jacques Hiblot | 1804044 | 2017-02-13 16:17:48 +0100 | [diff] [blame] | 60 | int index; |
Simon Glass | 23d6326 | 2017-05-18 20:09:10 -0600 | [diff] [blame] | 61 | ofnode node = dev_ofnode(dev); |
| 62 | struct resource r; |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 63 | |
Simon Glass | 878d68c | 2017-06-12 06:21:31 -0600 | [diff] [blame] | 64 | addr_len = dev_read_simple_addr_cells(dev->parent); |
| 65 | size_len = dev_read_simple_size_cells(dev->parent); |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 66 | both_len = addr_len + size_len; |
| 67 | |
Simon Glass | 23d6326 | 2017-05-18 20:09:10 -0600 | [diff] [blame] | 68 | len = dev_read_size(dev, "reg"); |
| 69 | if (len < 0) |
| 70 | return len; |
| 71 | len /= sizeof(fdt32_t); |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 72 | count = len / both_len; |
Simon Glass | 23d6326 | 2017-05-18 20:09:10 -0600 | [diff] [blame] | 73 | if (!count) |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 74 | return -EINVAL; |
| 75 | |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 76 | map = regmap_alloc(count); |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 77 | if (!map) |
| 78 | return -ENOMEM; |
| 79 | |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 80 | for (range = map->ranges, index = 0; count > 0; |
Simon Glass | 23d6326 | 2017-05-18 20:09:10 -0600 | [diff] [blame] | 81 | count--, range++, index++) { |
Jean-Jacques Hiblot | 1804044 | 2017-02-13 16:17:48 +0100 | [diff] [blame] | 82 | fdt_size_t sz; |
Simon Glass | 23d6326 | 2017-05-18 20:09:10 -0600 | [diff] [blame] | 83 | if (of_live_active()) { |
| 84 | of_address_to_resource(ofnode_to_np(node), index, &r); |
| 85 | range->start = r.start; |
| 86 | range->size = r.end - r.start + 1; |
| 87 | } else { |
| 88 | range->start = fdtdec_get_addr_size_fixed(gd->fdt_blob, |
| 89 | dev_of_offset(dev), "reg", index, |
| 90 | addr_len, size_len, &sz, true); |
| 91 | range->size = sz; |
| 92 | } |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 93 | } |
| 94 | |
| 95 | *mapp = map; |
| 96 | |
| 97 | return 0; |
| 98 | } |
Simon Glass | 3b2a29e | 2016-07-04 11:57:59 -0600 | [diff] [blame] | 99 | #endif |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 100 | |
| 101 | void *regmap_get_range(struct regmap *map, unsigned int range_num) |
| 102 | { |
| 103 | struct regmap_range *range; |
| 104 | |
| 105 | if (range_num >= map->range_count) |
| 106 | return NULL; |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 107 | range = &map->ranges[range_num]; |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 108 | |
| 109 | return map_sysmem(range->start, range->size); |
| 110 | } |
| 111 | |
| 112 | int regmap_uninit(struct regmap *map) |
| 113 | { |
Simon Glass | 6f98b75 | 2015-06-23 15:38:42 -0600 | [diff] [blame] | 114 | free(map); |
| 115 | |
| 116 | return 0; |
| 117 | } |
Paul Burton | 3bfb8cb | 2016-09-08 07:47:35 +0100 | [diff] [blame] | 118 | |
| 119 | int regmap_read(struct regmap *map, uint offset, uint *valp) |
| 120 | { |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 121 | u32 *ptr = map_physmem(map->ranges[0].start + offset, 4, MAP_NOCACHE); |
Paul Burton | 3bfb8cb | 2016-09-08 07:47:35 +0100 | [diff] [blame] | 122 | |
| 123 | *valp = le32_to_cpu(readl(ptr)); |
| 124 | |
| 125 | return 0; |
| 126 | } |
| 127 | |
| 128 | int regmap_write(struct regmap *map, uint offset, uint val) |
| 129 | { |
Masahiro Yamada | 8c1de5e | 2018-04-19 12:14:01 +0900 | [diff] [blame^] | 130 | u32 *ptr = map_physmem(map->ranges[0].start + offset, 4, MAP_NOCACHE); |
Paul Burton | 3bfb8cb | 2016-09-08 07:47:35 +0100 | [diff] [blame] | 131 | |
| 132 | writel(cpu_to_le32(val), ptr); |
| 133 | |
| 134 | return 0; |
| 135 | } |