1925ca369SKent Gibson // SPDX-License-Identifier: GPL-2.0 2925ca369SKent Gibson 3d189f627SKent Gibson #include <linux/anon_inodes.h> 43c0d9c63SKent Gibson #include <linux/atomic.h> 5925ca369SKent Gibson #include <linux/bitmap.h> 63c0d9c63SKent Gibson #include <linux/build_bug.h> 7d189f627SKent Gibson #include <linux/cdev.h> 8d189f627SKent Gibson #include <linux/compat.h> 9925ca369SKent Gibson #include <linux/device.h> 10925ca369SKent Gibson #include <linux/err.h> 11d189f627SKent Gibson #include <linux/file.h> 12925ca369SKent Gibson #include <linux/gpio.h> 13925ca369SKent Gibson #include <linux/gpio/driver.h> 14d189f627SKent Gibson #include <linux/interrupt.h> 15d189f627SKent Gibson #include <linux/irqreturn.h> 16d189f627SKent Gibson #include <linux/kernel.h> 17925ca369SKent Gibson #include <linux/kfifo.h> 18d189f627SKent Gibson #include <linux/module.h> 19*a54756cbSKent Gibson #include <linux/mutex.h> 20d189f627SKent Gibson #include <linux/pinctrl/consumer.h> 21925ca369SKent Gibson #include <linux/poll.h> 22d189f627SKent Gibson #include <linux/spinlock.h> 23925ca369SKent Gibson #include <linux/timekeeping.h> 24d189f627SKent Gibson #include <linux/uaccess.h> 25925ca369SKent Gibson #include <uapi/linux/gpio.h> 26925ca369SKent Gibson 27925ca369SKent Gibson #include "gpiolib.h" 28925ca369SKent Gibson #include "gpiolib-cdev.h" 29925ca369SKent Gibson 303c0d9c63SKent Gibson /* 313c0d9c63SKent Gibson * Array sizes must ensure 64-bit alignment and not create holes in the 323c0d9c63SKent Gibson * struct packing. 333c0d9c63SKent Gibson */ 343c0d9c63SKent Gibson static_assert(IS_ALIGNED(GPIO_V2_LINES_MAX, 2)); 353c0d9c63SKent Gibson static_assert(IS_ALIGNED(GPIO_MAX_NAME_SIZE, 8)); 363c0d9c63SKent Gibson 373c0d9c63SKent Gibson /* 383c0d9c63SKent Gibson * Check that uAPI structs are 64-bit aligned for 32/64-bit compatibility 393c0d9c63SKent Gibson */ 403c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_attribute), 8)); 413c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_config_attribute), 8)); 423c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_config), 8)); 433c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_request), 8)); 443c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_info), 8)); 453c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_info_changed), 8)); 463c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_event), 8)); 473c0d9c63SKent Gibson static_assert(IS_ALIGNED(sizeof(struct gpio_v2_line_values), 8)); 483c0d9c63SKent Gibson 49925ca369SKent Gibson /* Character device interface to GPIO. 50925ca369SKent Gibson * 51925ca369SKent Gibson * The GPIO character device, /dev/gpiochipN, provides userspace an 52925ca369SKent Gibson * interface to gpiolib GPIOs via ioctl()s. 53925ca369SKent Gibson */ 54925ca369SKent Gibson 55925ca369SKent Gibson /* 56925ca369SKent Gibson * GPIO line handle management 57925ca369SKent Gibson */ 58925ca369SKent Gibson 593c0d9c63SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 60925ca369SKent Gibson /** 61925ca369SKent Gibson * struct linehandle_state - contains the state of a userspace handle 62925ca369SKent Gibson * @gdev: the GPIO device the handle pertains to 63925ca369SKent Gibson * @label: consumer label used to tag descriptors 64925ca369SKent Gibson * @descs: the GPIO descriptors held by this handle 6552b7b596SKent Gibson * @num_descs: the number of descriptors held in the descs array 66925ca369SKent Gibson */ 67925ca369SKent Gibson struct linehandle_state { 68925ca369SKent Gibson struct gpio_device *gdev; 69925ca369SKent Gibson const char *label; 70925ca369SKent Gibson struct gpio_desc *descs[GPIOHANDLES_MAX]; 7152b7b596SKent Gibson u32 num_descs; 72925ca369SKent Gibson }; 73925ca369SKent Gibson 74925ca369SKent Gibson #define GPIOHANDLE_REQUEST_VALID_FLAGS \ 75925ca369SKent Gibson (GPIOHANDLE_REQUEST_INPUT | \ 76925ca369SKent Gibson GPIOHANDLE_REQUEST_OUTPUT | \ 77925ca369SKent Gibson GPIOHANDLE_REQUEST_ACTIVE_LOW | \ 78925ca369SKent Gibson GPIOHANDLE_REQUEST_BIAS_PULL_UP | \ 79925ca369SKent Gibson GPIOHANDLE_REQUEST_BIAS_PULL_DOWN | \ 80925ca369SKent Gibson GPIOHANDLE_REQUEST_BIAS_DISABLE | \ 81925ca369SKent Gibson GPIOHANDLE_REQUEST_OPEN_DRAIN | \ 82925ca369SKent Gibson GPIOHANDLE_REQUEST_OPEN_SOURCE) 83925ca369SKent Gibson 84925ca369SKent Gibson static int linehandle_validate_flags(u32 flags) 85925ca369SKent Gibson { 86925ca369SKent Gibson /* Return an error if an unknown flag is set */ 87925ca369SKent Gibson if (flags & ~GPIOHANDLE_REQUEST_VALID_FLAGS) 88925ca369SKent Gibson return -EINVAL; 89925ca369SKent Gibson 90925ca369SKent Gibson /* 91925ca369SKent Gibson * Do not allow both INPUT & OUTPUT flags to be set as they are 92925ca369SKent Gibson * contradictory. 93925ca369SKent Gibson */ 94925ca369SKent Gibson if ((flags & GPIOHANDLE_REQUEST_INPUT) && 95925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_OUTPUT)) 96925ca369SKent Gibson return -EINVAL; 97925ca369SKent Gibson 98925ca369SKent Gibson /* 99925ca369SKent Gibson * Do not allow OPEN_SOURCE & OPEN_DRAIN flags in a single request. If 100925ca369SKent Gibson * the hardware actually supports enabling both at the same time the 101925ca369SKent Gibson * electrical result would be disastrous. 102925ca369SKent Gibson */ 103925ca369SKent Gibson if ((flags & GPIOHANDLE_REQUEST_OPEN_DRAIN) && 104925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_OPEN_SOURCE)) 105925ca369SKent Gibson return -EINVAL; 106925ca369SKent Gibson 107925ca369SKent Gibson /* OPEN_DRAIN and OPEN_SOURCE flags only make sense for output mode. */ 108925ca369SKent Gibson if (!(flags & GPIOHANDLE_REQUEST_OUTPUT) && 109925ca369SKent Gibson ((flags & GPIOHANDLE_REQUEST_OPEN_DRAIN) || 110925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_OPEN_SOURCE))) 111925ca369SKent Gibson return -EINVAL; 112925ca369SKent Gibson 113925ca369SKent Gibson /* Bias flags only allowed for input or output mode. */ 114925ca369SKent Gibson if (!((flags & GPIOHANDLE_REQUEST_INPUT) || 115925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_OUTPUT)) && 116925ca369SKent Gibson ((flags & GPIOHANDLE_REQUEST_BIAS_DISABLE) || 117925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_BIAS_PULL_UP) || 118925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_BIAS_PULL_DOWN))) 119925ca369SKent Gibson return -EINVAL; 120925ca369SKent Gibson 121925ca369SKent Gibson /* Only one bias flag can be set. */ 122925ca369SKent Gibson if (((flags & GPIOHANDLE_REQUEST_BIAS_DISABLE) && 123925ca369SKent Gibson (flags & (GPIOHANDLE_REQUEST_BIAS_PULL_DOWN | 124925ca369SKent Gibson GPIOHANDLE_REQUEST_BIAS_PULL_UP))) || 125925ca369SKent Gibson ((flags & GPIOHANDLE_REQUEST_BIAS_PULL_DOWN) && 126925ca369SKent Gibson (flags & GPIOHANDLE_REQUEST_BIAS_PULL_UP))) 127925ca369SKent Gibson return -EINVAL; 128925ca369SKent Gibson 129925ca369SKent Gibson return 0; 130925ca369SKent Gibson } 131925ca369SKent Gibson 132c274b58aSKent Gibson static void linehandle_flags_to_desc_flags(u32 lflags, unsigned long *flagsp) 133c274b58aSKent Gibson { 134c274b58aSKent Gibson assign_bit(FLAG_ACTIVE_LOW, flagsp, 135c274b58aSKent Gibson lflags & GPIOHANDLE_REQUEST_ACTIVE_LOW); 136c274b58aSKent Gibson assign_bit(FLAG_OPEN_DRAIN, flagsp, 137c274b58aSKent Gibson lflags & GPIOHANDLE_REQUEST_OPEN_DRAIN); 138c274b58aSKent Gibson assign_bit(FLAG_OPEN_SOURCE, flagsp, 139c274b58aSKent Gibson lflags & GPIOHANDLE_REQUEST_OPEN_SOURCE); 140c274b58aSKent Gibson assign_bit(FLAG_PULL_UP, flagsp, 141c274b58aSKent Gibson lflags & GPIOHANDLE_REQUEST_BIAS_PULL_UP); 142c274b58aSKent Gibson assign_bit(FLAG_PULL_DOWN, flagsp, 143c274b58aSKent Gibson lflags & GPIOHANDLE_REQUEST_BIAS_PULL_DOWN); 144c274b58aSKent Gibson assign_bit(FLAG_BIAS_DISABLE, flagsp, 145c274b58aSKent Gibson lflags & GPIOHANDLE_REQUEST_BIAS_DISABLE); 146c274b58aSKent Gibson } 147c274b58aSKent Gibson 148925ca369SKent Gibson static long linehandle_set_config(struct linehandle_state *lh, 149925ca369SKent Gibson void __user *ip) 150925ca369SKent Gibson { 151925ca369SKent Gibson struct gpiohandle_config gcnf; 152925ca369SKent Gibson struct gpio_desc *desc; 153925ca369SKent Gibson int i, ret; 154925ca369SKent Gibson u32 lflags; 155925ca369SKent Gibson 156925ca369SKent Gibson if (copy_from_user(&gcnf, ip, sizeof(gcnf))) 157925ca369SKent Gibson return -EFAULT; 158925ca369SKent Gibson 159925ca369SKent Gibson lflags = gcnf.flags; 160925ca369SKent Gibson ret = linehandle_validate_flags(lflags); 161925ca369SKent Gibson if (ret) 162925ca369SKent Gibson return ret; 163925ca369SKent Gibson 16452b7b596SKent Gibson for (i = 0; i < lh->num_descs; i++) { 165925ca369SKent Gibson desc = lh->descs[i]; 166c274b58aSKent Gibson linehandle_flags_to_desc_flags(gcnf.flags, &desc->flags); 167925ca369SKent Gibson 168925ca369SKent Gibson /* 169925ca369SKent Gibson * Lines have to be requested explicitly for input 170925ca369SKent Gibson * or output, else the line will be treated "as is". 171925ca369SKent Gibson */ 172925ca369SKent Gibson if (lflags & GPIOHANDLE_REQUEST_OUTPUT) { 173925ca369SKent Gibson int val = !!gcnf.default_values[i]; 174925ca369SKent Gibson 175925ca369SKent Gibson ret = gpiod_direction_output(desc, val); 176925ca369SKent Gibson if (ret) 177925ca369SKent Gibson return ret; 178925ca369SKent Gibson } else if (lflags & GPIOHANDLE_REQUEST_INPUT) { 179925ca369SKent Gibson ret = gpiod_direction_input(desc); 180925ca369SKent Gibson if (ret) 181925ca369SKent Gibson return ret; 182925ca369SKent Gibson } 183925ca369SKent Gibson 1846accc376SKent Gibson blocking_notifier_call_chain(&desc->gdev->notifier, 185aad95584SKent Gibson GPIO_V2_LINE_CHANGED_CONFIG, 186aad95584SKent Gibson desc); 187925ca369SKent Gibson } 188925ca369SKent Gibson return 0; 189925ca369SKent Gibson } 190925ca369SKent Gibson 19149bc5279SKent Gibson static long linehandle_ioctl(struct file *file, unsigned int cmd, 192925ca369SKent Gibson unsigned long arg) 193925ca369SKent Gibson { 19449bc5279SKent Gibson struct linehandle_state *lh = file->private_data; 195925ca369SKent Gibson void __user *ip = (void __user *)arg; 196925ca369SKent Gibson struct gpiohandle_data ghd; 197925ca369SKent Gibson DECLARE_BITMAP(vals, GPIOHANDLES_MAX); 198925ca369SKent Gibson int i; 199925ca369SKent Gibson 200925ca369SKent Gibson if (cmd == GPIOHANDLE_GET_LINE_VALUES_IOCTL) { 201925ca369SKent Gibson /* NOTE: It's ok to read values of output lines. */ 202925ca369SKent Gibson int ret = gpiod_get_array_value_complex(false, 203925ca369SKent Gibson true, 20452b7b596SKent Gibson lh->num_descs, 205925ca369SKent Gibson lh->descs, 206925ca369SKent Gibson NULL, 207925ca369SKent Gibson vals); 208925ca369SKent Gibson if (ret) 209925ca369SKent Gibson return ret; 210925ca369SKent Gibson 211925ca369SKent Gibson memset(&ghd, 0, sizeof(ghd)); 21252b7b596SKent Gibson for (i = 0; i < lh->num_descs; i++) 213925ca369SKent Gibson ghd.values[i] = test_bit(i, vals); 214925ca369SKent Gibson 215925ca369SKent Gibson if (copy_to_user(ip, &ghd, sizeof(ghd))) 216925ca369SKent Gibson return -EFAULT; 217925ca369SKent Gibson 218925ca369SKent Gibson return 0; 219925ca369SKent Gibson } else if (cmd == GPIOHANDLE_SET_LINE_VALUES_IOCTL) { 220925ca369SKent Gibson /* 221925ca369SKent Gibson * All line descriptors were created at once with the same 222925ca369SKent Gibson * flags so just check if the first one is really output. 223925ca369SKent Gibson */ 224925ca369SKent Gibson if (!test_bit(FLAG_IS_OUT, &lh->descs[0]->flags)) 225925ca369SKent Gibson return -EPERM; 226925ca369SKent Gibson 227925ca369SKent Gibson if (copy_from_user(&ghd, ip, sizeof(ghd))) 228925ca369SKent Gibson return -EFAULT; 229925ca369SKent Gibson 230925ca369SKent Gibson /* Clamp all values to [0,1] */ 23152b7b596SKent Gibson for (i = 0; i < lh->num_descs; i++) 232925ca369SKent Gibson __assign_bit(i, vals, ghd.values[i]); 233925ca369SKent Gibson 234925ca369SKent Gibson /* Reuse the array setting function */ 235925ca369SKent Gibson return gpiod_set_array_value_complex(false, 236925ca369SKent Gibson true, 23752b7b596SKent Gibson lh->num_descs, 238925ca369SKent Gibson lh->descs, 239925ca369SKent Gibson NULL, 240925ca369SKent Gibson vals); 241925ca369SKent Gibson } else if (cmd == GPIOHANDLE_SET_CONFIG_IOCTL) { 242925ca369SKent Gibson return linehandle_set_config(lh, ip); 243925ca369SKent Gibson } 244925ca369SKent Gibson return -EINVAL; 245925ca369SKent Gibson } 246925ca369SKent Gibson 247925ca369SKent Gibson #ifdef CONFIG_COMPAT 24849bc5279SKent Gibson static long linehandle_ioctl_compat(struct file *file, unsigned int cmd, 249925ca369SKent Gibson unsigned long arg) 250925ca369SKent Gibson { 25149bc5279SKent Gibson return linehandle_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 252925ca369SKent Gibson } 253925ca369SKent Gibson #endif 254925ca369SKent Gibson 255883f9198SKent Gibson static void linehandle_free(struct linehandle_state *lh) 256925ca369SKent Gibson { 257925ca369SKent Gibson int i; 258925ca369SKent Gibson 25952b7b596SKent Gibson for (i = 0; i < lh->num_descs; i++) 260883f9198SKent Gibson if (lh->descs[i]) 261925ca369SKent Gibson gpiod_free(lh->descs[i]); 262925ca369SKent Gibson kfree(lh->label); 263883f9198SKent Gibson put_device(&lh->gdev->dev); 264925ca369SKent Gibson kfree(lh); 265883f9198SKent Gibson } 266883f9198SKent Gibson 267883f9198SKent Gibson static int linehandle_release(struct inode *inode, struct file *file) 268883f9198SKent Gibson { 269883f9198SKent Gibson linehandle_free(file->private_data); 270925ca369SKent Gibson return 0; 271925ca369SKent Gibson } 272925ca369SKent Gibson 273925ca369SKent Gibson static const struct file_operations linehandle_fileops = { 274925ca369SKent Gibson .release = linehandle_release, 275925ca369SKent Gibson .owner = THIS_MODULE, 276925ca369SKent Gibson .llseek = noop_llseek, 277925ca369SKent Gibson .unlocked_ioctl = linehandle_ioctl, 278925ca369SKent Gibson #ifdef CONFIG_COMPAT 279925ca369SKent Gibson .compat_ioctl = linehandle_ioctl_compat, 280925ca369SKent Gibson #endif 281925ca369SKent Gibson }; 282925ca369SKent Gibson 283925ca369SKent Gibson static int linehandle_create(struct gpio_device *gdev, void __user *ip) 284925ca369SKent Gibson { 285925ca369SKent Gibson struct gpiohandle_request handlereq; 286925ca369SKent Gibson struct linehandle_state *lh; 287925ca369SKent Gibson struct file *file; 288883f9198SKent Gibson int fd, i, ret; 289925ca369SKent Gibson u32 lflags; 290925ca369SKent Gibson 291925ca369SKent Gibson if (copy_from_user(&handlereq, ip, sizeof(handlereq))) 292925ca369SKent Gibson return -EFAULT; 293925ca369SKent Gibson if ((handlereq.lines == 0) || (handlereq.lines > GPIOHANDLES_MAX)) 294925ca369SKent Gibson return -EINVAL; 295925ca369SKent Gibson 296925ca369SKent Gibson lflags = handlereq.flags; 297925ca369SKent Gibson 298925ca369SKent Gibson ret = linehandle_validate_flags(lflags); 299925ca369SKent Gibson if (ret) 300925ca369SKent Gibson return ret; 301925ca369SKent Gibson 302925ca369SKent Gibson lh = kzalloc(sizeof(*lh), GFP_KERNEL); 303925ca369SKent Gibson if (!lh) 304925ca369SKent Gibson return -ENOMEM; 305925ca369SKent Gibson lh->gdev = gdev; 306925ca369SKent Gibson get_device(&gdev->dev); 307925ca369SKent Gibson 308925ca369SKent Gibson /* Make sure this is terminated */ 309925ca369SKent Gibson handlereq.consumer_label[sizeof(handlereq.consumer_label)-1] = '\0'; 310925ca369SKent Gibson if (strlen(handlereq.consumer_label)) { 311925ca369SKent Gibson lh->label = kstrdup(handlereq.consumer_label, 312925ca369SKent Gibson GFP_KERNEL); 313925ca369SKent Gibson if (!lh->label) { 314925ca369SKent Gibson ret = -ENOMEM; 315925ca369SKent Gibson goto out_free_lh; 316925ca369SKent Gibson } 317925ca369SKent Gibson } 318925ca369SKent Gibson 319883f9198SKent Gibson lh->num_descs = handlereq.lines; 320883f9198SKent Gibson 321925ca369SKent Gibson /* Request each GPIO */ 322925ca369SKent Gibson for (i = 0; i < handlereq.lines; i++) { 323925ca369SKent Gibson u32 offset = handlereq.lineoffsets[i]; 324925ca369SKent Gibson struct gpio_desc *desc = gpiochip_get_desc(gdev->chip, offset); 325925ca369SKent Gibson 326925ca369SKent Gibson if (IS_ERR(desc)) { 327925ca369SKent Gibson ret = PTR_ERR(desc); 328883f9198SKent Gibson goto out_free_lh; 329925ca369SKent Gibson } 330925ca369SKent Gibson 331925ca369SKent Gibson ret = gpiod_request(desc, lh->label); 332925ca369SKent Gibson if (ret) 333883f9198SKent Gibson goto out_free_lh; 334925ca369SKent Gibson lh->descs[i] = desc; 335c274b58aSKent Gibson linehandle_flags_to_desc_flags(handlereq.flags, &desc->flags); 336925ca369SKent Gibson 337925ca369SKent Gibson ret = gpiod_set_transitory(desc, false); 338925ca369SKent Gibson if (ret < 0) 339883f9198SKent Gibson goto out_free_lh; 340925ca369SKent Gibson 341925ca369SKent Gibson /* 342925ca369SKent Gibson * Lines have to be requested explicitly for input 343925ca369SKent Gibson * or output, else the line will be treated "as is". 344925ca369SKent Gibson */ 345925ca369SKent Gibson if (lflags & GPIOHANDLE_REQUEST_OUTPUT) { 346925ca369SKent Gibson int val = !!handlereq.default_values[i]; 347925ca369SKent Gibson 348925ca369SKent Gibson ret = gpiod_direction_output(desc, val); 349925ca369SKent Gibson if (ret) 350883f9198SKent Gibson goto out_free_lh; 351925ca369SKent Gibson } else if (lflags & GPIOHANDLE_REQUEST_INPUT) { 352925ca369SKent Gibson ret = gpiod_direction_input(desc); 353925ca369SKent Gibson if (ret) 354883f9198SKent Gibson goto out_free_lh; 355925ca369SKent Gibson } 356925ca369SKent Gibson 3576accc376SKent Gibson blocking_notifier_call_chain(&desc->gdev->notifier, 358aad95584SKent Gibson GPIO_V2_LINE_CHANGED_REQUESTED, desc); 359925ca369SKent Gibson 360925ca369SKent Gibson dev_dbg(&gdev->dev, "registered chardev handle for line %d\n", 361925ca369SKent Gibson offset); 362925ca369SKent Gibson } 363925ca369SKent Gibson 364925ca369SKent Gibson fd = get_unused_fd_flags(O_RDONLY | O_CLOEXEC); 365925ca369SKent Gibson if (fd < 0) { 366925ca369SKent Gibson ret = fd; 367883f9198SKent Gibson goto out_free_lh; 368925ca369SKent Gibson } 369925ca369SKent Gibson 370925ca369SKent Gibson file = anon_inode_getfile("gpio-linehandle", 371925ca369SKent Gibson &linehandle_fileops, 372925ca369SKent Gibson lh, 373925ca369SKent Gibson O_RDONLY | O_CLOEXEC); 374925ca369SKent Gibson if (IS_ERR(file)) { 375925ca369SKent Gibson ret = PTR_ERR(file); 376925ca369SKent Gibson goto out_put_unused_fd; 377925ca369SKent Gibson } 378925ca369SKent Gibson 379925ca369SKent Gibson handlereq.fd = fd; 380925ca369SKent Gibson if (copy_to_user(ip, &handlereq, sizeof(handlereq))) { 381925ca369SKent Gibson /* 382925ca369SKent Gibson * fput() will trigger the release() callback, so do not go onto 383925ca369SKent Gibson * the regular error cleanup path here. 384925ca369SKent Gibson */ 385925ca369SKent Gibson fput(file); 386925ca369SKent Gibson put_unused_fd(fd); 387925ca369SKent Gibson return -EFAULT; 388925ca369SKent Gibson } 389925ca369SKent Gibson 390925ca369SKent Gibson fd_install(fd, file); 391925ca369SKent Gibson 392925ca369SKent Gibson dev_dbg(&gdev->dev, "registered chardev handle for %d lines\n", 39352b7b596SKent Gibson lh->num_descs); 394925ca369SKent Gibson 395925ca369SKent Gibson return 0; 396925ca369SKent Gibson 397925ca369SKent Gibson out_put_unused_fd: 398925ca369SKent Gibson put_unused_fd(fd); 399925ca369SKent Gibson out_free_lh: 400883f9198SKent Gibson linehandle_free(lh); 401925ca369SKent Gibson return ret; 402925ca369SKent Gibson } 4033c0d9c63SKent Gibson #endif /* CONFIG_GPIO_CDEV_V1 */ 4043c0d9c63SKent Gibson 4053c0d9c63SKent Gibson /** 4063c0d9c63SKent Gibson * struct line - contains the state of a requested line 4073c0d9c63SKent Gibson * @desc: the GPIO descriptor for this line. 40873e03419SKent Gibson * @req: the corresponding line request 40973e03419SKent Gibson * @irq: the interrupt triggered in response to events on this GPIO 41073e03419SKent Gibson * @eflags: the edge flags, GPIO_V2_LINE_FLAG_EDGE_RISING and/or 41173e03419SKent Gibson * GPIO_V2_LINE_FLAG_EDGE_FALLING, indicating the edge detection applied 41273e03419SKent Gibson * @timestamp_ns: cache for the timestamp storing it between hardirq and 41373e03419SKent Gibson * IRQ thread, used to bring the timestamp close to the actual event 41473e03419SKent Gibson * @req_seqno: the seqno for the current edge event in the sequence of 41573e03419SKent Gibson * events for the corresponding line request. This is drawn from the @req. 41673e03419SKent Gibson * @line_seqno: the seqno for the current edge event in the sequence of 41773e03419SKent Gibson * events for this line. 4183c0d9c63SKent Gibson */ 4193c0d9c63SKent Gibson struct line { 4203c0d9c63SKent Gibson struct gpio_desc *desc; 42173e03419SKent Gibson /* 42273e03419SKent Gibson * -- edge detector specific fields -- 42373e03419SKent Gibson */ 42473e03419SKent Gibson struct linereq *req; 42573e03419SKent Gibson unsigned int irq; 42673e03419SKent Gibson u64 eflags; 42773e03419SKent Gibson /* 42873e03419SKent Gibson * timestamp_ns and req_seqno are accessed only by 42973e03419SKent Gibson * edge_irq_handler() and edge_irq_thread(), which are themselves 43073e03419SKent Gibson * mutually exclusive, so no additional protection is necessary. 43173e03419SKent Gibson */ 43273e03419SKent Gibson u64 timestamp_ns; 43373e03419SKent Gibson u32 req_seqno; 43473e03419SKent Gibson u32 line_seqno; 4353c0d9c63SKent Gibson }; 4363c0d9c63SKent Gibson 4373c0d9c63SKent Gibson /** 4383c0d9c63SKent Gibson * struct linereq - contains the state of a userspace line request 4393c0d9c63SKent Gibson * @gdev: the GPIO device the line request pertains to 4403c0d9c63SKent Gibson * @label: consumer label used to tag GPIO descriptors 4413c0d9c63SKent Gibson * @num_lines: the number of lines in the lines array 44273e03419SKent Gibson * @wait: wait queue that handles blocking reads of events 44373e03419SKent Gibson * @event_buffer_size: the number of elements allocated in @events 44473e03419SKent Gibson * @events: KFIFO for the GPIO events 44573e03419SKent Gibson * @seqno: the sequence number for edge events generated on all lines in 44673e03419SKent Gibson * this line request. Note that this is not used when @num_lines is 1, as 44773e03419SKent Gibson * the line_seqno is then the same and is cheaper to calculate. 448*a54756cbSKent Gibson * @config_mutex: mutex for serializing ioctl() calls to ensure consistency 449*a54756cbSKent Gibson * of configuration, particularly multi-step accesses to desc flags. 4503c0d9c63SKent Gibson * @lines: the lines held by this line request, with @num_lines elements. 4513c0d9c63SKent Gibson */ 4523c0d9c63SKent Gibson struct linereq { 4533c0d9c63SKent Gibson struct gpio_device *gdev; 4543c0d9c63SKent Gibson const char *label; 4553c0d9c63SKent Gibson u32 num_lines; 45673e03419SKent Gibson wait_queue_head_t wait; 45773e03419SKent Gibson u32 event_buffer_size; 45873e03419SKent Gibson DECLARE_KFIFO_PTR(events, struct gpio_v2_line_event); 45973e03419SKent Gibson atomic_t seqno; 460*a54756cbSKent Gibson struct mutex config_mutex; 4613c0d9c63SKent Gibson struct line lines[]; 4623c0d9c63SKent Gibson }; 4633c0d9c63SKent Gibson 4643c0d9c63SKent Gibson #define GPIO_V2_LINE_BIAS_FLAGS \ 4653c0d9c63SKent Gibson (GPIO_V2_LINE_FLAG_BIAS_PULL_UP | \ 4663c0d9c63SKent Gibson GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN | \ 4673c0d9c63SKent Gibson GPIO_V2_LINE_FLAG_BIAS_DISABLED) 4683c0d9c63SKent Gibson 4693c0d9c63SKent Gibson #define GPIO_V2_LINE_DIRECTION_FLAGS \ 4703c0d9c63SKent Gibson (GPIO_V2_LINE_FLAG_INPUT | \ 4713c0d9c63SKent Gibson GPIO_V2_LINE_FLAG_OUTPUT) 4723c0d9c63SKent Gibson 4733c0d9c63SKent Gibson #define GPIO_V2_LINE_DRIVE_FLAGS \ 4743c0d9c63SKent Gibson (GPIO_V2_LINE_FLAG_OPEN_DRAIN | \ 4753c0d9c63SKent Gibson GPIO_V2_LINE_FLAG_OPEN_SOURCE) 4763c0d9c63SKent Gibson 47773e03419SKent Gibson #define GPIO_V2_LINE_EDGE_FLAGS \ 47873e03419SKent Gibson (GPIO_V2_LINE_FLAG_EDGE_RISING | \ 47973e03419SKent Gibson GPIO_V2_LINE_FLAG_EDGE_FALLING) 48073e03419SKent Gibson 4813c0d9c63SKent Gibson #define GPIO_V2_LINE_VALID_FLAGS \ 4823c0d9c63SKent Gibson (GPIO_V2_LINE_FLAG_ACTIVE_LOW | \ 4833c0d9c63SKent Gibson GPIO_V2_LINE_DIRECTION_FLAGS | \ 4843c0d9c63SKent Gibson GPIO_V2_LINE_DRIVE_FLAGS | \ 48573e03419SKent Gibson GPIO_V2_LINE_EDGE_FLAGS | \ 4863c0d9c63SKent Gibson GPIO_V2_LINE_BIAS_FLAGS) 4873c0d9c63SKent Gibson 48873e03419SKent Gibson static void linereq_put_event(struct linereq *lr, 48973e03419SKent Gibson struct gpio_v2_line_event *le) 49073e03419SKent Gibson { 49173e03419SKent Gibson bool overflow = false; 49273e03419SKent Gibson 49373e03419SKent Gibson spin_lock(&lr->wait.lock); 49473e03419SKent Gibson if (kfifo_is_full(&lr->events)) { 49573e03419SKent Gibson overflow = true; 49673e03419SKent Gibson kfifo_skip(&lr->events); 49773e03419SKent Gibson } 49873e03419SKent Gibson kfifo_in(&lr->events, le, 1); 49973e03419SKent Gibson spin_unlock(&lr->wait.lock); 50073e03419SKent Gibson if (!overflow) 50173e03419SKent Gibson wake_up_poll(&lr->wait, EPOLLIN); 50273e03419SKent Gibson else 50373e03419SKent Gibson pr_debug_ratelimited("event FIFO is full - event dropped\n"); 50473e03419SKent Gibson } 50573e03419SKent Gibson 50673e03419SKent Gibson static irqreturn_t edge_irq_thread(int irq, void *p) 50773e03419SKent Gibson { 50873e03419SKent Gibson struct line *line = p; 50973e03419SKent Gibson struct linereq *lr = line->req; 51073e03419SKent Gibson struct gpio_v2_line_event le; 51173e03419SKent Gibson 51273e03419SKent Gibson /* Do not leak kernel stack to userspace */ 51373e03419SKent Gibson memset(&le, 0, sizeof(le)); 51473e03419SKent Gibson 51573e03419SKent Gibson if (line->timestamp_ns) { 51673e03419SKent Gibson le.timestamp_ns = line->timestamp_ns; 51773e03419SKent Gibson } else { 51873e03419SKent Gibson /* 51973e03419SKent Gibson * We may be running from a nested threaded interrupt in 52073e03419SKent Gibson * which case we didn't get the timestamp from 52173e03419SKent Gibson * edge_irq_handler(). 52273e03419SKent Gibson */ 52373e03419SKent Gibson le.timestamp_ns = ktime_get_ns(); 52473e03419SKent Gibson if (lr->num_lines != 1) 52573e03419SKent Gibson line->req_seqno = atomic_inc_return(&lr->seqno); 52673e03419SKent Gibson } 52773e03419SKent Gibson line->timestamp_ns = 0; 52873e03419SKent Gibson 52973e03419SKent Gibson if (line->eflags == (GPIO_V2_LINE_FLAG_EDGE_RISING | 53073e03419SKent Gibson GPIO_V2_LINE_FLAG_EDGE_FALLING)) { 53173e03419SKent Gibson int level = gpiod_get_value_cansleep(line->desc); 53273e03419SKent Gibson 53373e03419SKent Gibson if (level) 53473e03419SKent Gibson /* Emit low-to-high event */ 53573e03419SKent Gibson le.id = GPIO_V2_LINE_EVENT_RISING_EDGE; 53673e03419SKent Gibson else 53773e03419SKent Gibson /* Emit high-to-low event */ 53873e03419SKent Gibson le.id = GPIO_V2_LINE_EVENT_FALLING_EDGE; 53973e03419SKent Gibson } else if (line->eflags == GPIO_V2_LINE_FLAG_EDGE_RISING) { 54073e03419SKent Gibson /* Emit low-to-high event */ 54173e03419SKent Gibson le.id = GPIO_V2_LINE_EVENT_RISING_EDGE; 54273e03419SKent Gibson } else if (line->eflags == GPIO_V2_LINE_FLAG_EDGE_FALLING) { 54373e03419SKent Gibson /* Emit high-to-low event */ 54473e03419SKent Gibson le.id = GPIO_V2_LINE_EVENT_FALLING_EDGE; 54573e03419SKent Gibson } else { 54673e03419SKent Gibson return IRQ_NONE; 54773e03419SKent Gibson } 54873e03419SKent Gibson line->line_seqno++; 54973e03419SKent Gibson le.line_seqno = line->line_seqno; 55073e03419SKent Gibson le.seqno = (lr->num_lines == 1) ? le.line_seqno : line->req_seqno; 55173e03419SKent Gibson le.offset = gpio_chip_hwgpio(line->desc); 55273e03419SKent Gibson 55373e03419SKent Gibson linereq_put_event(lr, &le); 55473e03419SKent Gibson 55573e03419SKent Gibson return IRQ_HANDLED; 55673e03419SKent Gibson } 55773e03419SKent Gibson 55873e03419SKent Gibson static irqreturn_t edge_irq_handler(int irq, void *p) 55973e03419SKent Gibson { 56073e03419SKent Gibson struct line *line = p; 56173e03419SKent Gibson struct linereq *lr = line->req; 56273e03419SKent Gibson 56373e03419SKent Gibson /* 56473e03419SKent Gibson * Just store the timestamp in hardirq context so we get it as 56573e03419SKent Gibson * close in time as possible to the actual event. 56673e03419SKent Gibson */ 56773e03419SKent Gibson line->timestamp_ns = ktime_get_ns(); 56873e03419SKent Gibson 56973e03419SKent Gibson if (lr->num_lines != 1) 57073e03419SKent Gibson line->req_seqno = atomic_inc_return(&lr->seqno); 57173e03419SKent Gibson 57273e03419SKent Gibson return IRQ_WAKE_THREAD; 57373e03419SKent Gibson } 57473e03419SKent Gibson 57573e03419SKent Gibson static void edge_detector_stop(struct line *line) 57673e03419SKent Gibson { 57773e03419SKent Gibson if (line->irq) { 57873e03419SKent Gibson free_irq(line->irq, line); 57973e03419SKent Gibson line->irq = 0; 58073e03419SKent Gibson } 581*a54756cbSKent Gibson 582*a54756cbSKent Gibson line->eflags = 0; 58373e03419SKent Gibson } 58473e03419SKent Gibson 58573e03419SKent Gibson static int edge_detector_setup(struct line *line, 58673e03419SKent Gibson u64 eflags) 58773e03419SKent Gibson { 58873e03419SKent Gibson unsigned long irqflags = 0; 58973e03419SKent Gibson int irq, ret; 59073e03419SKent Gibson 59173e03419SKent Gibson if (eflags && !kfifo_initialized(&line->req->events)) { 59273e03419SKent Gibson ret = kfifo_alloc(&line->req->events, 59373e03419SKent Gibson line->req->event_buffer_size, GFP_KERNEL); 59473e03419SKent Gibson if (ret) 59573e03419SKent Gibson return ret; 59673e03419SKent Gibson } 59773e03419SKent Gibson line->eflags = eflags; 59873e03419SKent Gibson 59973e03419SKent Gibson if (!eflags) 60073e03419SKent Gibson return 0; 60173e03419SKent Gibson 60273e03419SKent Gibson irq = gpiod_to_irq(line->desc); 60373e03419SKent Gibson if (irq < 0) 60473e03419SKent Gibson return -ENXIO; 60573e03419SKent Gibson 60673e03419SKent Gibson if (eflags & GPIO_V2_LINE_FLAG_EDGE_RISING) 60773e03419SKent Gibson irqflags |= test_bit(FLAG_ACTIVE_LOW, &line->desc->flags) ? 60873e03419SKent Gibson IRQF_TRIGGER_FALLING : IRQF_TRIGGER_RISING; 60973e03419SKent Gibson if (eflags & GPIO_V2_LINE_FLAG_EDGE_FALLING) 61073e03419SKent Gibson irqflags |= test_bit(FLAG_ACTIVE_LOW, &line->desc->flags) ? 61173e03419SKent Gibson IRQF_TRIGGER_RISING : IRQF_TRIGGER_FALLING; 61273e03419SKent Gibson irqflags |= IRQF_ONESHOT; 61373e03419SKent Gibson 61473e03419SKent Gibson /* Request a thread to read the events */ 61573e03419SKent Gibson ret = request_threaded_irq(irq, edge_irq_handler, edge_irq_thread, 61673e03419SKent Gibson irqflags, line->req->label, line); 61773e03419SKent Gibson if (ret) 61873e03419SKent Gibson return ret; 61973e03419SKent Gibson 62073e03419SKent Gibson line->irq = irq; 62173e03419SKent Gibson return 0; 62273e03419SKent Gibson } 62373e03419SKent Gibson 624*a54756cbSKent Gibson static int edge_detector_update(struct line *line, u64 eflags, 625*a54756cbSKent Gibson bool polarity_change) 626*a54756cbSKent Gibson { 627*a54756cbSKent Gibson if ((line->eflags == eflags) && !polarity_change) 628*a54756cbSKent Gibson return 0; 629*a54756cbSKent Gibson 630*a54756cbSKent Gibson edge_detector_stop(line); 631*a54756cbSKent Gibson 632*a54756cbSKent Gibson return edge_detector_setup(line, eflags); 633*a54756cbSKent Gibson } 634*a54756cbSKent Gibson 6353c0d9c63SKent Gibson static u64 gpio_v2_line_config_flags(struct gpio_v2_line_config *lc, 6363c0d9c63SKent Gibson unsigned int line_idx) 6373c0d9c63SKent Gibson { 6383c0d9c63SKent Gibson unsigned int i; 6393c0d9c63SKent Gibson u64 mask = BIT_ULL(line_idx); 6403c0d9c63SKent Gibson 6413c0d9c63SKent Gibson for (i = 0; i < lc->num_attrs; i++) { 6423c0d9c63SKent Gibson if ((lc->attrs[i].attr.id == GPIO_V2_LINE_ATTR_ID_FLAGS) && 6433c0d9c63SKent Gibson (lc->attrs[i].mask & mask)) 6443c0d9c63SKent Gibson return lc->attrs[i].attr.flags; 6453c0d9c63SKent Gibson } 6463c0d9c63SKent Gibson return lc->flags; 6473c0d9c63SKent Gibson } 6483c0d9c63SKent Gibson 6493c0d9c63SKent Gibson static int gpio_v2_line_config_output_value(struct gpio_v2_line_config *lc, 6503c0d9c63SKent Gibson unsigned int line_idx) 6513c0d9c63SKent Gibson { 6523c0d9c63SKent Gibson unsigned int i; 6533c0d9c63SKent Gibson u64 mask = BIT_ULL(line_idx); 6543c0d9c63SKent Gibson 6553c0d9c63SKent Gibson for (i = 0; i < lc->num_attrs; i++) { 6563c0d9c63SKent Gibson if ((lc->attrs[i].attr.id == GPIO_V2_LINE_ATTR_ID_OUTPUT_VALUES) && 6573c0d9c63SKent Gibson (lc->attrs[i].mask & mask)) 6583c0d9c63SKent Gibson return !!(lc->attrs[i].attr.values & mask); 6593c0d9c63SKent Gibson } 6603c0d9c63SKent Gibson return 0; 6613c0d9c63SKent Gibson } 6623c0d9c63SKent Gibson 6633c0d9c63SKent Gibson static int gpio_v2_line_flags_validate(u64 flags) 6643c0d9c63SKent Gibson { 6653c0d9c63SKent Gibson /* Return an error if an unknown flag is set */ 6663c0d9c63SKent Gibson if (flags & ~GPIO_V2_LINE_VALID_FLAGS) 6673c0d9c63SKent Gibson return -EINVAL; 6683c0d9c63SKent Gibson 6693c0d9c63SKent Gibson /* 6703c0d9c63SKent Gibson * Do not allow both INPUT and OUTPUT flags to be set as they are 6713c0d9c63SKent Gibson * contradictory. 6723c0d9c63SKent Gibson */ 6733c0d9c63SKent Gibson if ((flags & GPIO_V2_LINE_FLAG_INPUT) && 6743c0d9c63SKent Gibson (flags & GPIO_V2_LINE_FLAG_OUTPUT)) 6753c0d9c63SKent Gibson return -EINVAL; 6763c0d9c63SKent Gibson 67773e03419SKent Gibson /* Edge detection requires explicit input. */ 67873e03419SKent Gibson if ((flags & GPIO_V2_LINE_EDGE_FLAGS) && 67973e03419SKent Gibson !(flags & GPIO_V2_LINE_FLAG_INPUT)) 68073e03419SKent Gibson return -EINVAL; 68173e03419SKent Gibson 6823c0d9c63SKent Gibson /* 6833c0d9c63SKent Gibson * Do not allow OPEN_SOURCE and OPEN_DRAIN flags in a single 6843c0d9c63SKent Gibson * request. If the hardware actually supports enabling both at the 6853c0d9c63SKent Gibson * same time the electrical result would be disastrous. 6863c0d9c63SKent Gibson */ 6873c0d9c63SKent Gibson if ((flags & GPIO_V2_LINE_FLAG_OPEN_DRAIN) && 6883c0d9c63SKent Gibson (flags & GPIO_V2_LINE_FLAG_OPEN_SOURCE)) 6893c0d9c63SKent Gibson return -EINVAL; 6903c0d9c63SKent Gibson 6913c0d9c63SKent Gibson /* Drive requires explicit output direction. */ 6923c0d9c63SKent Gibson if ((flags & GPIO_V2_LINE_DRIVE_FLAGS) && 6933c0d9c63SKent Gibson !(flags & GPIO_V2_LINE_FLAG_OUTPUT)) 6943c0d9c63SKent Gibson return -EINVAL; 6953c0d9c63SKent Gibson 6963c0d9c63SKent Gibson /* Bias requires explicit direction. */ 6973c0d9c63SKent Gibson if ((flags & GPIO_V2_LINE_BIAS_FLAGS) && 6983c0d9c63SKent Gibson !(flags & GPIO_V2_LINE_DIRECTION_FLAGS)) 6993c0d9c63SKent Gibson return -EINVAL; 7003c0d9c63SKent Gibson 7013c0d9c63SKent Gibson /* Only one bias flag can be set. */ 7023c0d9c63SKent Gibson if (((flags & GPIO_V2_LINE_FLAG_BIAS_DISABLED) && 7033c0d9c63SKent Gibson (flags & (GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN | 7043c0d9c63SKent Gibson GPIO_V2_LINE_FLAG_BIAS_PULL_UP))) || 7053c0d9c63SKent Gibson ((flags & GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN) && 7063c0d9c63SKent Gibson (flags & GPIO_V2_LINE_FLAG_BIAS_PULL_UP))) 7073c0d9c63SKent Gibson return -EINVAL; 7083c0d9c63SKent Gibson 7093c0d9c63SKent Gibson return 0; 7103c0d9c63SKent Gibson } 7113c0d9c63SKent Gibson 7123c0d9c63SKent Gibson static int gpio_v2_line_config_validate(struct gpio_v2_line_config *lc, 7133c0d9c63SKent Gibson unsigned int num_lines) 7143c0d9c63SKent Gibson { 7153c0d9c63SKent Gibson unsigned int i; 7163c0d9c63SKent Gibson u64 flags; 7173c0d9c63SKent Gibson int ret; 7183c0d9c63SKent Gibson 7193c0d9c63SKent Gibson if (lc->num_attrs > GPIO_V2_LINE_NUM_ATTRS_MAX) 7203c0d9c63SKent Gibson return -EINVAL; 7213c0d9c63SKent Gibson 7223c0d9c63SKent Gibson if (memchr_inv(lc->padding, 0, sizeof(lc->padding))) 7233c0d9c63SKent Gibson return -EINVAL; 7243c0d9c63SKent Gibson 7253c0d9c63SKent Gibson for (i = 0; i < num_lines; i++) { 7263c0d9c63SKent Gibson flags = gpio_v2_line_config_flags(lc, i); 7273c0d9c63SKent Gibson ret = gpio_v2_line_flags_validate(flags); 7283c0d9c63SKent Gibson if (ret) 7293c0d9c63SKent Gibson return ret; 7303c0d9c63SKent Gibson } 7313c0d9c63SKent Gibson return 0; 7323c0d9c63SKent Gibson } 7333c0d9c63SKent Gibson 7343c0d9c63SKent Gibson static void gpio_v2_line_config_flags_to_desc_flags(u64 flags, 7353c0d9c63SKent Gibson unsigned long *flagsp) 7363c0d9c63SKent Gibson { 7373c0d9c63SKent Gibson assign_bit(FLAG_ACTIVE_LOW, flagsp, 7383c0d9c63SKent Gibson flags & GPIO_V2_LINE_FLAG_ACTIVE_LOW); 7393c0d9c63SKent Gibson 7403c0d9c63SKent Gibson if (flags & GPIO_V2_LINE_FLAG_OUTPUT) 7413c0d9c63SKent Gibson set_bit(FLAG_IS_OUT, flagsp); 7423c0d9c63SKent Gibson else if (flags & GPIO_V2_LINE_FLAG_INPUT) 7433c0d9c63SKent Gibson clear_bit(FLAG_IS_OUT, flagsp); 7443c0d9c63SKent Gibson 74573e03419SKent Gibson assign_bit(FLAG_EDGE_RISING, flagsp, 74673e03419SKent Gibson flags & GPIO_V2_LINE_FLAG_EDGE_RISING); 74773e03419SKent Gibson assign_bit(FLAG_EDGE_FALLING, flagsp, 74873e03419SKent Gibson flags & GPIO_V2_LINE_FLAG_EDGE_FALLING); 74973e03419SKent Gibson 7503c0d9c63SKent Gibson assign_bit(FLAG_OPEN_DRAIN, flagsp, 7513c0d9c63SKent Gibson flags & GPIO_V2_LINE_FLAG_OPEN_DRAIN); 7523c0d9c63SKent Gibson assign_bit(FLAG_OPEN_SOURCE, flagsp, 7533c0d9c63SKent Gibson flags & GPIO_V2_LINE_FLAG_OPEN_SOURCE); 7543c0d9c63SKent Gibson 7553c0d9c63SKent Gibson assign_bit(FLAG_PULL_UP, flagsp, 7563c0d9c63SKent Gibson flags & GPIO_V2_LINE_FLAG_BIAS_PULL_UP); 7573c0d9c63SKent Gibson assign_bit(FLAG_PULL_DOWN, flagsp, 7583c0d9c63SKent Gibson flags & GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN); 7593c0d9c63SKent Gibson assign_bit(FLAG_BIAS_DISABLE, flagsp, 7603c0d9c63SKent Gibson flags & GPIO_V2_LINE_FLAG_BIAS_DISABLED); 7613c0d9c63SKent Gibson } 7623c0d9c63SKent Gibson 7633c0d9c63SKent Gibson static long linereq_get_values(struct linereq *lr, void __user *ip) 7643c0d9c63SKent Gibson { 7653c0d9c63SKent Gibson struct gpio_v2_line_values lv; 7663c0d9c63SKent Gibson DECLARE_BITMAP(vals, GPIO_V2_LINES_MAX); 7673c0d9c63SKent Gibson struct gpio_desc **descs; 7683c0d9c63SKent Gibson unsigned int i, didx, num_get; 7693c0d9c63SKent Gibson int ret; 7703c0d9c63SKent Gibson 7713c0d9c63SKent Gibson /* NOTE: It's ok to read values of output lines. */ 7723c0d9c63SKent Gibson if (copy_from_user(&lv, ip, sizeof(lv))) 7733c0d9c63SKent Gibson return -EFAULT; 7743c0d9c63SKent Gibson 7753c0d9c63SKent Gibson for (num_get = 0, i = 0; i < lr->num_lines; i++) { 7763c0d9c63SKent Gibson if (lv.mask & BIT_ULL(i)) { 7773c0d9c63SKent Gibson num_get++; 7783c0d9c63SKent Gibson descs = &lr->lines[i].desc; 7793c0d9c63SKent Gibson } 7803c0d9c63SKent Gibson } 7813c0d9c63SKent Gibson 7823c0d9c63SKent Gibson if (num_get == 0) 7833c0d9c63SKent Gibson return -EINVAL; 7843c0d9c63SKent Gibson 7853c0d9c63SKent Gibson if (num_get != 1) { 7863c0d9c63SKent Gibson descs = kmalloc_array(num_get, sizeof(*descs), GFP_KERNEL); 7873c0d9c63SKent Gibson if (!descs) 7883c0d9c63SKent Gibson return -ENOMEM; 7893c0d9c63SKent Gibson for (didx = 0, i = 0; i < lr->num_lines; i++) { 7903c0d9c63SKent Gibson if (lv.mask & BIT_ULL(i)) { 7913c0d9c63SKent Gibson descs[didx] = lr->lines[i].desc; 7923c0d9c63SKent Gibson didx++; 7933c0d9c63SKent Gibson } 7943c0d9c63SKent Gibson } 7953c0d9c63SKent Gibson } 7963c0d9c63SKent Gibson ret = gpiod_get_array_value_complex(false, true, num_get, 7973c0d9c63SKent Gibson descs, NULL, vals); 7983c0d9c63SKent Gibson 7993c0d9c63SKent Gibson if (num_get != 1) 8003c0d9c63SKent Gibson kfree(descs); 8013c0d9c63SKent Gibson if (ret) 8023c0d9c63SKent Gibson return ret; 8033c0d9c63SKent Gibson 8043c0d9c63SKent Gibson lv.bits = 0; 8053c0d9c63SKent Gibson for (didx = 0, i = 0; i < lr->num_lines; i++) { 8063c0d9c63SKent Gibson if (lv.mask & BIT_ULL(i)) { 8073c0d9c63SKent Gibson if (test_bit(didx, vals)) 8083c0d9c63SKent Gibson lv.bits |= BIT_ULL(i); 8093c0d9c63SKent Gibson didx++; 8103c0d9c63SKent Gibson } 8113c0d9c63SKent Gibson } 8123c0d9c63SKent Gibson 8133c0d9c63SKent Gibson if (copy_to_user(ip, &lv, sizeof(lv))) 8143c0d9c63SKent Gibson return -EFAULT; 8153c0d9c63SKent Gibson 8163c0d9c63SKent Gibson return 0; 8173c0d9c63SKent Gibson } 8183c0d9c63SKent Gibson 819*a54756cbSKent Gibson static long linereq_set_config_unlocked(struct linereq *lr, 820*a54756cbSKent Gibson struct gpio_v2_line_config *lc) 821*a54756cbSKent Gibson { 822*a54756cbSKent Gibson struct gpio_desc *desc; 823*a54756cbSKent Gibson unsigned int i; 824*a54756cbSKent Gibson u64 flags; 825*a54756cbSKent Gibson bool polarity_change; 826*a54756cbSKent Gibson int ret; 827*a54756cbSKent Gibson 828*a54756cbSKent Gibson for (i = 0; i < lr->num_lines; i++) { 829*a54756cbSKent Gibson desc = lr->lines[i].desc; 830*a54756cbSKent Gibson flags = gpio_v2_line_config_flags(lc, i); 831*a54756cbSKent Gibson polarity_change = 832*a54756cbSKent Gibson (!!test_bit(FLAG_ACTIVE_LOW, &desc->flags) != 833*a54756cbSKent Gibson ((flags & GPIO_V2_LINE_FLAG_ACTIVE_LOW) != 0)); 834*a54756cbSKent Gibson 835*a54756cbSKent Gibson gpio_v2_line_config_flags_to_desc_flags(flags, &desc->flags); 836*a54756cbSKent Gibson /* 837*a54756cbSKent Gibson * Lines have to be requested explicitly for input 838*a54756cbSKent Gibson * or output, else the line will be treated "as is". 839*a54756cbSKent Gibson */ 840*a54756cbSKent Gibson if (flags & GPIO_V2_LINE_FLAG_OUTPUT) { 841*a54756cbSKent Gibson int val = gpio_v2_line_config_output_value(lc, i); 842*a54756cbSKent Gibson 843*a54756cbSKent Gibson edge_detector_stop(&lr->lines[i]); 844*a54756cbSKent Gibson ret = gpiod_direction_output(desc, val); 845*a54756cbSKent Gibson if (ret) 846*a54756cbSKent Gibson return ret; 847*a54756cbSKent Gibson } else if (flags & GPIO_V2_LINE_FLAG_INPUT) { 848*a54756cbSKent Gibson ret = gpiod_direction_input(desc); 849*a54756cbSKent Gibson if (ret) 850*a54756cbSKent Gibson return ret; 851*a54756cbSKent Gibson 852*a54756cbSKent Gibson ret = edge_detector_update(&lr->lines[i], 853*a54756cbSKent Gibson flags & GPIO_V2_LINE_EDGE_FLAGS, 854*a54756cbSKent Gibson polarity_change); 855*a54756cbSKent Gibson if (ret) 856*a54756cbSKent Gibson return ret; 857*a54756cbSKent Gibson } 858*a54756cbSKent Gibson 859*a54756cbSKent Gibson blocking_notifier_call_chain(&desc->gdev->notifier, 860*a54756cbSKent Gibson GPIO_V2_LINE_CHANGED_CONFIG, 861*a54756cbSKent Gibson desc); 862*a54756cbSKent Gibson } 863*a54756cbSKent Gibson return 0; 864*a54756cbSKent Gibson } 865*a54756cbSKent Gibson 866*a54756cbSKent Gibson static long linereq_set_config(struct linereq *lr, void __user *ip) 867*a54756cbSKent Gibson { 868*a54756cbSKent Gibson struct gpio_v2_line_config lc; 869*a54756cbSKent Gibson int ret; 870*a54756cbSKent Gibson 871*a54756cbSKent Gibson if (copy_from_user(&lc, ip, sizeof(lc))) 872*a54756cbSKent Gibson return -EFAULT; 873*a54756cbSKent Gibson 874*a54756cbSKent Gibson ret = gpio_v2_line_config_validate(&lc, lr->num_lines); 875*a54756cbSKent Gibson if (ret) 876*a54756cbSKent Gibson return ret; 877*a54756cbSKent Gibson 878*a54756cbSKent Gibson mutex_lock(&lr->config_mutex); 879*a54756cbSKent Gibson 880*a54756cbSKent Gibson ret = linereq_set_config_unlocked(lr, &lc); 881*a54756cbSKent Gibson 882*a54756cbSKent Gibson mutex_unlock(&lr->config_mutex); 883*a54756cbSKent Gibson 884*a54756cbSKent Gibson return ret; 885*a54756cbSKent Gibson } 886*a54756cbSKent Gibson 8873c0d9c63SKent Gibson static long linereq_ioctl(struct file *file, unsigned int cmd, 8883c0d9c63SKent Gibson unsigned long arg) 8893c0d9c63SKent Gibson { 8903c0d9c63SKent Gibson struct linereq *lr = file->private_data; 8913c0d9c63SKent Gibson void __user *ip = (void __user *)arg; 8923c0d9c63SKent Gibson 8933c0d9c63SKent Gibson if (cmd == GPIO_V2_LINE_GET_VALUES_IOCTL) 8943c0d9c63SKent Gibson return linereq_get_values(lr, ip); 895*a54756cbSKent Gibson else if (cmd == GPIO_V2_LINE_SET_CONFIG_IOCTL) 896*a54756cbSKent Gibson return linereq_set_config(lr, ip); 8973c0d9c63SKent Gibson 8983c0d9c63SKent Gibson return -EINVAL; 8993c0d9c63SKent Gibson } 9003c0d9c63SKent Gibson 9013c0d9c63SKent Gibson #ifdef CONFIG_COMPAT 9023c0d9c63SKent Gibson static long linereq_ioctl_compat(struct file *file, unsigned int cmd, 9033c0d9c63SKent Gibson unsigned long arg) 9043c0d9c63SKent Gibson { 9053c0d9c63SKent Gibson return linereq_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 9063c0d9c63SKent Gibson } 9073c0d9c63SKent Gibson #endif 9083c0d9c63SKent Gibson 90973e03419SKent Gibson static __poll_t linereq_poll(struct file *file, 91073e03419SKent Gibson struct poll_table_struct *wait) 91173e03419SKent Gibson { 91273e03419SKent Gibson struct linereq *lr = file->private_data; 91373e03419SKent Gibson __poll_t events = 0; 91473e03419SKent Gibson 91573e03419SKent Gibson poll_wait(file, &lr->wait, wait); 91673e03419SKent Gibson 91773e03419SKent Gibson if (!kfifo_is_empty_spinlocked_noirqsave(&lr->events, 91873e03419SKent Gibson &lr->wait.lock)) 91973e03419SKent Gibson events = EPOLLIN | EPOLLRDNORM; 92073e03419SKent Gibson 92173e03419SKent Gibson return events; 92273e03419SKent Gibson } 92373e03419SKent Gibson 92473e03419SKent Gibson static ssize_t linereq_read(struct file *file, 92573e03419SKent Gibson char __user *buf, 92673e03419SKent Gibson size_t count, 92773e03419SKent Gibson loff_t *f_ps) 92873e03419SKent Gibson { 92973e03419SKent Gibson struct linereq *lr = file->private_data; 93073e03419SKent Gibson struct gpio_v2_line_event le; 93173e03419SKent Gibson ssize_t bytes_read = 0; 93273e03419SKent Gibson int ret; 93373e03419SKent Gibson 93473e03419SKent Gibson if (count < sizeof(le)) 93573e03419SKent Gibson return -EINVAL; 93673e03419SKent Gibson 93773e03419SKent Gibson do { 93873e03419SKent Gibson spin_lock(&lr->wait.lock); 93973e03419SKent Gibson if (kfifo_is_empty(&lr->events)) { 94073e03419SKent Gibson if (bytes_read) { 94173e03419SKent Gibson spin_unlock(&lr->wait.lock); 94273e03419SKent Gibson return bytes_read; 94373e03419SKent Gibson } 94473e03419SKent Gibson 94573e03419SKent Gibson if (file->f_flags & O_NONBLOCK) { 94673e03419SKent Gibson spin_unlock(&lr->wait.lock); 94773e03419SKent Gibson return -EAGAIN; 94873e03419SKent Gibson } 94973e03419SKent Gibson 95073e03419SKent Gibson ret = wait_event_interruptible_locked(lr->wait, 95173e03419SKent Gibson !kfifo_is_empty(&lr->events)); 95273e03419SKent Gibson if (ret) { 95373e03419SKent Gibson spin_unlock(&lr->wait.lock); 95473e03419SKent Gibson return ret; 95573e03419SKent Gibson } 95673e03419SKent Gibson } 95773e03419SKent Gibson 95873e03419SKent Gibson ret = kfifo_out(&lr->events, &le, 1); 95973e03419SKent Gibson spin_unlock(&lr->wait.lock); 96073e03419SKent Gibson if (ret != 1) { 96173e03419SKent Gibson /* 96273e03419SKent Gibson * This should never happen - we were holding the 96373e03419SKent Gibson * lock from the moment we learned the fifo is no 96473e03419SKent Gibson * longer empty until now. 96573e03419SKent Gibson */ 96673e03419SKent Gibson ret = -EIO; 96773e03419SKent Gibson break; 96873e03419SKent Gibson } 96973e03419SKent Gibson 97073e03419SKent Gibson if (copy_to_user(buf + bytes_read, &le, sizeof(le))) 97173e03419SKent Gibson return -EFAULT; 97273e03419SKent Gibson bytes_read += sizeof(le); 97373e03419SKent Gibson } while (count >= bytes_read + sizeof(le)); 97473e03419SKent Gibson 97573e03419SKent Gibson return bytes_read; 97673e03419SKent Gibson } 97773e03419SKent Gibson 9783c0d9c63SKent Gibson static void linereq_free(struct linereq *lr) 9793c0d9c63SKent Gibson { 9803c0d9c63SKent Gibson unsigned int i; 9813c0d9c63SKent Gibson 9823c0d9c63SKent Gibson for (i = 0; i < lr->num_lines; i++) { 98373e03419SKent Gibson edge_detector_stop(&lr->lines[i]); 9843c0d9c63SKent Gibson if (lr->lines[i].desc) 9853c0d9c63SKent Gibson gpiod_free(lr->lines[i].desc); 9863c0d9c63SKent Gibson } 98773e03419SKent Gibson kfifo_free(&lr->events); 9883c0d9c63SKent Gibson kfree(lr->label); 9893c0d9c63SKent Gibson put_device(&lr->gdev->dev); 9903c0d9c63SKent Gibson kfree(lr); 9913c0d9c63SKent Gibson } 9923c0d9c63SKent Gibson 9933c0d9c63SKent Gibson static int linereq_release(struct inode *inode, struct file *file) 9943c0d9c63SKent Gibson { 9953c0d9c63SKent Gibson struct linereq *lr = file->private_data; 9963c0d9c63SKent Gibson 9973c0d9c63SKent Gibson linereq_free(lr); 9983c0d9c63SKent Gibson return 0; 9993c0d9c63SKent Gibson } 10003c0d9c63SKent Gibson 10013c0d9c63SKent Gibson static const struct file_operations line_fileops = { 10023c0d9c63SKent Gibson .release = linereq_release, 100373e03419SKent Gibson .read = linereq_read, 100473e03419SKent Gibson .poll = linereq_poll, 10053c0d9c63SKent Gibson .owner = THIS_MODULE, 10063c0d9c63SKent Gibson .llseek = noop_llseek, 10073c0d9c63SKent Gibson .unlocked_ioctl = linereq_ioctl, 10083c0d9c63SKent Gibson #ifdef CONFIG_COMPAT 10093c0d9c63SKent Gibson .compat_ioctl = linereq_ioctl_compat, 10103c0d9c63SKent Gibson #endif 10113c0d9c63SKent Gibson }; 10123c0d9c63SKent Gibson 10133c0d9c63SKent Gibson static int linereq_create(struct gpio_device *gdev, void __user *ip) 10143c0d9c63SKent Gibson { 10153c0d9c63SKent Gibson struct gpio_v2_line_request ulr; 10163c0d9c63SKent Gibson struct gpio_v2_line_config *lc; 10173c0d9c63SKent Gibson struct linereq *lr; 10183c0d9c63SKent Gibson struct file *file; 10193c0d9c63SKent Gibson u64 flags; 10203c0d9c63SKent Gibson unsigned int i; 10213c0d9c63SKent Gibson int fd, ret; 10223c0d9c63SKent Gibson 10233c0d9c63SKent Gibson if (copy_from_user(&ulr, ip, sizeof(ulr))) 10243c0d9c63SKent Gibson return -EFAULT; 10253c0d9c63SKent Gibson 10263c0d9c63SKent Gibson if ((ulr.num_lines == 0) || (ulr.num_lines > GPIO_V2_LINES_MAX)) 10273c0d9c63SKent Gibson return -EINVAL; 10283c0d9c63SKent Gibson 10293c0d9c63SKent Gibson if (memchr_inv(ulr.padding, 0, sizeof(ulr.padding))) 10303c0d9c63SKent Gibson return -EINVAL; 10313c0d9c63SKent Gibson 10323c0d9c63SKent Gibson lc = &ulr.config; 10333c0d9c63SKent Gibson ret = gpio_v2_line_config_validate(lc, ulr.num_lines); 10343c0d9c63SKent Gibson if (ret) 10353c0d9c63SKent Gibson return ret; 10363c0d9c63SKent Gibson 10373c0d9c63SKent Gibson lr = kzalloc(struct_size(lr, lines, ulr.num_lines), GFP_KERNEL); 10383c0d9c63SKent Gibson if (!lr) 10393c0d9c63SKent Gibson return -ENOMEM; 10403c0d9c63SKent Gibson 10413c0d9c63SKent Gibson lr->gdev = gdev; 10423c0d9c63SKent Gibson get_device(&gdev->dev); 10433c0d9c63SKent Gibson 104473e03419SKent Gibson for (i = 0; i < ulr.num_lines; i++) 104573e03419SKent Gibson lr->lines[i].req = lr; 104673e03419SKent Gibson 10473c0d9c63SKent Gibson /* Make sure this is terminated */ 10483c0d9c63SKent Gibson ulr.consumer[sizeof(ulr.consumer)-1] = '\0'; 10493c0d9c63SKent Gibson if (strlen(ulr.consumer)) { 10503c0d9c63SKent Gibson /* label is only initialized if consumer is set */ 10513c0d9c63SKent Gibson lr->label = kstrdup(ulr.consumer, GFP_KERNEL); 10523c0d9c63SKent Gibson if (!lr->label) { 10533c0d9c63SKent Gibson ret = -ENOMEM; 10543c0d9c63SKent Gibson goto out_free_linereq; 10553c0d9c63SKent Gibson } 10563c0d9c63SKent Gibson } 10573c0d9c63SKent Gibson 1058*a54756cbSKent Gibson mutex_init(&lr->config_mutex); 105973e03419SKent Gibson init_waitqueue_head(&lr->wait); 106073e03419SKent Gibson lr->event_buffer_size = ulr.event_buffer_size; 106173e03419SKent Gibson if (lr->event_buffer_size == 0) 106273e03419SKent Gibson lr->event_buffer_size = ulr.num_lines * 16; 106373e03419SKent Gibson else if (lr->event_buffer_size > GPIO_V2_LINES_MAX * 16) 106473e03419SKent Gibson lr->event_buffer_size = GPIO_V2_LINES_MAX * 16; 106573e03419SKent Gibson 106673e03419SKent Gibson atomic_set(&lr->seqno, 0); 10673c0d9c63SKent Gibson lr->num_lines = ulr.num_lines; 10683c0d9c63SKent Gibson 10693c0d9c63SKent Gibson /* Request each GPIO */ 10703c0d9c63SKent Gibson for (i = 0; i < ulr.num_lines; i++) { 10713c0d9c63SKent Gibson u32 offset = ulr.offsets[i]; 10723c0d9c63SKent Gibson struct gpio_desc *desc = gpiochip_get_desc(gdev->chip, offset); 10733c0d9c63SKent Gibson 10743c0d9c63SKent Gibson if (IS_ERR(desc)) { 10753c0d9c63SKent Gibson ret = PTR_ERR(desc); 10763c0d9c63SKent Gibson goto out_free_linereq; 10773c0d9c63SKent Gibson } 10783c0d9c63SKent Gibson 10793c0d9c63SKent Gibson ret = gpiod_request(desc, lr->label); 10803c0d9c63SKent Gibson if (ret) 10813c0d9c63SKent Gibson goto out_free_linereq; 10823c0d9c63SKent Gibson 10833c0d9c63SKent Gibson lr->lines[i].desc = desc; 10843c0d9c63SKent Gibson flags = gpio_v2_line_config_flags(lc, i); 10853c0d9c63SKent Gibson gpio_v2_line_config_flags_to_desc_flags(flags, &desc->flags); 10863c0d9c63SKent Gibson 10873c0d9c63SKent Gibson ret = gpiod_set_transitory(desc, false); 10883c0d9c63SKent Gibson if (ret < 0) 10893c0d9c63SKent Gibson goto out_free_linereq; 10903c0d9c63SKent Gibson 10913c0d9c63SKent Gibson /* 10923c0d9c63SKent Gibson * Lines have to be requested explicitly for input 10933c0d9c63SKent Gibson * or output, else the line will be treated "as is". 10943c0d9c63SKent Gibson */ 10953c0d9c63SKent Gibson if (flags & GPIO_V2_LINE_FLAG_OUTPUT) { 10963c0d9c63SKent Gibson int val = gpio_v2_line_config_output_value(lc, i); 10973c0d9c63SKent Gibson 10983c0d9c63SKent Gibson ret = gpiod_direction_output(desc, val); 10993c0d9c63SKent Gibson if (ret) 11003c0d9c63SKent Gibson goto out_free_linereq; 11013c0d9c63SKent Gibson } else if (flags & GPIO_V2_LINE_FLAG_INPUT) { 11023c0d9c63SKent Gibson ret = gpiod_direction_input(desc); 11033c0d9c63SKent Gibson if (ret) 11043c0d9c63SKent Gibson goto out_free_linereq; 110573e03419SKent Gibson 110673e03419SKent Gibson ret = edge_detector_setup(&lr->lines[i], 110773e03419SKent Gibson flags & GPIO_V2_LINE_EDGE_FLAGS); 110873e03419SKent Gibson if (ret) 110973e03419SKent Gibson goto out_free_linereq; 11103c0d9c63SKent Gibson } 11113c0d9c63SKent Gibson 11123c0d9c63SKent Gibson blocking_notifier_call_chain(&desc->gdev->notifier, 1113aad95584SKent Gibson GPIO_V2_LINE_CHANGED_REQUESTED, desc); 11143c0d9c63SKent Gibson 11153c0d9c63SKent Gibson dev_dbg(&gdev->dev, "registered chardev handle for line %d\n", 11163c0d9c63SKent Gibson offset); 11173c0d9c63SKent Gibson } 11183c0d9c63SKent Gibson 11193c0d9c63SKent Gibson fd = get_unused_fd_flags(O_RDONLY | O_CLOEXEC); 11203c0d9c63SKent Gibson if (fd < 0) { 11213c0d9c63SKent Gibson ret = fd; 11223c0d9c63SKent Gibson goto out_free_linereq; 11233c0d9c63SKent Gibson } 11243c0d9c63SKent Gibson 11253c0d9c63SKent Gibson file = anon_inode_getfile("gpio-line", &line_fileops, lr, 11263c0d9c63SKent Gibson O_RDONLY | O_CLOEXEC); 11273c0d9c63SKent Gibson if (IS_ERR(file)) { 11283c0d9c63SKent Gibson ret = PTR_ERR(file); 11293c0d9c63SKent Gibson goto out_put_unused_fd; 11303c0d9c63SKent Gibson } 11313c0d9c63SKent Gibson 11323c0d9c63SKent Gibson ulr.fd = fd; 11333c0d9c63SKent Gibson if (copy_to_user(ip, &ulr, sizeof(ulr))) { 11343c0d9c63SKent Gibson /* 11353c0d9c63SKent Gibson * fput() will trigger the release() callback, so do not go onto 11363c0d9c63SKent Gibson * the regular error cleanup path here. 11373c0d9c63SKent Gibson */ 11383c0d9c63SKent Gibson fput(file); 11393c0d9c63SKent Gibson put_unused_fd(fd); 11403c0d9c63SKent Gibson return -EFAULT; 11413c0d9c63SKent Gibson } 11423c0d9c63SKent Gibson 11433c0d9c63SKent Gibson fd_install(fd, file); 11443c0d9c63SKent Gibson 11453c0d9c63SKent Gibson dev_dbg(&gdev->dev, "registered chardev handle for %d lines\n", 11463c0d9c63SKent Gibson lr->num_lines); 11473c0d9c63SKent Gibson 11483c0d9c63SKent Gibson return 0; 11493c0d9c63SKent Gibson 11503c0d9c63SKent Gibson out_put_unused_fd: 11513c0d9c63SKent Gibson put_unused_fd(fd); 11523c0d9c63SKent Gibson out_free_linereq: 11533c0d9c63SKent Gibson linereq_free(lr); 11543c0d9c63SKent Gibson return ret; 11553c0d9c63SKent Gibson } 11563c0d9c63SKent Gibson 11573c0d9c63SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1158925ca369SKent Gibson 1159925ca369SKent Gibson /* 1160925ca369SKent Gibson * GPIO line event management 1161925ca369SKent Gibson */ 1162925ca369SKent Gibson 1163925ca369SKent Gibson /** 1164925ca369SKent Gibson * struct lineevent_state - contains the state of a userspace event 1165925ca369SKent Gibson * @gdev: the GPIO device the event pertains to 1166925ca369SKent Gibson * @label: consumer label used to tag descriptors 1167925ca369SKent Gibson * @desc: the GPIO descriptor held by this event 1168925ca369SKent Gibson * @eflags: the event flags this line was requested with 1169925ca369SKent Gibson * @irq: the interrupt that trigger in response to events on this GPIO 1170925ca369SKent Gibson * @wait: wait queue that handles blocking reads of events 1171925ca369SKent Gibson * @events: KFIFO for the GPIO events 1172925ca369SKent Gibson * @timestamp: cache for the timestamp storing it between hardirq 1173925ca369SKent Gibson * and IRQ thread, used to bring the timestamp close to the actual 1174925ca369SKent Gibson * event 1175925ca369SKent Gibson */ 1176925ca369SKent Gibson struct lineevent_state { 1177925ca369SKent Gibson struct gpio_device *gdev; 1178925ca369SKent Gibson const char *label; 1179925ca369SKent Gibson struct gpio_desc *desc; 1180925ca369SKent Gibson u32 eflags; 1181925ca369SKent Gibson int irq; 1182925ca369SKent Gibson wait_queue_head_t wait; 1183925ca369SKent Gibson DECLARE_KFIFO(events, struct gpioevent_data, 16); 1184925ca369SKent Gibson u64 timestamp; 1185925ca369SKent Gibson }; 1186925ca369SKent Gibson 1187925ca369SKent Gibson #define GPIOEVENT_REQUEST_VALID_FLAGS \ 1188925ca369SKent Gibson (GPIOEVENT_REQUEST_RISING_EDGE | \ 1189925ca369SKent Gibson GPIOEVENT_REQUEST_FALLING_EDGE) 1190925ca369SKent Gibson 119149bc5279SKent Gibson static __poll_t lineevent_poll(struct file *file, 1192925ca369SKent Gibson struct poll_table_struct *wait) 1193925ca369SKent Gibson { 119449bc5279SKent Gibson struct lineevent_state *le = file->private_data; 1195925ca369SKent Gibson __poll_t events = 0; 1196925ca369SKent Gibson 119749bc5279SKent Gibson poll_wait(file, &le->wait, wait); 1198925ca369SKent Gibson 1199925ca369SKent Gibson if (!kfifo_is_empty_spinlocked_noirqsave(&le->events, &le->wait.lock)) 1200925ca369SKent Gibson events = EPOLLIN | EPOLLRDNORM; 1201925ca369SKent Gibson 1202925ca369SKent Gibson return events; 1203925ca369SKent Gibson } 1204925ca369SKent Gibson 1205925ca369SKent Gibson 120649bc5279SKent Gibson static ssize_t lineevent_read(struct file *file, 1207925ca369SKent Gibson char __user *buf, 1208925ca369SKent Gibson size_t count, 1209925ca369SKent Gibson loff_t *f_ps) 1210925ca369SKent Gibson { 121149bc5279SKent Gibson struct lineevent_state *le = file->private_data; 1212925ca369SKent Gibson struct gpioevent_data ge; 1213925ca369SKent Gibson ssize_t bytes_read = 0; 1214925ca369SKent Gibson int ret; 1215925ca369SKent Gibson 1216925ca369SKent Gibson if (count < sizeof(ge)) 1217925ca369SKent Gibson return -EINVAL; 1218925ca369SKent Gibson 1219925ca369SKent Gibson do { 1220925ca369SKent Gibson spin_lock(&le->wait.lock); 1221925ca369SKent Gibson if (kfifo_is_empty(&le->events)) { 1222925ca369SKent Gibson if (bytes_read) { 1223925ca369SKent Gibson spin_unlock(&le->wait.lock); 1224925ca369SKent Gibson return bytes_read; 1225925ca369SKent Gibson } 1226925ca369SKent Gibson 122749bc5279SKent Gibson if (file->f_flags & O_NONBLOCK) { 1228925ca369SKent Gibson spin_unlock(&le->wait.lock); 1229925ca369SKent Gibson return -EAGAIN; 1230925ca369SKent Gibson } 1231925ca369SKent Gibson 1232925ca369SKent Gibson ret = wait_event_interruptible_locked(le->wait, 1233925ca369SKent Gibson !kfifo_is_empty(&le->events)); 1234925ca369SKent Gibson if (ret) { 1235925ca369SKent Gibson spin_unlock(&le->wait.lock); 1236925ca369SKent Gibson return ret; 1237925ca369SKent Gibson } 1238925ca369SKent Gibson } 1239925ca369SKent Gibson 1240925ca369SKent Gibson ret = kfifo_out(&le->events, &ge, 1); 1241925ca369SKent Gibson spin_unlock(&le->wait.lock); 1242925ca369SKent Gibson if (ret != 1) { 1243925ca369SKent Gibson /* 1244925ca369SKent Gibson * This should never happen - we were holding the lock 1245925ca369SKent Gibson * from the moment we learned the fifo is no longer 1246925ca369SKent Gibson * empty until now. 1247925ca369SKent Gibson */ 1248925ca369SKent Gibson ret = -EIO; 1249925ca369SKent Gibson break; 1250925ca369SKent Gibson } 1251925ca369SKent Gibson 1252925ca369SKent Gibson if (copy_to_user(buf + bytes_read, &ge, sizeof(ge))) 1253925ca369SKent Gibson return -EFAULT; 1254925ca369SKent Gibson bytes_read += sizeof(ge); 1255925ca369SKent Gibson } while (count >= bytes_read + sizeof(ge)); 1256925ca369SKent Gibson 1257925ca369SKent Gibson return bytes_read; 1258925ca369SKent Gibson } 1259925ca369SKent Gibson 126046824272SKent Gibson static void lineevent_free(struct lineevent_state *le) 1261925ca369SKent Gibson { 126246824272SKent Gibson if (le->irq) 1263925ca369SKent Gibson free_irq(le->irq, le); 126446824272SKent Gibson if (le->desc) 1265925ca369SKent Gibson gpiod_free(le->desc); 1266925ca369SKent Gibson kfree(le->label); 126746824272SKent Gibson put_device(&le->gdev->dev); 1268925ca369SKent Gibson kfree(le); 126946824272SKent Gibson } 127046824272SKent Gibson 127146824272SKent Gibson static int lineevent_release(struct inode *inode, struct file *file) 127246824272SKent Gibson { 127346824272SKent Gibson lineevent_free(file->private_data); 1274925ca369SKent Gibson return 0; 1275925ca369SKent Gibson } 1276925ca369SKent Gibson 127749bc5279SKent Gibson static long lineevent_ioctl(struct file *file, unsigned int cmd, 1278925ca369SKent Gibson unsigned long arg) 1279925ca369SKent Gibson { 128049bc5279SKent Gibson struct lineevent_state *le = file->private_data; 1281925ca369SKent Gibson void __user *ip = (void __user *)arg; 1282925ca369SKent Gibson struct gpiohandle_data ghd; 1283925ca369SKent Gibson 1284925ca369SKent Gibson /* 1285925ca369SKent Gibson * We can get the value for an event line but not set it, 1286925ca369SKent Gibson * because it is input by definition. 1287925ca369SKent Gibson */ 1288925ca369SKent Gibson if (cmd == GPIOHANDLE_GET_LINE_VALUES_IOCTL) { 1289925ca369SKent Gibson int val; 1290925ca369SKent Gibson 1291925ca369SKent Gibson memset(&ghd, 0, sizeof(ghd)); 1292925ca369SKent Gibson 1293925ca369SKent Gibson val = gpiod_get_value_cansleep(le->desc); 1294925ca369SKent Gibson if (val < 0) 1295925ca369SKent Gibson return val; 1296925ca369SKent Gibson ghd.values[0] = val; 1297925ca369SKent Gibson 1298925ca369SKent Gibson if (copy_to_user(ip, &ghd, sizeof(ghd))) 1299925ca369SKent Gibson return -EFAULT; 1300925ca369SKent Gibson 1301925ca369SKent Gibson return 0; 1302925ca369SKent Gibson } 1303925ca369SKent Gibson return -EINVAL; 1304925ca369SKent Gibson } 1305925ca369SKent Gibson 1306925ca369SKent Gibson #ifdef CONFIG_COMPAT 130749bc5279SKent Gibson static long lineevent_ioctl_compat(struct file *file, unsigned int cmd, 1308925ca369SKent Gibson unsigned long arg) 1309925ca369SKent Gibson { 131049bc5279SKent Gibson return lineevent_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 1311925ca369SKent Gibson } 1312925ca369SKent Gibson #endif 1313925ca369SKent Gibson 1314925ca369SKent Gibson static const struct file_operations lineevent_fileops = { 1315925ca369SKent Gibson .release = lineevent_release, 1316925ca369SKent Gibson .read = lineevent_read, 1317925ca369SKent Gibson .poll = lineevent_poll, 1318925ca369SKent Gibson .owner = THIS_MODULE, 1319925ca369SKent Gibson .llseek = noop_llseek, 1320925ca369SKent Gibson .unlocked_ioctl = lineevent_ioctl, 1321925ca369SKent Gibson #ifdef CONFIG_COMPAT 1322925ca369SKent Gibson .compat_ioctl = lineevent_ioctl_compat, 1323925ca369SKent Gibson #endif 1324925ca369SKent Gibson }; 1325925ca369SKent Gibson 1326925ca369SKent Gibson static irqreturn_t lineevent_irq_thread(int irq, void *p) 1327925ca369SKent Gibson { 1328925ca369SKent Gibson struct lineevent_state *le = p; 1329925ca369SKent Gibson struct gpioevent_data ge; 1330925ca369SKent Gibson int ret; 1331925ca369SKent Gibson 1332925ca369SKent Gibson /* Do not leak kernel stack to userspace */ 1333925ca369SKent Gibson memset(&ge, 0, sizeof(ge)); 1334925ca369SKent Gibson 1335925ca369SKent Gibson /* 1336925ca369SKent Gibson * We may be running from a nested threaded interrupt in which case 1337925ca369SKent Gibson * we didn't get the timestamp from lineevent_irq_handler(). 1338925ca369SKent Gibson */ 1339925ca369SKent Gibson if (!le->timestamp) 1340925ca369SKent Gibson ge.timestamp = ktime_get_ns(); 1341925ca369SKent Gibson else 1342925ca369SKent Gibson ge.timestamp = le->timestamp; 1343925ca369SKent Gibson 1344925ca369SKent Gibson if (le->eflags & GPIOEVENT_REQUEST_RISING_EDGE 1345925ca369SKent Gibson && le->eflags & GPIOEVENT_REQUEST_FALLING_EDGE) { 1346925ca369SKent Gibson int level = gpiod_get_value_cansleep(le->desc); 1347925ca369SKent Gibson 1348925ca369SKent Gibson if (level) 1349925ca369SKent Gibson /* Emit low-to-high event */ 1350925ca369SKent Gibson ge.id = GPIOEVENT_EVENT_RISING_EDGE; 1351925ca369SKent Gibson else 1352925ca369SKent Gibson /* Emit high-to-low event */ 1353925ca369SKent Gibson ge.id = GPIOEVENT_EVENT_FALLING_EDGE; 1354925ca369SKent Gibson } else if (le->eflags & GPIOEVENT_REQUEST_RISING_EDGE) { 1355925ca369SKent Gibson /* Emit low-to-high event */ 1356925ca369SKent Gibson ge.id = GPIOEVENT_EVENT_RISING_EDGE; 1357925ca369SKent Gibson } else if (le->eflags & GPIOEVENT_REQUEST_FALLING_EDGE) { 1358925ca369SKent Gibson /* Emit high-to-low event */ 1359925ca369SKent Gibson ge.id = GPIOEVENT_EVENT_FALLING_EDGE; 1360925ca369SKent Gibson } else { 1361925ca369SKent Gibson return IRQ_NONE; 1362925ca369SKent Gibson } 1363925ca369SKent Gibson 1364925ca369SKent Gibson ret = kfifo_in_spinlocked_noirqsave(&le->events, &ge, 1365925ca369SKent Gibson 1, &le->wait.lock); 1366925ca369SKent Gibson if (ret) 1367925ca369SKent Gibson wake_up_poll(&le->wait, EPOLLIN); 1368925ca369SKent Gibson else 1369925ca369SKent Gibson pr_debug_ratelimited("event FIFO is full - event dropped\n"); 1370925ca369SKent Gibson 1371925ca369SKent Gibson return IRQ_HANDLED; 1372925ca369SKent Gibson } 1373925ca369SKent Gibson 1374925ca369SKent Gibson static irqreturn_t lineevent_irq_handler(int irq, void *p) 1375925ca369SKent Gibson { 1376925ca369SKent Gibson struct lineevent_state *le = p; 1377925ca369SKent Gibson 1378925ca369SKent Gibson /* 1379925ca369SKent Gibson * Just store the timestamp in hardirq context so we get it as 1380925ca369SKent Gibson * close in time as possible to the actual event. 1381925ca369SKent Gibson */ 1382925ca369SKent Gibson le->timestamp = ktime_get_ns(); 1383925ca369SKent Gibson 1384925ca369SKent Gibson return IRQ_WAKE_THREAD; 1385925ca369SKent Gibson } 1386925ca369SKent Gibson 1387925ca369SKent Gibson static int lineevent_create(struct gpio_device *gdev, void __user *ip) 1388925ca369SKent Gibson { 1389925ca369SKent Gibson struct gpioevent_request eventreq; 1390925ca369SKent Gibson struct lineevent_state *le; 1391925ca369SKent Gibson struct gpio_desc *desc; 1392925ca369SKent Gibson struct file *file; 1393925ca369SKent Gibson u32 offset; 1394925ca369SKent Gibson u32 lflags; 1395925ca369SKent Gibson u32 eflags; 1396925ca369SKent Gibson int fd; 1397925ca369SKent Gibson int ret; 139846824272SKent Gibson int irq, irqflags = 0; 1399925ca369SKent Gibson 1400925ca369SKent Gibson if (copy_from_user(&eventreq, ip, sizeof(eventreq))) 1401925ca369SKent Gibson return -EFAULT; 1402925ca369SKent Gibson 1403925ca369SKent Gibson offset = eventreq.lineoffset; 1404925ca369SKent Gibson lflags = eventreq.handleflags; 1405925ca369SKent Gibson eflags = eventreq.eventflags; 1406925ca369SKent Gibson 1407925ca369SKent Gibson desc = gpiochip_get_desc(gdev->chip, offset); 1408925ca369SKent Gibson if (IS_ERR(desc)) 1409925ca369SKent Gibson return PTR_ERR(desc); 1410925ca369SKent Gibson 1411925ca369SKent Gibson /* Return an error if a unknown flag is set */ 1412925ca369SKent Gibson if ((lflags & ~GPIOHANDLE_REQUEST_VALID_FLAGS) || 1413925ca369SKent Gibson (eflags & ~GPIOEVENT_REQUEST_VALID_FLAGS)) 1414925ca369SKent Gibson return -EINVAL; 1415925ca369SKent Gibson 1416925ca369SKent Gibson /* This is just wrong: we don't look for events on output lines */ 1417925ca369SKent Gibson if ((lflags & GPIOHANDLE_REQUEST_OUTPUT) || 1418925ca369SKent Gibson (lflags & GPIOHANDLE_REQUEST_OPEN_DRAIN) || 1419925ca369SKent Gibson (lflags & GPIOHANDLE_REQUEST_OPEN_SOURCE)) 1420925ca369SKent Gibson return -EINVAL; 1421925ca369SKent Gibson 1422925ca369SKent Gibson /* Only one bias flag can be set. */ 1423925ca369SKent Gibson if (((lflags & GPIOHANDLE_REQUEST_BIAS_DISABLE) && 1424925ca369SKent Gibson (lflags & (GPIOHANDLE_REQUEST_BIAS_PULL_DOWN | 1425925ca369SKent Gibson GPIOHANDLE_REQUEST_BIAS_PULL_UP))) || 1426925ca369SKent Gibson ((lflags & GPIOHANDLE_REQUEST_BIAS_PULL_DOWN) && 1427925ca369SKent Gibson (lflags & GPIOHANDLE_REQUEST_BIAS_PULL_UP))) 1428925ca369SKent Gibson return -EINVAL; 1429925ca369SKent Gibson 1430925ca369SKent Gibson le = kzalloc(sizeof(*le), GFP_KERNEL); 1431925ca369SKent Gibson if (!le) 1432925ca369SKent Gibson return -ENOMEM; 1433925ca369SKent Gibson le->gdev = gdev; 1434925ca369SKent Gibson get_device(&gdev->dev); 1435925ca369SKent Gibson 1436925ca369SKent Gibson /* Make sure this is terminated */ 1437925ca369SKent Gibson eventreq.consumer_label[sizeof(eventreq.consumer_label)-1] = '\0'; 1438925ca369SKent Gibson if (strlen(eventreq.consumer_label)) { 1439925ca369SKent Gibson le->label = kstrdup(eventreq.consumer_label, 1440925ca369SKent Gibson GFP_KERNEL); 1441925ca369SKent Gibson if (!le->label) { 1442925ca369SKent Gibson ret = -ENOMEM; 1443925ca369SKent Gibson goto out_free_le; 1444925ca369SKent Gibson } 1445925ca369SKent Gibson } 1446925ca369SKent Gibson 1447925ca369SKent Gibson ret = gpiod_request(desc, le->label); 1448925ca369SKent Gibson if (ret) 144946824272SKent Gibson goto out_free_le; 1450925ca369SKent Gibson le->desc = desc; 1451925ca369SKent Gibson le->eflags = eflags; 1452925ca369SKent Gibson 1453c274b58aSKent Gibson linehandle_flags_to_desc_flags(lflags, &desc->flags); 1454925ca369SKent Gibson 1455925ca369SKent Gibson ret = gpiod_direction_input(desc); 1456925ca369SKent Gibson if (ret) 145746824272SKent Gibson goto out_free_le; 1458925ca369SKent Gibson 14596accc376SKent Gibson blocking_notifier_call_chain(&desc->gdev->notifier, 1460aad95584SKent Gibson GPIO_V2_LINE_CHANGED_REQUESTED, desc); 1461925ca369SKent Gibson 146246824272SKent Gibson irq = gpiod_to_irq(desc); 146346824272SKent Gibson if (irq <= 0) { 1464925ca369SKent Gibson ret = -ENODEV; 146546824272SKent Gibson goto out_free_le; 1466925ca369SKent Gibson } 146746824272SKent Gibson le->irq = irq; 1468925ca369SKent Gibson 1469925ca369SKent Gibson if (eflags & GPIOEVENT_REQUEST_RISING_EDGE) 1470925ca369SKent Gibson irqflags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ? 1471925ca369SKent Gibson IRQF_TRIGGER_FALLING : IRQF_TRIGGER_RISING; 1472925ca369SKent Gibson if (eflags & GPIOEVENT_REQUEST_FALLING_EDGE) 1473925ca369SKent Gibson irqflags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ? 1474925ca369SKent Gibson IRQF_TRIGGER_RISING : IRQF_TRIGGER_FALLING; 1475925ca369SKent Gibson irqflags |= IRQF_ONESHOT; 1476925ca369SKent Gibson 1477925ca369SKent Gibson INIT_KFIFO(le->events); 1478925ca369SKent Gibson init_waitqueue_head(&le->wait); 1479925ca369SKent Gibson 1480925ca369SKent Gibson /* Request a thread to read the events */ 1481925ca369SKent Gibson ret = request_threaded_irq(le->irq, 1482925ca369SKent Gibson lineevent_irq_handler, 1483925ca369SKent Gibson lineevent_irq_thread, 1484925ca369SKent Gibson irqflags, 1485925ca369SKent Gibson le->label, 1486925ca369SKent Gibson le); 1487925ca369SKent Gibson if (ret) 148846824272SKent Gibson goto out_free_le; 1489925ca369SKent Gibson 1490925ca369SKent Gibson fd = get_unused_fd_flags(O_RDONLY | O_CLOEXEC); 1491925ca369SKent Gibson if (fd < 0) { 1492925ca369SKent Gibson ret = fd; 149346824272SKent Gibson goto out_free_le; 1494925ca369SKent Gibson } 1495925ca369SKent Gibson 1496925ca369SKent Gibson file = anon_inode_getfile("gpio-event", 1497925ca369SKent Gibson &lineevent_fileops, 1498925ca369SKent Gibson le, 1499925ca369SKent Gibson O_RDONLY | O_CLOEXEC); 1500925ca369SKent Gibson if (IS_ERR(file)) { 1501925ca369SKent Gibson ret = PTR_ERR(file); 1502925ca369SKent Gibson goto out_put_unused_fd; 1503925ca369SKent Gibson } 1504925ca369SKent Gibson 1505925ca369SKent Gibson eventreq.fd = fd; 1506925ca369SKent Gibson if (copy_to_user(ip, &eventreq, sizeof(eventreq))) { 1507925ca369SKent Gibson /* 1508925ca369SKent Gibson * fput() will trigger the release() callback, so do not go onto 1509925ca369SKent Gibson * the regular error cleanup path here. 1510925ca369SKent Gibson */ 1511925ca369SKent Gibson fput(file); 1512925ca369SKent Gibson put_unused_fd(fd); 1513925ca369SKent Gibson return -EFAULT; 1514925ca369SKent Gibson } 1515925ca369SKent Gibson 1516925ca369SKent Gibson fd_install(fd, file); 1517925ca369SKent Gibson 1518925ca369SKent Gibson return 0; 1519925ca369SKent Gibson 1520925ca369SKent Gibson out_put_unused_fd: 1521925ca369SKent Gibson put_unused_fd(fd); 1522925ca369SKent Gibson out_free_le: 152346824272SKent Gibson lineevent_free(le); 1524925ca369SKent Gibson return ret; 1525925ca369SKent Gibson } 1526925ca369SKent Gibson 1527aad95584SKent Gibson static void gpio_v2_line_info_to_v1(struct gpio_v2_line_info *info_v2, 1528aad95584SKent Gibson struct gpioline_info *info_v1) 1529aad95584SKent Gibson { 1530aad95584SKent Gibson u64 flagsv2 = info_v2->flags; 1531aad95584SKent Gibson 1532aad95584SKent Gibson memcpy(info_v1->name, info_v2->name, sizeof(info_v1->name)); 1533aad95584SKent Gibson memcpy(info_v1->consumer, info_v2->consumer, sizeof(info_v1->consumer)); 1534aad95584SKent Gibson info_v1->line_offset = info_v2->offset; 1535aad95584SKent Gibson info_v1->flags = 0; 1536aad95584SKent Gibson 1537aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_USED) 1538aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_KERNEL; 1539aad95584SKent Gibson 1540aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_OUTPUT) 1541aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_IS_OUT; 1542aad95584SKent Gibson 1543aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_ACTIVE_LOW) 1544aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_ACTIVE_LOW; 1545aad95584SKent Gibson 1546aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_OPEN_DRAIN) 1547aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_OPEN_DRAIN; 1548aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_OPEN_SOURCE) 1549aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_OPEN_SOURCE; 1550aad95584SKent Gibson 1551aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_BIAS_PULL_UP) 1552aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_BIAS_PULL_UP; 1553aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN) 1554aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_BIAS_PULL_DOWN; 1555aad95584SKent Gibson if (flagsv2 & GPIO_V2_LINE_FLAG_BIAS_DISABLED) 1556aad95584SKent Gibson info_v1->flags |= GPIOLINE_FLAG_BIAS_DISABLE; 1557aad95584SKent Gibson } 1558aad95584SKent Gibson 1559aad95584SKent Gibson static void gpio_v2_line_info_changed_to_v1( 1560aad95584SKent Gibson struct gpio_v2_line_info_changed *lic_v2, 1561aad95584SKent Gibson struct gpioline_info_changed *lic_v1) 1562aad95584SKent Gibson { 1563aad95584SKent Gibson gpio_v2_line_info_to_v1(&lic_v2->info, &lic_v1->info); 1564aad95584SKent Gibson lic_v1->timestamp = lic_v2->timestamp_ns; 1565aad95584SKent Gibson lic_v1->event_type = lic_v2->event_type; 1566aad95584SKent Gibson } 1567aad95584SKent Gibson 15683c0d9c63SKent Gibson #endif /* CONFIG_GPIO_CDEV_V1 */ 15693c0d9c63SKent Gibson 1570925ca369SKent Gibson static void gpio_desc_to_lineinfo(struct gpio_desc *desc, 1571aad95584SKent Gibson struct gpio_v2_line_info *info) 1572925ca369SKent Gibson { 1573925ca369SKent Gibson struct gpio_chip *gc = desc->gdev->chip; 1574925ca369SKent Gibson bool ok_for_pinctrl; 1575925ca369SKent Gibson unsigned long flags; 1576925ca369SKent Gibson 157769e4e136SKent Gibson memset(info, 0, sizeof(*info)); 1578aad95584SKent Gibson info->offset = gpio_chip_hwgpio(desc); 15790dc11e3aSKent Gibson 1580925ca369SKent Gibson /* 1581925ca369SKent Gibson * This function takes a mutex so we must check this before taking 1582925ca369SKent Gibson * the spinlock. 1583925ca369SKent Gibson * 1584925ca369SKent Gibson * FIXME: find a non-racy way to retrieve this information. Maybe a 1585925ca369SKent Gibson * lock common to both frameworks? 1586925ca369SKent Gibson */ 1587925ca369SKent Gibson ok_for_pinctrl = 1588aad95584SKent Gibson pinctrl_gpio_can_use_line(gc->base + info->offset); 1589925ca369SKent Gibson 1590925ca369SKent Gibson spin_lock_irqsave(&gpio_lock, flags); 1591925ca369SKent Gibson 159269e4e136SKent Gibson if (desc->name) 159369e4e136SKent Gibson strscpy(info->name, desc->name, sizeof(info->name)); 1594925ca369SKent Gibson 159569e4e136SKent Gibson if (desc->label) 159669e4e136SKent Gibson strscpy(info->consumer, desc->label, sizeof(info->consumer)); 1597925ca369SKent Gibson 1598925ca369SKent Gibson /* 1599925ca369SKent Gibson * Userspace only need to know that the kernel is using this GPIO so 1600925ca369SKent Gibson * it can't use it. 1601925ca369SKent Gibson */ 1602925ca369SKent Gibson info->flags = 0; 1603925ca369SKent Gibson if (test_bit(FLAG_REQUESTED, &desc->flags) || 1604925ca369SKent Gibson test_bit(FLAG_IS_HOGGED, &desc->flags) || 1605925ca369SKent Gibson test_bit(FLAG_USED_AS_IRQ, &desc->flags) || 1606925ca369SKent Gibson test_bit(FLAG_EXPORT, &desc->flags) || 1607925ca369SKent Gibson test_bit(FLAG_SYSFS, &desc->flags) || 1608925ca369SKent Gibson !ok_for_pinctrl) 1609aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_USED; 1610aad95584SKent Gibson 1611925ca369SKent Gibson if (test_bit(FLAG_IS_OUT, &desc->flags)) 1612aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_OUTPUT; 1613aad95584SKent Gibson else 1614aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_INPUT; 1615aad95584SKent Gibson 1616925ca369SKent Gibson if (test_bit(FLAG_ACTIVE_LOW, &desc->flags)) 1617aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_ACTIVE_LOW; 1618aad95584SKent Gibson 1619925ca369SKent Gibson if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) 1620aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_OPEN_DRAIN; 1621925ca369SKent Gibson if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) 1622aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_OPEN_SOURCE; 1623aad95584SKent Gibson 1624925ca369SKent Gibson if (test_bit(FLAG_BIAS_DISABLE, &desc->flags)) 1625aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_BIAS_DISABLED; 1626925ca369SKent Gibson if (test_bit(FLAG_PULL_DOWN, &desc->flags)) 1627aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN; 1628925ca369SKent Gibson if (test_bit(FLAG_PULL_UP, &desc->flags)) 1629aad95584SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_BIAS_PULL_UP; 1630925ca369SKent Gibson 163173e03419SKent Gibson if (test_bit(FLAG_EDGE_RISING, &desc->flags)) 163273e03419SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_EDGE_RISING; 163373e03419SKent Gibson if (test_bit(FLAG_EDGE_FALLING, &desc->flags)) 163473e03419SKent Gibson info->flags |= GPIO_V2_LINE_FLAG_EDGE_FALLING; 163573e03419SKent Gibson 1636925ca369SKent Gibson spin_unlock_irqrestore(&gpio_lock, flags); 1637925ca369SKent Gibson } 1638925ca369SKent Gibson 1639925ca369SKent Gibson struct gpio_chardev_data { 1640925ca369SKent Gibson struct gpio_device *gdev; 1641925ca369SKent Gibson wait_queue_head_t wait; 1642aad95584SKent Gibson DECLARE_KFIFO(events, struct gpio_v2_line_info_changed, 32); 1643925ca369SKent Gibson struct notifier_block lineinfo_changed_nb; 1644925ca369SKent Gibson unsigned long *watched_lines; 1645aad95584SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1646aad95584SKent Gibson atomic_t watch_abi_version; 1647aad95584SKent Gibson #endif 1648925ca369SKent Gibson }; 1649925ca369SKent Gibson 1650aad95584SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1651aad95584SKent Gibson /* 1652aad95584SKent Gibson * returns 0 if the versions match, else the previously selected ABI version 1653aad95584SKent Gibson */ 1654aad95584SKent Gibson static int lineinfo_ensure_abi_version(struct gpio_chardev_data *cdata, 1655aad95584SKent Gibson unsigned int version) 1656aad95584SKent Gibson { 1657aad95584SKent Gibson int abiv = atomic_cmpxchg(&cdata->watch_abi_version, 0, version); 1658aad95584SKent Gibson 1659aad95584SKent Gibson if (abiv == version) 1660aad95584SKent Gibson return 0; 1661aad95584SKent Gibson 1662aad95584SKent Gibson return abiv; 1663aad95584SKent Gibson } 1664aad95584SKent Gibson #endif 1665aad95584SKent Gibson 1666aad95584SKent Gibson static int lineinfo_get(struct gpio_chardev_data *cdev, void __user *ip, 1667aad95584SKent Gibson bool watch) 1668aad95584SKent Gibson { 1669aad95584SKent Gibson struct gpio_desc *desc; 1670aad95584SKent Gibson struct gpio_v2_line_info lineinfo; 1671aad95584SKent Gibson 1672aad95584SKent Gibson if (copy_from_user(&lineinfo, ip, sizeof(lineinfo))) 1673aad95584SKent Gibson return -EFAULT; 1674aad95584SKent Gibson 1675aad95584SKent Gibson if (memchr_inv(lineinfo.padding, 0, sizeof(lineinfo.padding))) 1676aad95584SKent Gibson return -EINVAL; 1677aad95584SKent Gibson 1678aad95584SKent Gibson desc = gpiochip_get_desc(cdev->gdev->chip, lineinfo.offset); 1679aad95584SKent Gibson if (IS_ERR(desc)) 1680aad95584SKent Gibson return PTR_ERR(desc); 1681aad95584SKent Gibson 1682aad95584SKent Gibson if (watch) { 1683aad95584SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1684aad95584SKent Gibson if (lineinfo_ensure_abi_version(cdev, 2)) 1685aad95584SKent Gibson return -EPERM; 1686aad95584SKent Gibson #endif 1687aad95584SKent Gibson if (test_and_set_bit(lineinfo.offset, cdev->watched_lines)) 1688aad95584SKent Gibson return -EBUSY; 1689aad95584SKent Gibson } 1690aad95584SKent Gibson gpio_desc_to_lineinfo(desc, &lineinfo); 1691aad95584SKent Gibson 1692aad95584SKent Gibson if (copy_to_user(ip, &lineinfo, sizeof(lineinfo))) { 1693aad95584SKent Gibson if (watch) 1694aad95584SKent Gibson clear_bit(lineinfo.offset, cdev->watched_lines); 1695aad95584SKent Gibson return -EFAULT; 1696aad95584SKent Gibson } 1697aad95584SKent Gibson 1698aad95584SKent Gibson return 0; 1699aad95584SKent Gibson } 1700aad95584SKent Gibson 1701925ca369SKent Gibson /* 1702925ca369SKent Gibson * gpio_ioctl() - ioctl handler for the GPIO chardev 1703925ca369SKent Gibson */ 170449bc5279SKent Gibson static long gpio_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 1705925ca369SKent Gibson { 1706e2b781c5SKent Gibson struct gpio_chardev_data *cdev = file->private_data; 1707e2b781c5SKent Gibson struct gpio_device *gdev = cdev->gdev; 1708925ca369SKent Gibson struct gpio_chip *gc = gdev->chip; 1709925ca369SKent Gibson void __user *ip = (void __user *)arg; 1710925ca369SKent Gibson __u32 offset; 1711925ca369SKent Gibson 1712925ca369SKent Gibson /* We fail any subsequent ioctl():s when the chip is gone */ 1713925ca369SKent Gibson if (!gc) 1714925ca369SKent Gibson return -ENODEV; 1715925ca369SKent Gibson 1716925ca369SKent Gibson /* Fill in the struct and pass to userspace */ 1717925ca369SKent Gibson if (cmd == GPIO_GET_CHIPINFO_IOCTL) { 1718925ca369SKent Gibson struct gpiochip_info chipinfo; 1719925ca369SKent Gibson 1720925ca369SKent Gibson memset(&chipinfo, 0, sizeof(chipinfo)); 1721925ca369SKent Gibson 172269e4e136SKent Gibson strscpy(chipinfo.name, dev_name(&gdev->dev), 1723925ca369SKent Gibson sizeof(chipinfo.name)); 172469e4e136SKent Gibson strscpy(chipinfo.label, gdev->label, 1725925ca369SKent Gibson sizeof(chipinfo.label)); 1726925ca369SKent Gibson chipinfo.lines = gdev->ngpio; 1727925ca369SKent Gibson if (copy_to_user(ip, &chipinfo, sizeof(chipinfo))) 1728925ca369SKent Gibson return -EFAULT; 1729925ca369SKent Gibson return 0; 17303c0d9c63SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1731925ca369SKent Gibson } else if (cmd == GPIO_GET_LINEINFO_IOCTL) { 1732aad95584SKent Gibson struct gpio_desc *desc; 1733925ca369SKent Gibson struct gpioline_info lineinfo; 1734aad95584SKent Gibson struct gpio_v2_line_info lineinfo_v2; 1735925ca369SKent Gibson 1736925ca369SKent Gibson if (copy_from_user(&lineinfo, ip, sizeof(lineinfo))) 1737925ca369SKent Gibson return -EFAULT; 1738925ca369SKent Gibson 17391bf7ba40SKent Gibson /* this doubles as a range check on line_offset */ 1740925ca369SKent Gibson desc = gpiochip_get_desc(gc, lineinfo.line_offset); 1741925ca369SKent Gibson if (IS_ERR(desc)) 1742925ca369SKent Gibson return PTR_ERR(desc); 1743925ca369SKent Gibson 1744aad95584SKent Gibson gpio_desc_to_lineinfo(desc, &lineinfo_v2); 1745aad95584SKent Gibson gpio_v2_line_info_to_v1(&lineinfo_v2, &lineinfo); 1746925ca369SKent Gibson 1747925ca369SKent Gibson if (copy_to_user(ip, &lineinfo, sizeof(lineinfo))) 1748925ca369SKent Gibson return -EFAULT; 1749925ca369SKent Gibson return 0; 1750925ca369SKent Gibson } else if (cmd == GPIO_GET_LINEHANDLE_IOCTL) { 1751925ca369SKent Gibson return linehandle_create(gdev, ip); 1752925ca369SKent Gibson } else if (cmd == GPIO_GET_LINEEVENT_IOCTL) { 1753925ca369SKent Gibson return lineevent_create(gdev, ip); 1754925ca369SKent Gibson } else if (cmd == GPIO_GET_LINEINFO_WATCH_IOCTL) { 1755aad95584SKent Gibson struct gpio_desc *desc; 1756925ca369SKent Gibson struct gpioline_info lineinfo; 1757aad95584SKent Gibson struct gpio_v2_line_info lineinfo_v2; 1758925ca369SKent Gibson 1759925ca369SKent Gibson if (copy_from_user(&lineinfo, ip, sizeof(lineinfo))) 1760925ca369SKent Gibson return -EFAULT; 1761925ca369SKent Gibson 17621bf7ba40SKent Gibson /* this doubles as a range check on line_offset */ 1763925ca369SKent Gibson desc = gpiochip_get_desc(gc, lineinfo.line_offset); 1764925ca369SKent Gibson if (IS_ERR(desc)) 1765925ca369SKent Gibson return PTR_ERR(desc); 1766925ca369SKent Gibson 1767aad95584SKent Gibson if (lineinfo_ensure_abi_version(cdev, 1)) 1768aad95584SKent Gibson return -EPERM; 1769aad95584SKent Gibson 17701bf7ba40SKent Gibson if (test_and_set_bit(lineinfo.line_offset, cdev->watched_lines)) 1771925ca369SKent Gibson return -EBUSY; 1772925ca369SKent Gibson 1773aad95584SKent Gibson gpio_desc_to_lineinfo(desc, &lineinfo_v2); 1774aad95584SKent Gibson gpio_v2_line_info_to_v1(&lineinfo_v2, &lineinfo); 1775925ca369SKent Gibson 1776f30ef3e8SKent Gibson if (copy_to_user(ip, &lineinfo, sizeof(lineinfo))) { 17771bf7ba40SKent Gibson clear_bit(lineinfo.line_offset, cdev->watched_lines); 1778925ca369SKent Gibson return -EFAULT; 1779f30ef3e8SKent Gibson } 1780925ca369SKent Gibson 1781925ca369SKent Gibson return 0; 17823c0d9c63SKent Gibson #endif /* CONFIG_GPIO_CDEV_V1 */ 1783aad95584SKent Gibson } else if (cmd == GPIO_V2_GET_LINEINFO_IOCTL || 1784aad95584SKent Gibson cmd == GPIO_V2_GET_LINEINFO_WATCH_IOCTL) { 1785aad95584SKent Gibson return lineinfo_get(cdev, ip, 1786aad95584SKent Gibson cmd == GPIO_V2_GET_LINEINFO_WATCH_IOCTL); 17873c0d9c63SKent Gibson } else if (cmd == GPIO_V2_GET_LINE_IOCTL) { 17883c0d9c63SKent Gibson return linereq_create(gdev, ip); 1789925ca369SKent Gibson } else if (cmd == GPIO_GET_LINEINFO_UNWATCH_IOCTL) { 1790925ca369SKent Gibson if (copy_from_user(&offset, ip, sizeof(offset))) 1791925ca369SKent Gibson return -EFAULT; 1792925ca369SKent Gibson 17931bf7ba40SKent Gibson if (offset >= cdev->gdev->ngpio) 17941bf7ba40SKent Gibson return -EINVAL; 1795925ca369SKent Gibson 17961bf7ba40SKent Gibson if (!test_and_clear_bit(offset, cdev->watched_lines)) 1797925ca369SKent Gibson return -EBUSY; 1798925ca369SKent Gibson 1799925ca369SKent Gibson return 0; 1800925ca369SKent Gibson } 1801925ca369SKent Gibson return -EINVAL; 1802925ca369SKent Gibson } 1803925ca369SKent Gibson 1804925ca369SKent Gibson #ifdef CONFIG_COMPAT 180549bc5279SKent Gibson static long gpio_ioctl_compat(struct file *file, unsigned int cmd, 1806925ca369SKent Gibson unsigned long arg) 1807925ca369SKent Gibson { 180849bc5279SKent Gibson return gpio_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 1809925ca369SKent Gibson } 1810925ca369SKent Gibson #endif 1811925ca369SKent Gibson 1812925ca369SKent Gibson static struct gpio_chardev_data * 1813925ca369SKent Gibson to_gpio_chardev_data(struct notifier_block *nb) 1814925ca369SKent Gibson { 1815925ca369SKent Gibson return container_of(nb, struct gpio_chardev_data, lineinfo_changed_nb); 1816925ca369SKent Gibson } 1817925ca369SKent Gibson 1818925ca369SKent Gibson static int lineinfo_changed_notify(struct notifier_block *nb, 1819925ca369SKent Gibson unsigned long action, void *data) 1820925ca369SKent Gibson { 1821e2b781c5SKent Gibson struct gpio_chardev_data *cdev = to_gpio_chardev_data(nb); 1822aad95584SKent Gibson struct gpio_v2_line_info_changed chg; 1823925ca369SKent Gibson struct gpio_desc *desc = data; 1824925ca369SKent Gibson int ret; 1825925ca369SKent Gibson 1826e2b781c5SKent Gibson if (!test_bit(gpio_chip_hwgpio(desc), cdev->watched_lines)) 1827925ca369SKent Gibson return NOTIFY_DONE; 1828925ca369SKent Gibson 1829925ca369SKent Gibson memset(&chg, 0, sizeof(chg)); 1830925ca369SKent Gibson chg.event_type = action; 1831aad95584SKent Gibson chg.timestamp_ns = ktime_get_ns(); 1832925ca369SKent Gibson gpio_desc_to_lineinfo(desc, &chg.info); 1833925ca369SKent Gibson 1834e2b781c5SKent Gibson ret = kfifo_in_spinlocked(&cdev->events, &chg, 1, &cdev->wait.lock); 1835925ca369SKent Gibson if (ret) 1836e2b781c5SKent Gibson wake_up_poll(&cdev->wait, EPOLLIN); 1837925ca369SKent Gibson else 1838925ca369SKent Gibson pr_debug_ratelimited("lineinfo event FIFO is full - event dropped\n"); 1839925ca369SKent Gibson 1840925ca369SKent Gibson return NOTIFY_OK; 1841925ca369SKent Gibson } 1842925ca369SKent Gibson 184349bc5279SKent Gibson static __poll_t lineinfo_watch_poll(struct file *file, 1844925ca369SKent Gibson struct poll_table_struct *pollt) 1845925ca369SKent Gibson { 1846e2b781c5SKent Gibson struct gpio_chardev_data *cdev = file->private_data; 1847925ca369SKent Gibson __poll_t events = 0; 1848925ca369SKent Gibson 1849e2b781c5SKent Gibson poll_wait(file, &cdev->wait, pollt); 1850925ca369SKent Gibson 1851e2b781c5SKent Gibson if (!kfifo_is_empty_spinlocked_noirqsave(&cdev->events, 1852e2b781c5SKent Gibson &cdev->wait.lock)) 1853925ca369SKent Gibson events = EPOLLIN | EPOLLRDNORM; 1854925ca369SKent Gibson 1855925ca369SKent Gibson return events; 1856925ca369SKent Gibson } 1857925ca369SKent Gibson 185849bc5279SKent Gibson static ssize_t lineinfo_watch_read(struct file *file, char __user *buf, 1859925ca369SKent Gibson size_t count, loff_t *off) 1860925ca369SKent Gibson { 1861e2b781c5SKent Gibson struct gpio_chardev_data *cdev = file->private_data; 1862aad95584SKent Gibson struct gpio_v2_line_info_changed event; 1863925ca369SKent Gibson ssize_t bytes_read = 0; 1864925ca369SKent Gibson int ret; 1865aad95584SKent Gibson size_t event_size; 1866925ca369SKent Gibson 1867aad95584SKent Gibson #ifndef CONFIG_GPIO_CDEV_V1 1868aad95584SKent Gibson event_size = sizeof(struct gpio_v2_line_info_changed); 1869aad95584SKent Gibson if (count < event_size) 1870925ca369SKent Gibson return -EINVAL; 1871aad95584SKent Gibson #endif 1872925ca369SKent Gibson 1873925ca369SKent Gibson do { 1874e2b781c5SKent Gibson spin_lock(&cdev->wait.lock); 1875e2b781c5SKent Gibson if (kfifo_is_empty(&cdev->events)) { 1876925ca369SKent Gibson if (bytes_read) { 1877e2b781c5SKent Gibson spin_unlock(&cdev->wait.lock); 1878925ca369SKent Gibson return bytes_read; 1879925ca369SKent Gibson } 1880925ca369SKent Gibson 188149bc5279SKent Gibson if (file->f_flags & O_NONBLOCK) { 1882e2b781c5SKent Gibson spin_unlock(&cdev->wait.lock); 1883925ca369SKent Gibson return -EAGAIN; 1884925ca369SKent Gibson } 1885925ca369SKent Gibson 1886e2b781c5SKent Gibson ret = wait_event_interruptible_locked(cdev->wait, 1887e2b781c5SKent Gibson !kfifo_is_empty(&cdev->events)); 1888925ca369SKent Gibson if (ret) { 1889e2b781c5SKent Gibson spin_unlock(&cdev->wait.lock); 1890925ca369SKent Gibson return ret; 1891925ca369SKent Gibson } 1892925ca369SKent Gibson } 1893aad95584SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1894aad95584SKent Gibson /* must be after kfifo check so watch_abi_version is set */ 1895aad95584SKent Gibson if (atomic_read(&cdev->watch_abi_version) == 2) 1896aad95584SKent Gibson event_size = sizeof(struct gpio_v2_line_info_changed); 1897aad95584SKent Gibson else 1898aad95584SKent Gibson event_size = sizeof(struct gpioline_info_changed); 1899aad95584SKent Gibson if (count < event_size) { 1900aad95584SKent Gibson spin_unlock(&cdev->wait.lock); 1901aad95584SKent Gibson return -EINVAL; 1902aad95584SKent Gibson } 1903aad95584SKent Gibson #endif 1904e2b781c5SKent Gibson ret = kfifo_out(&cdev->events, &event, 1); 1905e2b781c5SKent Gibson spin_unlock(&cdev->wait.lock); 1906925ca369SKent Gibson if (ret != 1) { 1907925ca369SKent Gibson ret = -EIO; 1908925ca369SKent Gibson break; 1909925ca369SKent Gibson /* We should never get here. See lineevent_read(). */ 1910925ca369SKent Gibson } 1911925ca369SKent Gibson 1912aad95584SKent Gibson #ifdef CONFIG_GPIO_CDEV_V1 1913aad95584SKent Gibson if (event_size == sizeof(struct gpio_v2_line_info_changed)) { 1914aad95584SKent Gibson if (copy_to_user(buf + bytes_read, &event, event_size)) 1915925ca369SKent Gibson return -EFAULT; 1916aad95584SKent Gibson } else { 1917aad95584SKent Gibson struct gpioline_info_changed event_v1; 1918aad95584SKent Gibson 1919aad95584SKent Gibson gpio_v2_line_info_changed_to_v1(&event, &event_v1); 1920aad95584SKent Gibson if (copy_to_user(buf + bytes_read, &event_v1, 1921aad95584SKent Gibson event_size)) 1922aad95584SKent Gibson return -EFAULT; 1923aad95584SKent Gibson } 1924aad95584SKent Gibson #else 1925aad95584SKent Gibson if (copy_to_user(buf + bytes_read, &event, event_size)) 1926aad95584SKent Gibson return -EFAULT; 1927aad95584SKent Gibson #endif 1928aad95584SKent Gibson bytes_read += event_size; 1929925ca369SKent Gibson } while (count >= bytes_read + sizeof(event)); 1930925ca369SKent Gibson 1931925ca369SKent Gibson return bytes_read; 1932925ca369SKent Gibson } 1933925ca369SKent Gibson 1934925ca369SKent Gibson /** 1935925ca369SKent Gibson * gpio_chrdev_open() - open the chardev for ioctl operations 1936925ca369SKent Gibson * @inode: inode for this chardev 193749bc5279SKent Gibson * @file: file struct for storing private data 1938925ca369SKent Gibson * Returns 0 on success 1939925ca369SKent Gibson */ 194049bc5279SKent Gibson static int gpio_chrdev_open(struct inode *inode, struct file *file) 1941925ca369SKent Gibson { 1942925ca369SKent Gibson struct gpio_device *gdev = container_of(inode->i_cdev, 1943925ca369SKent Gibson struct gpio_device, chrdev); 1944e2b781c5SKent Gibson struct gpio_chardev_data *cdev; 1945925ca369SKent Gibson int ret = -ENOMEM; 1946925ca369SKent Gibson 1947925ca369SKent Gibson /* Fail on open if the backing gpiochip is gone */ 1948925ca369SKent Gibson if (!gdev->chip) 1949925ca369SKent Gibson return -ENODEV; 1950925ca369SKent Gibson 1951e2b781c5SKent Gibson cdev = kzalloc(sizeof(*cdev), GFP_KERNEL); 1952e2b781c5SKent Gibson if (!cdev) 1953925ca369SKent Gibson return -ENOMEM; 1954925ca369SKent Gibson 1955e2b781c5SKent Gibson cdev->watched_lines = bitmap_zalloc(gdev->chip->ngpio, GFP_KERNEL); 1956e2b781c5SKent Gibson if (!cdev->watched_lines) 1957e2b781c5SKent Gibson goto out_free_cdev; 1958925ca369SKent Gibson 1959e2b781c5SKent Gibson init_waitqueue_head(&cdev->wait); 1960e2b781c5SKent Gibson INIT_KFIFO(cdev->events); 1961e2b781c5SKent Gibson cdev->gdev = gdev; 1962925ca369SKent Gibson 1963e2b781c5SKent Gibson cdev->lineinfo_changed_nb.notifier_call = lineinfo_changed_notify; 19646accc376SKent Gibson ret = blocking_notifier_chain_register(&gdev->notifier, 1965e2b781c5SKent Gibson &cdev->lineinfo_changed_nb); 1966925ca369SKent Gibson if (ret) 1967925ca369SKent Gibson goto out_free_bitmap; 1968925ca369SKent Gibson 1969925ca369SKent Gibson get_device(&gdev->dev); 1970e2b781c5SKent Gibson file->private_data = cdev; 1971925ca369SKent Gibson 197249bc5279SKent Gibson ret = nonseekable_open(inode, file); 1973925ca369SKent Gibson if (ret) 1974925ca369SKent Gibson goto out_unregister_notifier; 1975925ca369SKent Gibson 1976925ca369SKent Gibson return ret; 1977925ca369SKent Gibson 1978925ca369SKent Gibson out_unregister_notifier: 19796accc376SKent Gibson blocking_notifier_chain_unregister(&gdev->notifier, 1980e2b781c5SKent Gibson &cdev->lineinfo_changed_nb); 1981925ca369SKent Gibson out_free_bitmap: 1982e2b781c5SKent Gibson bitmap_free(cdev->watched_lines); 1983e2b781c5SKent Gibson out_free_cdev: 1984e2b781c5SKent Gibson kfree(cdev); 1985925ca369SKent Gibson return ret; 1986925ca369SKent Gibson } 1987925ca369SKent Gibson 1988925ca369SKent Gibson /** 1989925ca369SKent Gibson * gpio_chrdev_release() - close chardev after ioctl operations 1990925ca369SKent Gibson * @inode: inode for this chardev 199149bc5279SKent Gibson * @file: file struct for storing private data 1992925ca369SKent Gibson * Returns 0 on success 1993925ca369SKent Gibson */ 199449bc5279SKent Gibson static int gpio_chrdev_release(struct inode *inode, struct file *file) 1995925ca369SKent Gibson { 1996e2b781c5SKent Gibson struct gpio_chardev_data *cdev = file->private_data; 1997e2b781c5SKent Gibson struct gpio_device *gdev = cdev->gdev; 1998925ca369SKent Gibson 1999e2b781c5SKent Gibson bitmap_free(cdev->watched_lines); 20006accc376SKent Gibson blocking_notifier_chain_unregister(&gdev->notifier, 2001e2b781c5SKent Gibson &cdev->lineinfo_changed_nb); 2002925ca369SKent Gibson put_device(&gdev->dev); 2003e2b781c5SKent Gibson kfree(cdev); 2004925ca369SKent Gibson 2005925ca369SKent Gibson return 0; 2006925ca369SKent Gibson } 2007925ca369SKent Gibson 2008925ca369SKent Gibson static const struct file_operations gpio_fileops = { 2009925ca369SKent Gibson .release = gpio_chrdev_release, 2010925ca369SKent Gibson .open = gpio_chrdev_open, 2011925ca369SKent Gibson .poll = lineinfo_watch_poll, 2012925ca369SKent Gibson .read = lineinfo_watch_read, 2013925ca369SKent Gibson .owner = THIS_MODULE, 2014925ca369SKent Gibson .llseek = no_llseek, 2015925ca369SKent Gibson .unlocked_ioctl = gpio_ioctl, 2016925ca369SKent Gibson #ifdef CONFIG_COMPAT 2017925ca369SKent Gibson .compat_ioctl = gpio_ioctl_compat, 2018925ca369SKent Gibson #endif 2019925ca369SKent Gibson }; 2020925ca369SKent Gibson 2021925ca369SKent Gibson int gpiolib_cdev_register(struct gpio_device *gdev, dev_t devt) 2022925ca369SKent Gibson { 2023925ca369SKent Gibson int ret; 2024925ca369SKent Gibson 2025925ca369SKent Gibson cdev_init(&gdev->chrdev, &gpio_fileops); 2026925ca369SKent Gibson gdev->chrdev.owner = THIS_MODULE; 2027925ca369SKent Gibson gdev->dev.devt = MKDEV(MAJOR(devt), gdev->id); 2028925ca369SKent Gibson 2029925ca369SKent Gibson ret = cdev_device_add(&gdev->chrdev, &gdev->dev); 2030925ca369SKent Gibson if (ret) 2031925ca369SKent Gibson return ret; 2032925ca369SKent Gibson 2033925ca369SKent Gibson chip_dbg(gdev->chip, "added GPIO chardev (%d:%d)\n", 2034925ca369SKent Gibson MAJOR(devt), gdev->id); 2035925ca369SKent Gibson 2036925ca369SKent Gibson return 0; 2037925ca369SKent Gibson } 2038925ca369SKent Gibson 2039925ca369SKent Gibson void gpiolib_cdev_unregister(struct gpio_device *gdev) 2040925ca369SKent Gibson { 2041925ca369SKent Gibson cdev_device_del(&gdev->chrdev, &gdev->dev); 2042925ca369SKent Gibson } 2043