ARM: uniphier: adjust dram_init() and dram_init_banksize() for ARM64
Currently, these functions assume #address-cells and #size-cells are both one. Fix them to support 64bit DTB. Also, I am fixing a buffer overrun bug while I am here. The array size of gd->bd->bd_dram is CONFIG_NR_DRAM_BANKS. The number of iteration in the loop should be limited by that CONFIG. Signed-off-by: Masahiro Yamada <yamada.masahiro@socionext.com>
This commit is contained in:
parent
15826e7e70
commit
ac2a1030e3
|
|
@ -23,14 +23,25 @@ static const void *get_memory_reg_prop(const void *fdt, int *lenp)
|
||||||
|
|
||||||
int dram_init(void)
|
int dram_init(void)
|
||||||
{
|
{
|
||||||
|
const void *fdt = gd->fdt_blob;
|
||||||
const fdt32_t *val;
|
const fdt32_t *val;
|
||||||
int len;
|
int ac, sc, len;
|
||||||
|
|
||||||
val = get_memory_reg_prop(gd->fdt_blob, &len);
|
ac = fdt_address_cells(fdt, 0);
|
||||||
if (len < sizeof(*val))
|
sc = fdt_size_cells(fdt, 0);
|
||||||
|
if (ac < 0 || sc < 1 || sc > 2) {
|
||||||
|
printf("invalid address/size cells\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
val = get_memory_reg_prop(fdt, &len);
|
||||||
|
if (len / sizeof(*val) < ac + sc)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
gd->ram_size = fdt32_to_cpu(*(val + 1));
|
val += ac;
|
||||||
|
|
||||||
|
gd->ram_size = sc == 2 ? fdt64_to_cpu(*(fdt64_t *)val) :
|
||||||
|
fdt32_to_cpu(*val);
|
||||||
|
|
||||||
debug("DRAM size = %08lx\n", (unsigned long)gd->ram_size);
|
debug("DRAM size = %08lx\n", (unsigned long)gd->ram_size);
|
||||||
|
|
||||||
|
|
@ -39,19 +50,33 @@ int dram_init(void)
|
||||||
|
|
||||||
void dram_init_banksize(void)
|
void dram_init_banksize(void)
|
||||||
{
|
{
|
||||||
|
const void *fdt = gd->fdt_blob;
|
||||||
const fdt32_t *val;
|
const fdt32_t *val;
|
||||||
int len, i;
|
int ac, sc, cells, len, i;
|
||||||
|
|
||||||
val = get_memory_reg_prop(gd->fdt_blob, &len);
|
val = get_memory_reg_prop(fdt, &len);
|
||||||
if (len < 0)
|
if (len < 0)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
len /= sizeof(*val);
|
ac = fdt_address_cells(fdt, 0);
|
||||||
len /= 2;
|
sc = fdt_size_cells(fdt, 0);
|
||||||
|
if (ac < 1 || sc > 2 || sc < 1 || sc > 2) {
|
||||||
|
printf("invalid address/size cells\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
for (i = 0; i < len; i++) {
|
cells = ac + sc;
|
||||||
gd->bd->bi_dram[i].start = fdt32_to_cpu(*val++);
|
|
||||||
gd->bd->bi_dram[i].size = fdt32_to_cpu(*val++);
|
len /= sizeof(*val);
|
||||||
|
|
||||||
|
for (i = 0; i < CONFIG_NR_DRAM_BANKS && len >= cells;
|
||||||
|
i++, len -= cells) {
|
||||||
|
gd->bd->bi_dram[i].start = ac == 2 ?
|
||||||
|
fdt64_to_cpu(*(fdt64_t *)val) : fdt32_to_cpu(*val);
|
||||||
|
val += ac;
|
||||||
|
gd->bd->bi_dram[i].size = sc == 2 ?
|
||||||
|
fdt64_to_cpu(*(fdt64_t *)val) : fdt32_to_cpu(*val);
|
||||||
|
val += sc;
|
||||||
|
|
||||||
debug("DRAM bank %d: start = %08lx, size = %08lx\n",
|
debug("DRAM bank %d: start = %08lx, size = %08lx\n",
|
||||||
i, (unsigned long)gd->bd->bi_dram[i].start,
|
i, (unsigned long)gd->bd->bi_dram[i].start,
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue