| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * Copyright (c) 2024, Kongyang Liu <seashell11234455@gmail.com> |
| */ |
| |
| #include <asm/global_data.h> |
| #include <asm/io.h> |
| #include <config.h> |
| #include <bitfield.h> |
| #include <fdt_support.h> |
| #include <linux/sizes.h> |
| |
| #define DDR_BASE 0xC0000000 |
| DECLARE_GLOBAL_DATA_PTR; |
| |
| static phys_size_t ddr_map_size(u32 val) |
| { |
| u32 tmp; |
| |
| if (!(val & 0x1)) |
| return 0; |
| |
| tmp = bitfield_extract(val, 16, 5); |
| switch (tmp) { |
| case 0xd: |
| return 512; |
| case 0xe: |
| return 1024; |
| case 0xf: |
| return 2048; |
| case 0x10: |
| return 4096; |
| case 0x11: |
| return 8192; |
| default: |
| pr_info("Invalid DRAM density %x\n", val); |
| return 0; |
| } |
| } |
| |
| phys_size_t ddr_get_density(void) |
| { |
| phys_size_t cs0_size = ddr_map_size(readl((void *)DDR_BASE + 0x200)); |
| phys_size_t cs1_size = ddr_map_size(readl((void *)DDR_BASE + 0x208)); |
| phys_size_t ddr_size = cs0_size + cs1_size; |
| |
| return ddr_size; |
| } |
| |
| int dram_init(void) |
| { |
| gd->ram_base = CFG_SYS_SDRAM_BASE; |
| gd->ram_size = ddr_get_density() * SZ_1M; |
| return 0; |
| } |
| |
| int dram_init_banksize(void) |
| { |
| gd->bd->bi_dram[0].start = CFG_SYS_SDRAM_BASE; |
| gd->bd->bi_dram[0].size = min_t(phys_size_t, gd->ram_size, SZ_2G); |
| |
| if (gd->ram_size > SZ_2G && CONFIG_NR_DRAM_BANKS > 1) { |
| gd->bd->bi_dram[1].start = 0x100000000; |
| gd->bd->bi_dram[1].size = gd->ram_size - SZ_2G; |
| } |
| |
| return 0; |
| } |
| |
| phys_addr_t board_get_usable_ram_top(phys_size_t total_size) |
| { |
| if (gd->ram_size > SZ_2G) |
| return SZ_2G; |
| |
| return gd->ram_size; |
| } |
| |
| int ft_board_setup(void *blob, struct bd_info *bd) |
| { |
| u64 start[CONFIG_NR_DRAM_BANKS]; |
| u64 size[CONFIG_NR_DRAM_BANKS]; |
| int i; |
| |
| for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { |
| start[i] = gd->bd->bi_dram[i].start; |
| size[i] = gd->bd->bi_dram[i].size; |
| } |
| |
| return fdt_fixup_memory_banks(blob, start, size, CONFIG_NR_DRAM_BANKS); |
| } |