162306a36Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
262306a36Sopenharmony_ci#ifndef _M68K_PAGE_MM_H
362306a36Sopenharmony_ci#define _M68K_PAGE_MM_H
462306a36Sopenharmony_ci
562306a36Sopenharmony_ci#ifndef __ASSEMBLY__
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include <linux/compiler.h>
862306a36Sopenharmony_ci#include <asm/module.h>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci/*
1162306a36Sopenharmony_ci * We don't need to check for alignment etc.
1262306a36Sopenharmony_ci */
1362306a36Sopenharmony_ci#ifdef CPU_M68040_OR_M68060_ONLY
1462306a36Sopenharmony_cistatic inline void copy_page(void *to, void *from)
1562306a36Sopenharmony_ci{
1662306a36Sopenharmony_ci  unsigned long tmp;
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci  __asm__ __volatile__("1:\t"
1962306a36Sopenharmony_ci		       ".chip 68040\n\t"
2062306a36Sopenharmony_ci		       "move16 %1@+,%0@+\n\t"
2162306a36Sopenharmony_ci		       "move16 %1@+,%0@+\n\t"
2262306a36Sopenharmony_ci		       ".chip 68k\n\t"
2362306a36Sopenharmony_ci		       "dbra  %2,1b\n\t"
2462306a36Sopenharmony_ci		       : "=a" (to), "=a" (from), "=d" (tmp)
2562306a36Sopenharmony_ci		       : "0" (to), "1" (from) , "2" (PAGE_SIZE / 32 - 1)
2662306a36Sopenharmony_ci		       );
2762306a36Sopenharmony_ci}
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_cistatic inline void clear_page(void *page)
3062306a36Sopenharmony_ci{
3162306a36Sopenharmony_ci	unsigned long tmp;
3262306a36Sopenharmony_ci	unsigned long *sp = page;
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci	*sp++ = 0;
3562306a36Sopenharmony_ci	*sp++ = 0;
3662306a36Sopenharmony_ci	*sp++ = 0;
3762306a36Sopenharmony_ci	*sp++ = 0;
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci	__asm__ __volatile__("1:\t"
4062306a36Sopenharmony_ci			     ".chip 68040\n\t"
4162306a36Sopenharmony_ci			     "move16 %2@+,%0@+\n\t"
4262306a36Sopenharmony_ci			     ".chip 68k\n\t"
4362306a36Sopenharmony_ci			     "subqw  #8,%2\n\t"
4462306a36Sopenharmony_ci			     "subqw  #8,%2\n\t"
4562306a36Sopenharmony_ci			     "dbra   %1,1b\n\t"
4662306a36Sopenharmony_ci			     : "=a" (sp), "=d" (tmp)
4762306a36Sopenharmony_ci			     : "a" (page), "0" (sp),
4862306a36Sopenharmony_ci			       "1" ((PAGE_SIZE - 16) / 16 - 1));
4962306a36Sopenharmony_ci}
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci#else
5262306a36Sopenharmony_ci#define clear_page(page)	memset((page), 0, PAGE_SIZE)
5362306a36Sopenharmony_ci#define copy_page(to,from)	memcpy((to), (from), PAGE_SIZE)
5462306a36Sopenharmony_ci#endif
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci#define clear_user_page(addr, vaddr, page)	\
5762306a36Sopenharmony_ci	do {	clear_page(addr);		\
5862306a36Sopenharmony_ci		flush_dcache_page(page);	\
5962306a36Sopenharmony_ci	} while (0)
6062306a36Sopenharmony_ci#define copy_user_page(to, from, vaddr, page)	\
6162306a36Sopenharmony_ci	do {	copy_page(to, from);		\
6262306a36Sopenharmony_ci		flush_dcache_page(page);	\
6362306a36Sopenharmony_ci	} while (0)
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ciextern unsigned long m68k_memoffset;
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci#ifndef CONFIG_SUN3
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci#define WANT_PAGE_VIRTUAL
7062306a36Sopenharmony_ci
7162306a36Sopenharmony_cistatic inline unsigned long ___pa(void *vaddr)
7262306a36Sopenharmony_ci{
7362306a36Sopenharmony_ci	unsigned long paddr;
7462306a36Sopenharmony_ci	asm (
7562306a36Sopenharmony_ci		"1:	addl #0,%0\n"
7662306a36Sopenharmony_ci		m68k_fixup(%c2, 1b+2)
7762306a36Sopenharmony_ci		: "=r" (paddr)
7862306a36Sopenharmony_ci		: "0" (vaddr), "i" (m68k_fixup_memoffset));
7962306a36Sopenharmony_ci	return paddr;
8062306a36Sopenharmony_ci}
8162306a36Sopenharmony_ci#define __pa(vaddr)	___pa((void *)(long)(vaddr))
8262306a36Sopenharmony_cistatic inline void *__va(unsigned long paddr)
8362306a36Sopenharmony_ci{
8462306a36Sopenharmony_ci	void *vaddr;
8562306a36Sopenharmony_ci	asm (
8662306a36Sopenharmony_ci		"1:	subl #0,%0\n"
8762306a36Sopenharmony_ci		m68k_fixup(%c2, 1b+2)
8862306a36Sopenharmony_ci		: "=r" (vaddr)
8962306a36Sopenharmony_ci		: "0" (paddr), "i" (m68k_fixup_memoffset));
9062306a36Sopenharmony_ci	return vaddr;
9162306a36Sopenharmony_ci}
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci#else	/* !CONFIG_SUN3 */
9462306a36Sopenharmony_ci/* This #define is a horrible hack to suppress lots of warnings. --m */
9562306a36Sopenharmony_ci#define __pa(x) ___pa((unsigned long)(x))
9662306a36Sopenharmony_cistatic inline unsigned long ___pa(unsigned long x)
9762306a36Sopenharmony_ci{
9862306a36Sopenharmony_ci     if(x == 0)
9962306a36Sopenharmony_ci	  return 0;
10062306a36Sopenharmony_ci     if(x >= PAGE_OFFSET)
10162306a36Sopenharmony_ci        return (x-PAGE_OFFSET);
10262306a36Sopenharmony_ci     else
10362306a36Sopenharmony_ci        return (x+0x2000000);
10462306a36Sopenharmony_ci}
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_cistatic inline void *__va(unsigned long x)
10762306a36Sopenharmony_ci{
10862306a36Sopenharmony_ci     if(x == 0)
10962306a36Sopenharmony_ci	  return (void *)0;
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci     if(x < 0x2000000)
11262306a36Sopenharmony_ci        return (void *)(x+PAGE_OFFSET);
11362306a36Sopenharmony_ci     else
11462306a36Sopenharmony_ci        return (void *)(x-0x2000000);
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci#endif	/* CONFIG_SUN3 */
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci/*
11962306a36Sopenharmony_ci * NOTE: virtual isn't really correct, actually it should be the offset into the
12062306a36Sopenharmony_ci * memory node, but we have no highmem, so that works for now.
12162306a36Sopenharmony_ci * TODO: implement (fast) pfn<->pgdat_idx conversion functions, this makes lots
12262306a36Sopenharmony_ci * of the shifts unnecessary.
12362306a36Sopenharmony_ci */
12462306a36Sopenharmony_cistatic inline unsigned long virt_to_pfn(const void *kaddr)
12562306a36Sopenharmony_ci{
12662306a36Sopenharmony_ci	return __pa(kaddr) >> PAGE_SHIFT;
12762306a36Sopenharmony_ci}
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_cistatic inline void *pfn_to_virt(unsigned long pfn)
13062306a36Sopenharmony_ci{
13162306a36Sopenharmony_ci	return __va(pfn << PAGE_SHIFT);
13262306a36Sopenharmony_ci}
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_ciextern int m68k_virt_to_node_shift;
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci#define virt_to_page(addr) ({						\
13762306a36Sopenharmony_ci	pfn_to_page(virt_to_pfn(addr));					\
13862306a36Sopenharmony_ci})
13962306a36Sopenharmony_ci#define page_to_virt(page) ({						\
14062306a36Sopenharmony_ci	pfn_to_virt(page_to_pfn(page));					\
14162306a36Sopenharmony_ci})
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci#define ARCH_PFN_OFFSET (m68k_memory[0].addr >> PAGE_SHIFT)
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci#define virt_addr_valid(kaddr)	((unsigned long)(kaddr) >= PAGE_OFFSET && (unsigned long)(kaddr) < (unsigned long)high_memory)
14662306a36Sopenharmony_ci#define pfn_valid(pfn)		virt_addr_valid(pfn_to_virt(pfn))
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci#endif /* __ASSEMBLY__ */
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci#endif /* _M68K_PAGE_MM_H */
151