arch/s390/mm/pageattr.c - kernel/msm-4.9 - Gitiles

 /*
  * Copyright IBM Corp. 2011
  * Author(s): Jan Glauber <jang@linux.vnet.ibm.com>
  */
 #include <linux/hugetlb.h>
 #include <linux/module.h>
 #include <linux/mm.h>
 #include <asm/cacheflush.h>
 #include <asm/facility.h>
 #include <asm/pgtable.h>
 #include <asm/page.h>

 static inline unsigned long sske_frame(unsigned long addr, unsigned char skey)
 {
 	asm volatile(".insn rrf,0xb22b0000,%[skey],%[addr],9,0"
 		     : [addr] "+a" (addr) : [skey] "d" (skey));
 	return addr;
 }

 void __storage_key_init_range(unsigned long start, unsigned long end)
 {
 	unsigned long boundary, size;

 	if (!PAGE_DEFAULT_KEY)
 		return;
 	while (start < end) {
 		if (MACHINE_HAS_EDAT1) {
 			/* set storage keys for a 1MB frame */
 			size = 1UL << 20;
 			boundary = (start + size) & ~(size - 1);
 			if (boundary <= end) {
 				do {
 					start = sske_frame(start, PAGE_DEFAULT_KEY);
 				} while (start < boundary);
 				continue;
 			}
 		}
 		page_set_storage_key(start, PAGE_DEFAULT_KEY, 0);
 		start += PAGE_SIZE;
 	}
 }

 #ifdef CONFIG_PROC_FS
 atomic_long_t direct_pages_count[PG_DIRECT_MAP_MAX];

 void arch_report_meminfo(struct seq_file *m)
 {
 	seq_printf(m, "DirectMap4k:    %8lu kB\n",
 		   atomic_long_read(&direct_pages_count[PG_DIRECT_MAP_4K]) << 2);
 	seq_printf(m, "DirectMap1M:    %8lu kB\n",
 		   atomic_long_read(&direct_pages_count[PG_DIRECT_MAP_1M]) << 10);
 	seq_printf(m, "DirectMap2G:    %8lu kB\n",
 		   atomic_long_read(&direct_pages_count[PG_DIRECT_MAP_2G]) << 21);
 }
 #endif /* CONFIG_PROC_FS */

 static void pgt_set(unsigned long *old, unsigned long new, unsigned long addr,
 		    unsigned long dtt)
 {
 	unsigned long table, mask;

 	mask = 0;
 	if (MACHINE_HAS_EDAT2) {
 		switch (dtt) {
 		case CRDTE_DTT_REGION3:
 			mask = ~(PTRS_PER_PUD * sizeof(pud_t) - 1);
 			break;
 		case CRDTE_DTT_SEGMENT:
 			mask = ~(PTRS_PER_PMD * sizeof(pmd_t) - 1);
 			break;
 		case CRDTE_DTT_PAGE:
 			mask = ~(PTRS_PER_PTE * sizeof(pte_t) - 1);
 			break;
 		}
 		table = (unsigned long)old & mask;
 		crdte(*old, new, table, dtt, addr, S390_lowcore.kernel_asce);
 	} else if (MACHINE_HAS_IDTE) {
 		cspg(old, *old, new);
 	} else {
 		csp((unsigned int *)old + 1, *old, new);
 	}
 }

 struct cpa {
 	unsigned int set_ro	: 1;
 	unsigned int clear_ro	: 1;
 };

 static int walk_pte_level(pmd_t *pmdp, unsigned long addr, unsigned long end,
 			  struct cpa cpa)
 {
 	pte_t *ptep, new;

 	ptep = pte_offset(pmdp, addr);
 	do {
 		if (pte_none(*ptep))
 			return -EINVAL;
 		if (cpa.set_ro)
 			new = pte_wrprotect(*ptep);
 		else if (cpa.clear_ro)
 			new = pte_mkwrite(pte_mkdirty(*ptep));
 		pgt_set((unsigned long *)ptep, pte_val(new), addr, CRDTE_DTT_PAGE);
 		ptep++;
 		addr += PAGE_SIZE;
 		cond_resched();
 	} while (addr < end);
 	return 0;
 }

 static int split_pmd_page(pmd_t *pmdp, unsigned long addr)
 {
 	unsigned long pte_addr, prot;
 	pte_t *pt_dir, *ptep;
 	pmd_t new;
 	int i, ro;

 	pt_dir = vmem_pte_alloc();
 	if (!pt_dir)
 		return -ENOMEM;
 	pte_addr = pmd_pfn(*pmdp) << PAGE_SHIFT;
 	ro = !!(pmd_val(*pmdp) & _SEGMENT_ENTRY_PROTECT);
 	prot = pgprot_val(ro ? PAGE_KERNEL_RO : PAGE_KERNEL);
 	ptep = pt_dir;
 	for (i = 0; i < PTRS_PER_PTE; i++) {
 		pte_val(*ptep) = pte_addr | prot;
 		pte_addr += PAGE_SIZE;
 		ptep++;
 	}
 	pmd_val(new) = __pa(pt_dir) | _SEGMENT_ENTRY;
 	pgt_set((unsigned long *)pmdp, pmd_val(new), addr, CRDTE_DTT_SEGMENT);
 	update_page_count(PG_DIRECT_MAP_4K, PTRS_PER_PTE);
 	update_page_count(PG_DIRECT_MAP_1M, -1);
 	return 0;
 }

 static void modify_pmd_page(pmd_t *pmdp, unsigned long addr, struct cpa cpa)
 {
 	pmd_t new;

 	if (cpa.set_ro)
 		new = pmd_wrprotect(*pmdp);
 	else if (cpa.clear_ro)
 		new = pmd_mkwrite(pmd_mkdirty(*pmdp));
 	pgt_set((unsigned long *)pmdp, pmd_val(new), addr, CRDTE_DTT_SEGMENT);
 }

 static int walk_pmd_level(pud_t *pudp, unsigned long addr, unsigned long end,
 			  struct cpa cpa)
 {
 	unsigned long next;
 	pmd_t *pmdp;
 	int rc = 0;

 	pmdp = pmd_offset(pudp, addr);
 	do {
 		if (pmd_none(*pmdp))
 			return -EINVAL;
 		next = pmd_addr_end(addr, end);
 		if (pmd_large(*pmdp)) {
 			if (addr & ~PMD_MASK || addr + PMD_SIZE > next) {
 				rc = split_pmd_page(pmdp, addr);
 				if (rc)
 					return rc;
 				continue;
 			}
 			modify_pmd_page(pmdp, addr, cpa);
 		} else {
 			rc = walk_pte_level(pmdp, addr, next, cpa);
 			if (rc)
 				return rc;
 		}
 		pmdp++;
 		addr = next;
 		cond_resched();
 	} while (addr < end);
 	return rc;
 }

 static int split_pud_page(pud_t *pudp, unsigned long addr)
 {
 	unsigned long pmd_addr, prot;
 	pmd_t *pm_dir, *pmdp;
 	pud_t new;
 	int i, ro;

 	pm_dir = vmem_pmd_alloc();
 	if (!pm_dir)
 		return -ENOMEM;
 	pmd_addr = pud_pfn(*pudp) << PAGE_SHIFT;
 	ro = !!(pud_val(*pudp) & _REGION_ENTRY_PROTECT);
 	prot = pgprot_val(ro ? SEGMENT_KERNEL_RO : SEGMENT_KERNEL);
 	pmdp = pm_dir;
 	for (i = 0; i < PTRS_PER_PMD; i++) {
 		pmd_val(*pmdp) = pmd_addr | prot;
 		pmd_addr += PMD_SIZE;
 		pmdp++;
 	}
 	pud_val(new) = __pa(pm_dir) | _REGION3_ENTRY;
 	pgt_set((unsigned long *)pudp, pud_val(new), addr, CRDTE_DTT_REGION3);
 	update_page_count(PG_DIRECT_MAP_1M, PTRS_PER_PMD);
 	update_page_count(PG_DIRECT_MAP_2G, -1);
 	return 0;
 }

 static void modify_pud_page(pud_t *pudp, unsigned long addr, struct cpa cpa)
 {
 	pud_t new;

 	if (cpa.set_ro)
 		new = pud_wrprotect(*pudp);
 	else if (cpa.clear_ro)
 		new = pud_mkwrite(pud_mkdirty(*pudp));
 	pgt_set((unsigned long *)pudp, pud_val(new), addr, CRDTE_DTT_REGION3);
 }

 static int walk_pud_level(pgd_t *pgd, unsigned long addr, unsigned long end,
 			  struct cpa cpa)
 {
 	unsigned long next;
 	pud_t *pudp;
 	int rc = 0;

 	pudp = pud_offset(pgd, addr);
 	do {
 		if (pud_none(*pudp))
 			return -EINVAL;
 		next = pud_addr_end(addr, end);
 		if (pud_large(*pudp)) {
 			if (addr & ~PUD_MASK || addr + PUD_SIZE > next) {
 				rc = split_pud_page(pudp, addr);
 				if (rc)
 					break;
 				continue;
 			}
 			modify_pud_page(pudp, addr, cpa);
 		} else {
 			rc = walk_pmd_level(pudp, addr, next, cpa);
 		}
 		pudp++;
 		addr = next;
 		cond_resched();
 	} while (addr < end && !rc);
 	return rc;
 }

 static DEFINE_MUTEX(cpa_mutex);

 static int change_page_attr(unsigned long addr, unsigned long end,
 			    struct cpa cpa)
 {
 	unsigned long next;
 	int rc = -EINVAL;
 	pgd_t *pgdp;

 	if (addr == end)
 		return 0;
 	if (end >= MODULES_END)
 		return -EINVAL;
 	mutex_lock(&cpa_mutex);
 	pgdp = pgd_offset_k(addr);
 	do {
 		if (pgd_none(*pgdp))
 			break;
 		next = pgd_addr_end(addr, end);
 		rc = walk_pud_level(pgdp, addr, next, cpa);
 		if (rc)
 			break;
 		cond_resched();
 	} while (pgdp++, addr = next, addr < end && !rc);
 	mutex_unlock(&cpa_mutex);
 	return rc;
 }

 int set_memory_ro(unsigned long addr, int numpages)
 {
 	struct cpa cpa = {
 		.set_ro = 1,
 	};

 	addr &= PAGE_MASK;
 	return change_page_attr(addr, addr + numpages * PAGE_SIZE, cpa);
 }

 int set_memory_rw(unsigned long addr, int numpages)
 {
 	struct cpa cpa = {
 		.clear_ro = 1,
 	};

 	addr &= PAGE_MASK;
 	return change_page_attr(addr, addr + numpages * PAGE_SIZE, cpa);
 }

 /* not possible */
 int set_memory_nx(unsigned long addr, int numpages)
 {
 	return 0;
 }

 int set_memory_x(unsigned long addr, int numpages)
 {
 	return 0;
 }

 #ifdef CONFIG_DEBUG_PAGEALLOC

 static void ipte_range(pte_t *pte, unsigned long address, int nr)
 {
 	int i;

 	if (test_facility(13)) {
 		__ptep_ipte_range(address, nr - 1, pte, IPTE_GLOBAL);
 		return;
 	}
 	for (i = 0; i < nr; i++) {
 		__ptep_ipte(address, pte, IPTE_GLOBAL);
 		address += PAGE_SIZE;
 		pte++;
 	}
 }

 void __kernel_map_pages(struct page *page, int numpages, int enable)
 {
 	unsigned long address;
 	int nr, i, j;
 	pgd_t *pgd;
 	pud_t *pud;
 	pmd_t *pmd;
 	pte_t *pte;

 	for (i = 0; i < numpages;) {
 		address = page_to_phys(page + i);
 		pgd = pgd_offset_k(address);
 		pud = pud_offset(pgd, address);
 		pmd = pmd_offset(pud, address);
 		pte = pte_offset_kernel(pmd, address);
 		nr = (unsigned long)pte >> ilog2(sizeof(long));
 		nr = PTRS_PER_PTE - (nr & (PTRS_PER_PTE - 1));
 		nr = min(numpages - i, nr);
 		if (enable) {
 			for (j = 0; j < nr; j++) {
 				pte_val(*pte) = address | pgprot_val(PAGE_KERNEL);
 				address += PAGE_SIZE;
 				pte++;
 			}
 		} else {
 			ipte_range(pte, address, nr);
 		}
 		i += nr;
 	}
 }

 #ifdef CONFIG_HIBERNATION
 bool kernel_page_present(struct page *page)
 {
 	unsigned long addr;
 	int cc;

 	addr = page_to_phys(page);
 	asm volatile(
 		"	lra	%1,0(%1)\n"
 		"	ipm	%0\n"
 		"	srl	%0,28"
 		: "=d" (cc), "+a" (addr) : : "cc");
 	return cc == 0;
 }
 #endif /* CONFIG_HIBERNATION */

 #endif /* CONFIG_DEBUG_PAGEALLOC */
	/*
	* Copyright IBM Corp. 2011
	* Author(s): Jan Glauber <jang@linux.vnet.ibm.com>
	*/
	#include <linux/hugetlb.h>
	#include <linux/module.h>
	#include <linux/mm.h>
	#include <asm/cacheflush.h>
	#include <asm/facility.h>
	#include <asm/pgtable.h>
	#include <asm/page.h>

	static inline unsigned long sske_frame(unsigned long addr, unsigned char skey)
	{
	asm volatile(".insn rrf,0xb22b0000,%[skey],%[addr],9,0"
	: [addr] "+a" (addr) : [skey] "d" (skey));
	return addr;
	}

	void __storage_key_init_range(unsigned long start, unsigned long end)
	{
	unsigned long boundary, size;

	if (!PAGE_DEFAULT_KEY)
	return;
	while (start < end) {
	if (MACHINE_HAS_EDAT1) {
	/* set storage keys for a 1MB frame */
	size = 1UL << 20;
	boundary = (start + size) & ~(size - 1);
	if (boundary <= end) {
	do {
	start = sske_frame(start, PAGE_DEFAULT_KEY);
	} while (start < boundary);
	continue;
	}
	}
	page_set_storage_key(start, PAGE_DEFAULT_KEY, 0);
	start += PAGE_SIZE;
	}
	}

	#ifdef CONFIG_PROC_FS
	atomic_long_t direct_pages_count[PG_DIRECT_MAP_MAX];

	void arch_report_meminfo(struct seq_file *m)
	{
	seq_printf(m, "DirectMap4k: %8lu kB\n",
	atomic_long_read(&direct_pages_count[PG_DIRECT_MAP_4K]) << 2);
	seq_printf(m, "DirectMap1M: %8lu kB\n",
	atomic_long_read(&direct_pages_count[PG_DIRECT_MAP_1M]) << 10);
	seq_printf(m, "DirectMap2G: %8lu kB\n",
	atomic_long_read(&direct_pages_count[PG_DIRECT_MAP_2G]) << 21);
	}
	#endif /* CONFIG_PROC_FS */

	static void pgt_set(unsigned long *old, unsigned long new, unsigned long addr,
	unsigned long dtt)
	{
	unsigned long table, mask;

	mask = 0;
	if (MACHINE_HAS_EDAT2) {
	switch (dtt) {
	case CRDTE_DTT_REGION3:
	mask = ~(PTRS_PER_PUD * sizeof(pud_t) - 1);
	break;
	case CRDTE_DTT_SEGMENT:
	mask = ~(PTRS_PER_PMD * sizeof(pmd_t) - 1);
	break;
	case CRDTE_DTT_PAGE:
	mask = ~(PTRS_PER_PTE * sizeof(pte_t) - 1);
	break;
	}
	table = (unsigned long)old & mask;
	crdte(*old, new, table, dtt, addr, S390_lowcore.kernel_asce);
	} else if (MACHINE_HAS_IDTE) {
	cspg(old, *old, new);
	} else {
	csp((unsigned int )old + 1, old, new);
	}
	}

	struct cpa {
	unsigned int set_ro : 1;
	unsigned int clear_ro : 1;
	};

	static int walk_pte_level(pmd_t *pmdp, unsigned long addr, unsigned long end,
	struct cpa cpa)
	{
	pte_t *ptep, new;

	ptep = pte_offset(pmdp, addr);
	do {
	if (pte_none(*ptep))
	return -EINVAL;
	if (cpa.set_ro)
	new = pte_wrprotect(*ptep);
	else if (cpa.clear_ro)
	new = pte_mkwrite(pte_mkdirty(*ptep));
	pgt_set((unsigned long *)ptep, pte_val(new), addr, CRDTE_DTT_PAGE);
	ptep++;
	addr += PAGE_SIZE;
	cond_resched();
	} while (addr < end);
	return 0;
	}

	static int split_pmd_page(pmd_t *pmdp, unsigned long addr)
	{
	unsigned long pte_addr, prot;
	pte_t pt_dir, ptep;
	pmd_t new;
	int i, ro;

	pt_dir = vmem_pte_alloc();
	if (!pt_dir)
	return -ENOMEM;
	pte_addr = pmd_pfn(*pmdp) << PAGE_SHIFT;
	ro = !!(pmd_val(*pmdp) & _SEGMENT_ENTRY_PROTECT);
	prot = pgprot_val(ro ? PAGE_KERNEL_RO : PAGE_KERNEL);
	ptep = pt_dir;
	for (i = 0; i < PTRS_PER_PTE; i++) {
	pte_val(*ptep) = pte_addr \| prot;
	pte_addr += PAGE_SIZE;
	ptep++;
	}
	pmd_val(new) = __pa(pt_dir) \| _SEGMENT_ENTRY;
	pgt_set((unsigned long *)pmdp, pmd_val(new), addr, CRDTE_DTT_SEGMENT);
	update_page_count(PG_DIRECT_MAP_4K, PTRS_PER_PTE);
	update_page_count(PG_DIRECT_MAP_1M, -1);
	return 0;
	}

	static void modify_pmd_page(pmd_t *pmdp, unsigned long addr, struct cpa cpa)
	{
	pmd_t new;

	if (cpa.set_ro)
	new = pmd_wrprotect(*pmdp);
	else if (cpa.clear_ro)
	new = pmd_mkwrite(pmd_mkdirty(*pmdp));
	pgt_set((unsigned long *)pmdp, pmd_val(new), addr, CRDTE_DTT_SEGMENT);
	}

	static int walk_pmd_level(pud_t *pudp, unsigned long addr, unsigned long end,
	struct cpa cpa)
	{
	unsigned long next;
	pmd_t *pmdp;
	int rc = 0;

	pmdp = pmd_offset(pudp, addr);
	do {
	if (pmd_none(*pmdp))
	return -EINVAL;
	next = pmd_addr_end(addr, end);
	if (pmd_large(*pmdp)) {
	if (addr & ~PMD_MASK \|\| addr + PMD_SIZE > next) {
	rc = split_pmd_page(pmdp, addr);
	if (rc)
	return rc;
	continue;
	}
	modify_pmd_page(pmdp, addr, cpa);
	} else {
	rc = walk_pte_level(pmdp, addr, next, cpa);
	if (rc)
	return rc;
	}
	pmdp++;
	addr = next;
	cond_resched();
	} while (addr < end);
	return rc;
	}

	static int split_pud_page(pud_t *pudp, unsigned long addr)
	{
	unsigned long pmd_addr, prot;
	pmd_t pm_dir, pmdp;
	pud_t new;
	int i, ro;

	pm_dir = vmem_pmd_alloc();
	if (!pm_dir)
	return -ENOMEM;
	pmd_addr = pud_pfn(*pudp) << PAGE_SHIFT;
	ro = !!(pud_val(*pudp) & _REGION_ENTRY_PROTECT);
	prot = pgprot_val(ro ? SEGMENT_KERNEL_RO : SEGMENT_KERNEL);
	pmdp = pm_dir;
	for (i = 0; i < PTRS_PER_PMD; i++) {
	pmd_val(*pmdp) = pmd_addr \| prot;
	pmd_addr += PMD_SIZE;
	pmdp++;
	}
	pud_val(new) = __pa(pm_dir) \| _REGION3_ENTRY;
	pgt_set((unsigned long *)pudp, pud_val(new), addr, CRDTE_DTT_REGION3);
	update_page_count(PG_DIRECT_MAP_1M, PTRS_PER_PMD);
	update_page_count(PG_DIRECT_MAP_2G, -1);
	return 0;
	}

	static void modify_pud_page(pud_t *pudp, unsigned long addr, struct cpa cpa)
	{
	pud_t new;

	if (cpa.set_ro)
	new = pud_wrprotect(*pudp);
	else if (cpa.clear_ro)
	new = pud_mkwrite(pud_mkdirty(*pudp));
	pgt_set((unsigned long *)pudp, pud_val(new), addr, CRDTE_DTT_REGION3);
	}

	static int walk_pud_level(pgd_t *pgd, unsigned long addr, unsigned long end,
	struct cpa cpa)
	{
	unsigned long next;
	pud_t *pudp;
	int rc = 0;

	pudp = pud_offset(pgd, addr);
	do {
	if (pud_none(*pudp))
	return -EINVAL;
	next = pud_addr_end(addr, end);
	if (pud_large(*pudp)) {
	if (addr & ~PUD_MASK \|\| addr + PUD_SIZE > next) {
	rc = split_pud_page(pudp, addr);
	if (rc)
	break;
	continue;
	}
	modify_pud_page(pudp, addr, cpa);
	} else {
	rc = walk_pmd_level(pudp, addr, next, cpa);
	}
	pudp++;
	addr = next;
	cond_resched();
	} while (addr < end && !rc);
	return rc;
	}

	static DEFINE_MUTEX(cpa_mutex);

	static int change_page_attr(unsigned long addr, unsigned long end,
	struct cpa cpa)
	{
	unsigned long next;
	int rc = -EINVAL;
	pgd_t *pgdp;

	if (addr == end)
	return 0;
	if (end >= MODULES_END)
	return -EINVAL;
	mutex_lock(&cpa_mutex);
	pgdp = pgd_offset_k(addr);
	do {
	if (pgd_none(*pgdp))
	break;
	next = pgd_addr_end(addr, end);
	rc = walk_pud_level(pgdp, addr, next, cpa);
	if (rc)
	break;
	cond_resched();
	} while (pgdp++, addr = next, addr < end && !rc);
	mutex_unlock(&cpa_mutex);
	return rc;
	}

	int set_memory_ro(unsigned long addr, int numpages)
	{
	struct cpa cpa = {
	.set_ro = 1,
	};

	addr &= PAGE_MASK;
	return change_page_attr(addr, addr + numpages * PAGE_SIZE, cpa);
	}

	int set_memory_rw(unsigned long addr, int numpages)
	{
	struct cpa cpa = {
	.clear_ro = 1,
	};

	addr &= PAGE_MASK;
	return change_page_attr(addr, addr + numpages * PAGE_SIZE, cpa);
	}

	/* not possible */
	int set_memory_nx(unsigned long addr, int numpages)
	{
	return 0;
	}

	int set_memory_x(unsigned long addr, int numpages)
	{
	return 0;
	}

	#ifdef CONFIG_DEBUG_PAGEALLOC

	static void ipte_range(pte_t *pte, unsigned long address, int nr)
	{
	int i;

	if (test_facility(13)) {
	__ptep_ipte_range(address, nr - 1, pte, IPTE_GLOBAL);
	return;
	}
	for (i = 0; i < nr; i++) {
	__ptep_ipte(address, pte, IPTE_GLOBAL);
	address += PAGE_SIZE;
	pte++;
	}
	}

	void __kernel_map_pages(struct page *page, int numpages, int enable)
	{
	unsigned long address;
	int nr, i, j;
	pgd_t *pgd;
	pud_t *pud;
	pmd_t *pmd;
	pte_t *pte;

	for (i = 0; i < numpages;) {
	address = page_to_phys(page + i);
	pgd = pgd_offset_k(address);
	pud = pud_offset(pgd, address);
	pmd = pmd_offset(pud, address);
	pte = pte_offset_kernel(pmd, address);
	nr = (unsigned long)pte >> ilog2(sizeof(long));
	nr = PTRS_PER_PTE - (nr & (PTRS_PER_PTE - 1));
	nr = min(numpages - i, nr);
	if (enable) {
	for (j = 0; j < nr; j++) {
	pte_val(*pte) = address \| pgprot_val(PAGE_KERNEL);
	address += PAGE_SIZE;
	pte++;
	}
	} else {
	ipte_range(pte, address, nr);
	}
	i += nr;
	}
	}

	#ifdef CONFIG_HIBERNATION
	bool kernel_page_present(struct page *page)
	{
	unsigned long addr;
	int cc;

	addr = page_to_phys(page);
	asm volatile(
	" lra %1,0(%1)\n"
	" ipm %0\n"
	" srl %0,28"
	: "=d" (cc), "+a" (addr) : : "cc");
	return cc == 0;
	}
	#endif /* CONFIG_HIBERNATION */

	#endif /* CONFIG_DEBUG_PAGEALLOC */