Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <linux/fs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <xen/page.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <xen/xenbus.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include "xenfs.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) static ssize_t xsd_read(struct file *file, char __user *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 			    size_t size, loff_t *off)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	const char *str = (const char *)file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	return simple_read_from_buffer(buf, size, off, str, strlen(str));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) static int xsd_release(struct inode *inode, struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	kfree(file->private_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static int xsd_kva_open(struct inode *inode, struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	file->private_data = (void *)kasprintf(GFP_KERNEL, "0x%p",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 					       xen_store_interface);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	if (!file->private_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static int xsd_kva_mmap(struct file *file, struct vm_area_struct *vma)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	size_t size = vma->vm_end - vma->vm_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	if ((size > PAGE_SIZE) || (vma->vm_pgoff != 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	if (remap_pfn_range(vma, vma->vm_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 			    virt_to_pfn(xen_store_interface),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 			    size, vma->vm_page_prot))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 		return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) const struct file_operations xsd_kva_file_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	.open = xsd_kva_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	.mmap = xsd_kva_mmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	.read = xsd_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	.release = xsd_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) static int xsd_port_open(struct inode *inode, struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	file->private_data = (void *)kasprintf(GFP_KERNEL, "%d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 					       xen_store_evtchn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	if (!file->private_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) const struct file_operations xsd_port_file_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	.open = xsd_port_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 	.read = xsd_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	.release = xsd_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) };