145 lines
3.3 KiB
C
145 lines
3.3 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
|
#ifndef _M68K_PAGE_MM_H
|
||
|
|
#define _M68K_PAGE_MM_H
|
||
|
|
|
||
|
|
#ifndef __ASSEMBLY__
|
||
|
|
|
||
|
|
#include <linux/compiler.h>
|
||
|
|
#include <asm/module.h>
|
||
|
|
|
||
|
|
/*
|
||
|
|
* We don't need to check for alignment etc.
|
||
|
|
*/
|
||
|
|
#ifdef CPU_M68040_OR_M68060_ONLY
|
||
|
|
static inline void copy_page(void *to, void *from)
|
||
|
|
{
|
||
|
|
unsigned long tmp;
|
||
|
|
|
||
|
|
__asm__ __volatile__("1:\t"
|
||
|
|
".chip 68040\n\t"
|
||
|
|
"move16 %1@+,%0@+\n\t"
|
||
|
|
"move16 %1@+,%0@+\n\t"
|
||
|
|
".chip 68k\n\t"
|
||
|
|
"dbra %2,1b\n\t"
|
||
|
|
: "=a" (to), "=a" (from), "=d" (tmp)
|
||
|
|
: "0" (to), "1" (from) , "2" (PAGE_SIZE / 32 - 1)
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void clear_page(void *page)
|
||
|
|
{
|
||
|
|
unsigned long tmp;
|
||
|
|
unsigned long *sp = page;
|
||
|
|
|
||
|
|
*sp++ = 0;
|
||
|
|
*sp++ = 0;
|
||
|
|
*sp++ = 0;
|
||
|
|
*sp++ = 0;
|
||
|
|
|
||
|
|
__asm__ __volatile__("1:\t"
|
||
|
|
".chip 68040\n\t"
|
||
|
|
"move16 %2@+,%0@+\n\t"
|
||
|
|
".chip 68k\n\t"
|
||
|
|
"subqw #8,%2\n\t"
|
||
|
|
"subqw #8,%2\n\t"
|
||
|
|
"dbra %1,1b\n\t"
|
||
|
|
: "=a" (sp), "=d" (tmp)
|
||
|
|
: "a" (page), "0" (sp),
|
||
|
|
"1" ((PAGE_SIZE - 16) / 16 - 1));
|
||
|
|
}
|
||
|
|
|
||
|
|
#else
|
||
|
|
#define clear_page(page) memset((page), 0, PAGE_SIZE)
|
||
|
|
#define copy_page(to,from) memcpy((to), (from), PAGE_SIZE)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#define clear_user_page(addr, vaddr, page) \
|
||
|
|
do { clear_page(addr); \
|
||
|
|
flush_dcache_page(page); \
|
||
|
|
} while (0)
|
||
|
|
#define copy_user_page(to, from, vaddr, page) \
|
||
|
|
do { copy_page(to, from); \
|
||
|
|
flush_dcache_page(page); \
|
||
|
|
} while (0)
|
||
|
|
|
||
|
|
extern unsigned long m68k_memoffset;
|
||
|
|
|
||
|
|
#ifndef CONFIG_SUN3
|
||
|
|
|
||
|
|
#define WANT_PAGE_VIRTUAL
|
||
|
|
|
||
|
|
static inline unsigned long ___pa(void *vaddr)
|
||
|
|
{
|
||
|
|
unsigned long paddr;
|
||
|
|
asm (
|
||
|
|
"1: addl #0,%0\n"
|
||
|
|
m68k_fixup(%c2, 1b+2)
|
||
|
|
: "=r" (paddr)
|
||
|
|
: "0" (vaddr), "i" (m68k_fixup_memoffset));
|
||
|
|
return paddr;
|
||
|
|
}
|
||
|
|
#define __pa(vaddr) ___pa((void *)(long)(vaddr))
|
||
|
|
static inline void *__va(unsigned long paddr)
|
||
|
|
{
|
||
|
|
void *vaddr;
|
||
|
|
asm (
|
||
|
|
"1: subl #0,%0\n"
|
||
|
|
m68k_fixup(%c2, 1b+2)
|
||
|
|
: "=r" (vaddr)
|
||
|
|
: "0" (paddr), "i" (m68k_fixup_memoffset));
|
||
|
|
return vaddr;
|
||
|
|
}
|
||
|
|
|
||
|
|
#else /* !CONFIG_SUN3 */
|
||
|
|
/* This #define is a horrible hack to suppress lots of warnings. --m */
|
||
|
|
#define __pa(x) ___pa((unsigned long)(x))
|
||
|
|
static inline unsigned long ___pa(unsigned long x)
|
||
|
|
{
|
||
|
|
if(x == 0)
|
||
|
|
return 0;
|
||
|
|
if(x >= PAGE_OFFSET)
|
||
|
|
return (x-PAGE_OFFSET);
|
||
|
|
else
|
||
|
|
return (x+0x2000000);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void *__va(unsigned long x)
|
||
|
|
{
|
||
|
|
if(x == 0)
|
||
|
|
return (void *)0;
|
||
|
|
|
||
|
|
if(x < 0x2000000)
|
||
|
|
return (void *)(x+PAGE_OFFSET);
|
||
|
|
else
|
||
|
|
return (void *)(x-0x2000000);
|
||
|
|
}
|
||
|
|
#endif /* CONFIG_SUN3 */
|
||
|
|
|
||
|
|
/*
|
||
|
|
* NOTE: virtual isn't really correct, actually it should be the offset into the
|
||
|
|
* memory node, but we have no highmem, so that works for now.
|
||
|
|
* TODO: implement (fast) pfn<->pgdat_idx conversion functions, this makes lots
|
||
|
|
* of the shifts unnecessary.
|
||
|
|
*/
|
||
|
|
#define virt_to_pfn(kaddr) (__pa(kaddr) >> PAGE_SHIFT)
|
||
|
|
#define pfn_to_virt(pfn) __va((pfn) << PAGE_SHIFT)
|
||
|
|
|
||
|
|
extern int m68k_virt_to_node_shift;
|
||
|
|
|
||
|
|
#define virt_to_page(addr) ({ \
|
||
|
|
pfn_to_page(virt_to_pfn(addr)); \
|
||
|
|
})
|
||
|
|
#define page_to_virt(page) ({ \
|
||
|
|
pfn_to_virt(page_to_pfn(page)); \
|
||
|
|
})
|
||
|
|
|
||
|
|
#define ARCH_PFN_OFFSET (m68k_memory[0].addr >> PAGE_SHIFT)
|
||
|
|
#include <asm-generic/memory_model.h>
|
||
|
|
|
||
|
|
#define virt_addr_valid(kaddr) ((unsigned long)(kaddr) >= PAGE_OFFSET && (unsigned long)(kaddr) < (unsigned long)high_memory)
|
||
|
|
#define pfn_valid(pfn) virt_addr_valid(pfn_to_virt(pfn))
|
||
|
|
|
||
|
|
#endif /* __ASSEMBLY__ */
|
||
|
|
|
||
|
|
#endif /* _M68K_PAGE_MM_H */
|