162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (C) 2007 Felix Fietkau <nbd@openwrt.org> 462306a36Sopenharmony_ci * Copyright (C) 2007 Eugene Konev <ejka@openwrt.org> 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci#include <linux/memblock.h> 762306a36Sopenharmony_ci#include <linux/init.h> 862306a36Sopenharmony_ci#include <linux/mm.h> 962306a36Sopenharmony_ci#include <linux/pfn.h> 1062306a36Sopenharmony_ci#include <linux/proc_fs.h> 1162306a36Sopenharmony_ci#include <linux/string.h> 1262306a36Sopenharmony_ci#include <linux/swap.h> 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#include <asm/bootinfo.h> 1562306a36Sopenharmony_ci#include <asm/page.h> 1662306a36Sopenharmony_ci#include <asm/sections.h> 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci#include <asm/mach-ar7/ar7.h> 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_cistatic int __init memsize(void) 2162306a36Sopenharmony_ci{ 2262306a36Sopenharmony_ci u32 size = (64 << 20); 2362306a36Sopenharmony_ci u32 *addr = (u32 *)KSEG1ADDR(AR7_SDRAM_BASE + size - 4); 2462306a36Sopenharmony_ci u32 *kernel_end = (u32 *)KSEG1ADDR(CPHYSADDR((u32)&_end)); 2562306a36Sopenharmony_ci u32 *tmpaddr = addr; 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci while (tmpaddr > kernel_end) { 2862306a36Sopenharmony_ci *tmpaddr = (u32)tmpaddr; 2962306a36Sopenharmony_ci size >>= 1; 3062306a36Sopenharmony_ci tmpaddr -= size >> 2; 3162306a36Sopenharmony_ci } 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci do { 3462306a36Sopenharmony_ci tmpaddr += size >> 2; 3562306a36Sopenharmony_ci if (*tmpaddr != (u32)tmpaddr) 3662306a36Sopenharmony_ci break; 3762306a36Sopenharmony_ci size <<= 1; 3862306a36Sopenharmony_ci } while (size < (64 << 20)); 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_ci writel((u32)tmpaddr, &addr); 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci return size; 4362306a36Sopenharmony_ci} 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_civoid __init prom_meminit(void) 4662306a36Sopenharmony_ci{ 4762306a36Sopenharmony_ci unsigned long pages; 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci pages = memsize() >> PAGE_SHIFT; 5062306a36Sopenharmony_ci memblock_add(PHYS_OFFSET, pages << PAGE_SHIFT); 5162306a36Sopenharmony_ci} 52