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