Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Linux/SPARC PROM Configuration Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright (C) 1996 Thomas K. Dyas (tdyas@noc.rutgers.edu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (C) 1996 Eddie C. Dost  (ecd@skynet.be)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  * This character device driver allows user programs to access the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * PROM device tree. It is compatible with the SunOS /dev/openprom
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * driver and the NetBSD /dev/openprom driver. The SunOS eeprom
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  * utility works without any modifications.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  * The driver uses a minor number under the misc device major. The
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  * file read/write mode determines the type of access to the PROM.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  * Interrupts are disabled whenever the driver calls into the PROM for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  * sanity's sake.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16)  */
^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) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/miscdevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/fs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #include <asm/oplib.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #include <asm/prom.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #include <asm/openpromio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #ifdef CONFIG_PCI
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) MODULE_AUTHOR("Thomas K. Dyas (tdyas@noc.rutgers.edu) and Eddie C. Dost  (ecd@skynet.be)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) MODULE_DESCRIPTION("OPENPROM Configuration Driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) MODULE_VERSION("1.0");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) MODULE_ALIAS_MISCDEV(SUN_OPENPROM_MINOR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) /* Private data kept by the driver for each descriptor. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) typedef struct openprom_private_data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	struct device_node *current_node; /* Current node for SunOS ioctls. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	struct device_node *lastnode; /* Last valid node used by BSD ioctls. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) } DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) /* ID of the PROM node containing all of the EEPROM options. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) static DEFINE_MUTEX(openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) static struct device_node *options_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54)  * Copy an openpromio structure into kernel space from user space.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55)  * This routine does error checking to make sure that all memory
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56)  * accesses are within bounds. A pointer to the allocated openpromio
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57)  * structure will be placed in "*opp_p". Return value is the length
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58)  * of the user supplied buffer.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) static int copyin(struct openpromio __user *info, struct openpromio **opp_p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	unsigned int bufsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	if (!info || !opp_p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	if (get_user(bufsize, &info->oprom_size))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	if (bufsize == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	/* If the bufsize is too large, just limit it.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	 * Fix from Jason Rappleye.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	if (bufsize > OPROMMAXPARAM)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 		bufsize = OPROMMAXPARAM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	if (!(*opp_p = kzalloc(sizeof(int) + bufsize + 1, GFP_KERNEL)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	if (copy_from_user(&(*opp_p)->oprom_array,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 			   &info->oprom_array, bufsize)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		kfree(*opp_p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	return bufsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) static int getstrings(struct openpromio __user *info, struct openpromio **opp_p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	int n, bufsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	char c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	if (!info || !opp_p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	if (!(*opp_p = kzalloc(sizeof(int) + OPROMMAXPARAM + 1, GFP_KERNEL)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	(*opp_p)->oprom_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	n = bufsize = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	while ((n < 2) && (bufsize < OPROMMAXPARAM)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		if (get_user(c, &info->oprom_array[bufsize])) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 			kfree(*opp_p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 			return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		if (c == '\0')
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 			n++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		(*opp_p)->oprom_array[bufsize++] = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	if (!n) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		kfree(*opp_p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	return bufsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)  * Copy an openpromio structure in kernel space back to user space.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static int copyout(void __user *info, struct openpromio *opp, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	if (copy_to_user(info, opp, len))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) static int opromgetprop(void __user *argp, struct device_node *dp, struct openpromio *op, int bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	const void *pval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	if (!dp ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	    !(pval = of_get_property(dp, op->oprom_array, &len)) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	    len <= 0 || len > bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 		return copyout(argp, op, sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	memcpy(op->oprom_array, pval, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	op->oprom_array[len] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	op->oprom_size = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	return copyout(argp, op, sizeof(int) + bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) static int opromnxtprop(void __user *argp, struct device_node *dp, struct openpromio *op, int bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	struct property *prop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	if (!dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 		return copyout(argp, op, sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	if (op->oprom_array[0] == '\0') {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 		prop = dp->properties;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 		if (!prop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 			return copyout(argp, op, sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 		len = strlen(prop->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		prop = of_find_property(dp, op->oprom_array, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		if (!prop ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		    !prop->next ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 		    (len = strlen(prop->next->name)) + 1 > bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 			return copyout(argp, op, sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 		prop = prop->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	memcpy(op->oprom_array, prop->name, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	op->oprom_array[len] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	op->oprom_size = ++len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	return copyout(argp, op, sizeof(int) + bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) static int opromsetopt(struct device_node *dp, struct openpromio *op, int bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	char *buf = op->oprom_array + strlen(op->oprom_array) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	int len = op->oprom_array + bufsize - buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	return of_set_property(options_node, op->oprom_array, buf, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) static int opromnext(void __user *argp, unsigned int cmd, struct device_node *dp, struct openpromio *op, int bufsize, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	phandle ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	BUILD_BUG_ON(sizeof(phandle) != sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	if (bufsize < sizeof(phandle))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	ph = *((int *) op->oprom_array);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	if (ph) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 		dp = of_find_node_by_phandle(ph);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 		if (!dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 		switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		case OPROMNEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 			dp = dp->sibling;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		case OPROMCHILD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 			dp = dp->child;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 		case OPROMSETCUR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 		/* Sibling of node zero is the root node.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		if (cmd != OPROMNEXT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 		dp = of_find_node_by_path("/");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	ph = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	if (dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		ph = dp->phandle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	data->current_node = dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	*((int *) op->oprom_array) = ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	op->oprom_size = sizeof(phandle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	return copyout(argp, op, bufsize + sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) static int oprompci2node(void __user *argp, struct device_node *dp, struct openpromio *op, int bufsize, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	int err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	if (bufsize >= 2*sizeof(int)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) #ifdef CONFIG_PCI
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 		struct pci_dev *pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 		struct device_node *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 		pdev = pci_get_domain_bus_and_slot(0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 						((int *) op->oprom_array)[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 						((int *) op->oprom_array)[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		dp = pci_device_to_OF_node(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 		data->current_node = dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		*((int *)op->oprom_array) = dp->phandle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 		op->oprom_size = sizeof(int);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 		err = copyout(argp, op, bufsize + sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 		pci_dev_put(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) static int oprompath2node(void __user *argp, struct device_node *dp, struct openpromio *op, int bufsize, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	phandle ph = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	dp = of_find_node_by_path(op->oprom_array);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	if (dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		ph = dp->phandle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	data->current_node = dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	*((int *)op->oprom_array) = ph;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	op->oprom_size = sizeof(int);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	return copyout(argp, op, bufsize + sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) static int opromgetbootargs(void __user *argp, struct openpromio *op, int bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	char *buf = saved_command_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	int len = strlen(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	if (len > bufsize)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	strcpy(op->oprom_array, buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	op->oprom_size = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	return copyout(argp, op, bufsize + sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)  *	SunOS and Solaris /dev/openprom ioctl calls.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) static long openprom_sunos_ioctl(struct file * file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 				 unsigned int cmd, unsigned long arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 				 struct device_node *dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	DATA *data = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	struct openpromio *opp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	int bufsize, error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	static int cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	void __user *argp = (void __user *)arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	if (cmd == OPROMSETOPT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		bufsize = getstrings(argp, &opp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 		bufsize = copyin(argp, &opp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	if (bufsize < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		return bufsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	mutex_lock(&openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	case OPROMGETOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	case OPROMGETPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 		error = opromgetprop(argp, dp, opp, bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	case OPROMNXTOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	case OPROMNXTPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 		error = opromnxtprop(argp, dp, opp, bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	case OPROMSETOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	case OPROMSETOPT2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 		error = opromsetopt(dp, opp, bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	case OPROMNEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 	case OPROMCHILD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	case OPROMSETCUR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 		error = opromnext(argp, cmd, dp, opp, bufsize, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	case OPROMPCI2NODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 		error = oprompci2node(argp, dp, opp, bufsize, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	case OPROMPATH2NODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 		error = oprompath2node(argp, dp, opp, bufsize, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	case OPROMGETBOOTARGS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 		error = opromgetbootargs(argp, opp, bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	case OPROMU2P:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	case OPROMGETCONS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	case OPROMGETFBNAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 		if (cnt++ < 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 			printk(KERN_INFO "openprom_sunos_ioctl: unimplemented ioctl\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		error = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 		if (cnt++ < 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 			printk(KERN_INFO "openprom_sunos_ioctl: cmd 0x%X, arg 0x%lX\n", cmd, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 		error = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	kfree(opp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	mutex_unlock(&openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) static struct device_node *get_node(phandle n, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	struct device_node *dp = of_find_node_by_phandle(n);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 	if (dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 		data->lastnode = dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 	return dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) /* Copy in a whole string from userspace into kernelspace. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) static char * copyin_string(char __user *user, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 	if ((ssize_t)len < 0 || (ssize_t)(len + 1) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 		return ERR_PTR(-EINVAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 	return memdup_user_nul(user, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)  *	NetBSD /dev/openprom ioctl calls.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) static int opiocget(void __user *argp, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 	struct opiocdesc op;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	struct device_node *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	char *str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 	const void *pval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 	int err, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 	if (copy_from_user(&op, argp, sizeof(op)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	dp = get_node(op.op_nodeid, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 	str = copyin_string(op.op_name, op.op_namelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	if (IS_ERR(str))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 		return PTR_ERR(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	pval = of_get_property(dp, str, &len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	if (!pval || len > op.op_buflen) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 		err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 		op.op_buflen = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 		if (copy_to_user(argp, &op, sizeof(op)) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 		    copy_to_user(op.op_buf, pval, len))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 			err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	kfree(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 	return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) static int opiocnextprop(void __user *argp, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 	struct opiocdesc op;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 	struct device_node *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 	struct property *prop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 	char *str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 	int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 	if (copy_from_user(&op, argp, sizeof(op)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 	dp = get_node(op.op_nodeid, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 	if (!dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 	str = copyin_string(op.op_name, op.op_namelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 	if (IS_ERR(str))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 		return PTR_ERR(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 	if (str[0] == '\0') {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 		prop = dp->properties;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 		prop = of_find_property(dp, str, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 		if (prop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 			prop = prop->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 	kfree(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 	if (!prop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 		len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 		len = prop->length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 	if (len > op.op_buflen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 		len = op.op_buflen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 	if (copy_to_user(argp, &op, sizeof(op)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 	if (len &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 	    copy_to_user(op.op_buf, prop->value, len))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) static int opiocset(void __user *argp, DATA *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 	struct opiocdesc op;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 	struct device_node *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 	char *str, *tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 	if (copy_from_user(&op, argp, sizeof(op)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 	dp = get_node(op.op_nodeid, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) 	if (!dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 	str = copyin_string(op.op_name, op.op_namelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	if (IS_ERR(str))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 		return PTR_ERR(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 	tmp = copyin_string(op.op_buf, op.op_buflen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) 	if (IS_ERR(tmp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 		kfree(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) 		return PTR_ERR(tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) 	err = of_set_property(dp, str, tmp, op.op_buflen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 	kfree(str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) 	kfree(tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 	return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) static int opiocgetnext(unsigned int cmd, void __user *argp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) 	struct device_node *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) 	phandle nd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) 	BUILD_BUG_ON(sizeof(phandle) != sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) 	if (copy_from_user(&nd, argp, sizeof(phandle)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) 	if (nd == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) 		if (cmd != OPIOCGETNEXT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) 		dp = of_find_node_by_path("/");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) 		dp = of_find_node_by_phandle(nd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) 		nd = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) 		if (dp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) 			if (cmd == OPIOCGETNEXT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) 				dp = dp->sibling;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) 			else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) 				dp = dp->child;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) 	if (dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) 		nd = dp->phandle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) 	if (copy_to_user(argp, &nd, sizeof(phandle)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) static int openprom_bsd_ioctl(struct file * file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) 			      unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 	DATA *data = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) 	void __user *argp = (void __user *)arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) 	mutex_lock(&openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 	switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 	case OPIOCGET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) 		err = opiocget(argp, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) 	case OPIOCNEXTPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) 		err = opiocnextprop(argp, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) 	case OPIOCSET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) 		err = opiocset(argp, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) 	case OPIOCGETOPTNODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) 		BUILD_BUG_ON(sizeof(phandle) != sizeof(int));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) 		err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) 		if (copy_to_user(argp, &options_node->phandle, sizeof(phandle)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) 			err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) 	case OPIOCGETNEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) 	case OPIOCGETCHILD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) 		err = opiocgetnext(cmd, argp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) 		err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) 	mutex_unlock(&openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) 	return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572)  *	Handoff control to the correct ioctl handler.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) static long openprom_ioctl(struct file * file,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) 			   unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) 	DATA *data = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) 	switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) 	case OPROMGETOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) 	case OPROMNXTOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) 		if ((file->f_mode & FMODE_READ) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) 			return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) 		return openprom_sunos_ioctl(file, cmd, arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) 					    options_node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) 	case OPROMSETOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) 	case OPROMSETOPT2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) 		if ((file->f_mode & FMODE_WRITE) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) 			return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) 		return openprom_sunos_ioctl(file, cmd, arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) 					    options_node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) 	case OPROMNEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) 	case OPROMCHILD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) 	case OPROMGETPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) 	case OPROMNXTPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) 		if ((file->f_mode & FMODE_READ) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) 			return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) 		return openprom_sunos_ioctl(file, cmd, arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) 					    data->current_node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) 	case OPROMU2P:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) 	case OPROMGETCONS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) 	case OPROMGETFBNAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) 	case OPROMGETBOOTARGS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) 	case OPROMSETCUR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) 	case OPROMPCI2NODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) 	case OPROMPATH2NODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) 		if ((file->f_mode & FMODE_READ) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) 			return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) 		return openprom_sunos_ioctl(file, cmd, arg, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) 	case OPIOCGET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) 	case OPIOCNEXTPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) 	case OPIOCGETOPTNODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) 	case OPIOCGETNEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) 	case OPIOCGETCHILD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) 		if ((file->f_mode & FMODE_READ) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) 			return -EBADF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) 		return openprom_bsd_ioctl(file,cmd,arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) 	case OPIOCSET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) 		if ((file->f_mode & FMODE_WRITE) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) 			return -EBADF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) 		return openprom_bsd_ioctl(file,cmd,arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) 	};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) static long openprom_compat_ioctl(struct file *file, unsigned int cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) 		unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) 	long rval = -ENOTTY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) 	 * SunOS/Solaris only, the NetBSD one's have embedded pointers in
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) 	 * the arg which we'd need to clean up...
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) 	switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) 	case OPROMGETOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) 	case OPROMSETOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) 	case OPROMNXTOPT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) 	case OPROMSETOPT2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) 	case OPROMNEXT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) 	case OPROMCHILD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) 	case OPROMGETPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) 	case OPROMNXTPROP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) 	case OPROMU2P:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) 	case OPROMGETCONS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) 	case OPROMGETFBNAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) 	case OPROMGETBOOTARGS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) 	case OPROMSETCUR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) 	case OPROMPCI2NODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) 	case OPROMPATH2NODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) 		rval = openprom_ioctl(file, cmd, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) 	return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) static int openprom_open(struct inode * inode, struct file * file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) 	DATA *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) 	data = kmalloc(sizeof(DATA), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) 	if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) 	mutex_lock(&openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) 	data->current_node = of_find_node_by_path("/");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) 	data->lastnode = data->current_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) 	file->private_data = (void *) data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) 	mutex_unlock(&openprom_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) static int openprom_release(struct inode * inode, struct file * file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) 	kfree(file->private_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) static const struct file_operations openprom_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) 	.owner =	THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) 	.llseek =	no_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) 	.unlocked_ioctl = openprom_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) 	.compat_ioctl =	openprom_compat_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) 	.open =		openprom_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) 	.release =	openprom_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) static struct miscdevice openprom_dev = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) 	.minor		= SUN_OPENPROM_MINOR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) 	.name		= "openprom",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) 	.fops		= &openprom_fops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) static int __init openprom_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) 	err = misc_register(&openprom_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) 	if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) 	options_node = of_get_child_by_name(of_find_node_by_path("/"), "options");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) 	if (!options_node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) 		misc_deregister(&openprom_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) 		return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) static void __exit openprom_cleanup(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) 	misc_deregister(&openprom_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) module_init(openprom_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) module_exit(openprom_cleanup);