162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * User address space access functions.
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright 1997 Andi Kleen <ak@muc.de>
662306a36Sopenharmony_ci * Copyright 1997 Linus Torvalds
762306a36Sopenharmony_ci * Copyright 2002 Andi Kleen <ak@suse.de>
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci#include <linux/export.h>
1062306a36Sopenharmony_ci#include <linux/uaccess.h>
1162306a36Sopenharmony_ci#include <linux/highmem.h>
1262306a36Sopenharmony_ci#include <linux/libnvdimm.h>
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci/*
1562306a36Sopenharmony_ci * Zero Userspace
1662306a36Sopenharmony_ci */
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#ifdef CONFIG_ARCH_HAS_UACCESS_FLUSHCACHE
1962306a36Sopenharmony_ci/**
2062306a36Sopenharmony_ci * clean_cache_range - write back a cache range with CLWB
2162306a36Sopenharmony_ci * @vaddr:	virtual start address
2262306a36Sopenharmony_ci * @size:	number of bytes to write back
2362306a36Sopenharmony_ci *
2462306a36Sopenharmony_ci * Write back a cache range using the CLWB (cache line write back)
2562306a36Sopenharmony_ci * instruction. Note that @size is internally rounded up to be cache
2662306a36Sopenharmony_ci * line size aligned.
2762306a36Sopenharmony_ci */
2862306a36Sopenharmony_cistatic void clean_cache_range(void *addr, size_t size)
2962306a36Sopenharmony_ci{
3062306a36Sopenharmony_ci	u16 x86_clflush_size = boot_cpu_data.x86_clflush_size;
3162306a36Sopenharmony_ci	unsigned long clflush_mask = x86_clflush_size - 1;
3262306a36Sopenharmony_ci	void *vend = addr + size;
3362306a36Sopenharmony_ci	void *p;
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	for (p = (void *)((unsigned long)addr & ~clflush_mask);
3662306a36Sopenharmony_ci	     p < vend; p += x86_clflush_size)
3762306a36Sopenharmony_ci		clwb(p);
3862306a36Sopenharmony_ci}
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_civoid arch_wb_cache_pmem(void *addr, size_t size)
4162306a36Sopenharmony_ci{
4262306a36Sopenharmony_ci	clean_cache_range(addr, size);
4362306a36Sopenharmony_ci}
4462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(arch_wb_cache_pmem);
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_cilong __copy_user_flushcache(void *dst, const void __user *src, unsigned size)
4762306a36Sopenharmony_ci{
4862306a36Sopenharmony_ci	unsigned long flushed, dest = (unsigned long) dst;
4962306a36Sopenharmony_ci	long rc;
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci	stac();
5262306a36Sopenharmony_ci	rc = __copy_user_nocache(dst, src, size);
5362306a36Sopenharmony_ci	clac();
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	/*
5662306a36Sopenharmony_ci	 * __copy_user_nocache() uses non-temporal stores for the bulk
5762306a36Sopenharmony_ci	 * of the transfer, but we need to manually flush if the
5862306a36Sopenharmony_ci	 * transfer is unaligned. A cached memory copy is used when
5962306a36Sopenharmony_ci	 * destination or size is not naturally aligned. That is:
6062306a36Sopenharmony_ci	 *   - Require 8-byte alignment when size is 8 bytes or larger.
6162306a36Sopenharmony_ci	 *   - Require 4-byte alignment when size is 4 bytes.
6262306a36Sopenharmony_ci	 */
6362306a36Sopenharmony_ci	if (size < 8) {
6462306a36Sopenharmony_ci		if (!IS_ALIGNED(dest, 4) || size != 4)
6562306a36Sopenharmony_ci			clean_cache_range(dst, size);
6662306a36Sopenharmony_ci	} else {
6762306a36Sopenharmony_ci		if (!IS_ALIGNED(dest, 8)) {
6862306a36Sopenharmony_ci			dest = ALIGN(dest, boot_cpu_data.x86_clflush_size);
6962306a36Sopenharmony_ci			clean_cache_range(dst, 1);
7062306a36Sopenharmony_ci		}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci		flushed = dest - (unsigned long) dst;
7362306a36Sopenharmony_ci		if (size > flushed && !IS_ALIGNED(size - flushed, 8))
7462306a36Sopenharmony_ci			clean_cache_range(dst + size - 1, 1);
7562306a36Sopenharmony_ci	}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	return rc;
7862306a36Sopenharmony_ci}
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_civoid __memcpy_flushcache(void *_dst, const void *_src, size_t size)
8162306a36Sopenharmony_ci{
8262306a36Sopenharmony_ci	unsigned long dest = (unsigned long) _dst;
8362306a36Sopenharmony_ci	unsigned long source = (unsigned long) _src;
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci	/* cache copy and flush to align dest */
8662306a36Sopenharmony_ci	if (!IS_ALIGNED(dest, 8)) {
8762306a36Sopenharmony_ci		size_t len = min_t(size_t, size, ALIGN(dest, 8) - dest);
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci		memcpy((void *) dest, (void *) source, len);
9062306a36Sopenharmony_ci		clean_cache_range((void *) dest, len);
9162306a36Sopenharmony_ci		dest += len;
9262306a36Sopenharmony_ci		source += len;
9362306a36Sopenharmony_ci		size -= len;
9462306a36Sopenharmony_ci		if (!size)
9562306a36Sopenharmony_ci			return;
9662306a36Sopenharmony_ci	}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	/* 4x8 movnti loop */
9962306a36Sopenharmony_ci	while (size >= 32) {
10062306a36Sopenharmony_ci		asm("movq    (%0), %%r8\n"
10162306a36Sopenharmony_ci		    "movq   8(%0), %%r9\n"
10262306a36Sopenharmony_ci		    "movq  16(%0), %%r10\n"
10362306a36Sopenharmony_ci		    "movq  24(%0), %%r11\n"
10462306a36Sopenharmony_ci		    "movnti  %%r8,   (%1)\n"
10562306a36Sopenharmony_ci		    "movnti  %%r9,  8(%1)\n"
10662306a36Sopenharmony_ci		    "movnti %%r10, 16(%1)\n"
10762306a36Sopenharmony_ci		    "movnti %%r11, 24(%1)\n"
10862306a36Sopenharmony_ci		    :: "r" (source), "r" (dest)
10962306a36Sopenharmony_ci		    : "memory", "r8", "r9", "r10", "r11");
11062306a36Sopenharmony_ci		dest += 32;
11162306a36Sopenharmony_ci		source += 32;
11262306a36Sopenharmony_ci		size -= 32;
11362306a36Sopenharmony_ci	}
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_ci	/* 1x8 movnti loop */
11662306a36Sopenharmony_ci	while (size >= 8) {
11762306a36Sopenharmony_ci		asm("movq    (%0), %%r8\n"
11862306a36Sopenharmony_ci		    "movnti  %%r8,   (%1)\n"
11962306a36Sopenharmony_ci		    :: "r" (source), "r" (dest)
12062306a36Sopenharmony_ci		    : "memory", "r8");
12162306a36Sopenharmony_ci		dest += 8;
12262306a36Sopenharmony_ci		source += 8;
12362306a36Sopenharmony_ci		size -= 8;
12462306a36Sopenharmony_ci	}
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_ci	/* 1x4 movnti loop */
12762306a36Sopenharmony_ci	while (size >= 4) {
12862306a36Sopenharmony_ci		asm("movl    (%0), %%r8d\n"
12962306a36Sopenharmony_ci		    "movnti  %%r8d,   (%1)\n"
13062306a36Sopenharmony_ci		    :: "r" (source), "r" (dest)
13162306a36Sopenharmony_ci		    : "memory", "r8");
13262306a36Sopenharmony_ci		dest += 4;
13362306a36Sopenharmony_ci		source += 4;
13462306a36Sopenharmony_ci		size -= 4;
13562306a36Sopenharmony_ci	}
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_ci	/* cache copy for remaining bytes */
13862306a36Sopenharmony_ci	if (size) {
13962306a36Sopenharmony_ci		memcpy((void *) dest, (void *) source, size);
14062306a36Sopenharmony_ci		clean_cache_range((void *) dest, size);
14162306a36Sopenharmony_ci	}
14262306a36Sopenharmony_ci}
14362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(__memcpy_flushcache);
14462306a36Sopenharmony_ci#endif
145