Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 1 | /* |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 2 | * Copyright (C) 2012-2015 Masahiro Yamada <yamada.masahiro@socionext.com> |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: GPL-2.0+ |
| 5 | */ |
| 6 | |
| 7 | #include <common.h> |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 8 | #include <libfdt.h> |
| 9 | #include <linux/err.h> |
| 10 | |
| 11 | DECLARE_GLOBAL_DATA_PTR; |
| 12 | |
| 13 | static const void *get_memory_reg_prop(const void *fdt, int *lenp) |
| 14 | { |
| 15 | int offset; |
| 16 | |
| 17 | offset = fdt_path_offset(fdt, "/memory"); |
| 18 | if (offset < 0) |
| 19 | return NULL; |
| 20 | |
| 21 | return fdt_getprop(fdt, offset, "reg", lenp); |
| 22 | } |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 23 | |
| 24 | int dram_init(void) |
| 25 | { |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 26 | const void *fdt = gd->fdt_blob; |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 27 | const fdt32_t *val; |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 28 | int ac, sc, len; |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 29 | |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 30 | ac = fdt_address_cells(fdt, 0); |
| 31 | sc = fdt_size_cells(fdt, 0); |
| 32 | if (ac < 0 || sc < 1 || sc > 2) { |
| 33 | printf("invalid address/size cells\n"); |
| 34 | return -EINVAL; |
| 35 | } |
| 36 | |
| 37 | val = get_memory_reg_prop(fdt, &len); |
| 38 | if (len / sizeof(*val) < ac + sc) |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 39 | return -EINVAL; |
| 40 | |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 41 | val += ac; |
| 42 | |
| 43 | gd->ram_size = sc == 2 ? fdt64_to_cpu(*(fdt64_t *)val) : |
| 44 | fdt32_to_cpu(*val); |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 45 | |
Masahiro Yamada | 11d3ede | 2016-02-26 18:59:45 +0900 | [diff] [blame] | 46 | debug("DRAM size = %08lx\n", (unsigned long)gd->ram_size); |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 47 | |
Masahiro Yamada | 5894ca0 | 2014-10-03 19:21:06 +0900 | [diff] [blame] | 48 | return 0; |
| 49 | } |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 50 | |
| 51 | void dram_init_banksize(void) |
| 52 | { |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 53 | const void *fdt = gd->fdt_blob; |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 54 | const fdt32_t *val; |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 55 | int ac, sc, cells, len, i; |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 56 | |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 57 | val = get_memory_reg_prop(fdt, &len); |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 58 | if (len < 0) |
| 59 | return; |
| 60 | |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 61 | ac = fdt_address_cells(fdt, 0); |
| 62 | sc = fdt_size_cells(fdt, 0); |
| 63 | if (ac < 1 || sc > 2 || sc < 1 || sc > 2) { |
| 64 | printf("invalid address/size cells\n"); |
| 65 | return; |
| 66 | } |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 67 | |
Masahiro Yamada | ac2a103 | 2016-03-29 20:18:45 +0900 | [diff] [blame^] | 68 | cells = ac + sc; |
| 69 | |
| 70 | len /= sizeof(*val); |
| 71 | |
| 72 | for (i = 0; i < CONFIG_NR_DRAM_BANKS && len >= cells; |
| 73 | i++, len -= cells) { |
| 74 | gd->bd->bi_dram[i].start = ac == 2 ? |
| 75 | fdt64_to_cpu(*(fdt64_t *)val) : fdt32_to_cpu(*val); |
| 76 | val += ac; |
| 77 | gd->bd->bi_dram[i].size = sc == 2 ? |
| 78 | fdt64_to_cpu(*(fdt64_t *)val) : fdt32_to_cpu(*val); |
| 79 | val += sc; |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 80 | |
| 81 | debug("DRAM bank %d: start = %08lx, size = %08lx\n", |
Masahiro Yamada | 11d3ede | 2016-02-26 18:59:45 +0900 | [diff] [blame] | 82 | i, (unsigned long)gd->bd->bi_dram[i].start, |
| 83 | (unsigned long)gd->bd->bi_dram[i].size); |
Masahiro Yamada | cf88aff | 2015-09-11 20:17:49 +0900 | [diff] [blame] | 84 | } |
| 85 | } |