164 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/***************************************************************************3 * Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org> *4 * *5 * Based on Logitech G13 driver (v0.4) *6 * Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu> *7 * *8 ***************************************************************************/9 10#include <linux/hid.h>11#include <linux/hid-debug.h>12#include <linux/input.h>13#include "hid-ids.h"14 15#include <linux/fb.h>16#include <linux/vmalloc.h>17#include <linux/backlight.h>18#include <linux/lcd.h>19 20#include <linux/leds.h>21 22#include <linux/seq_file.h>23#include <linux/debugfs.h>24 25#include <linux/completion.h>26#include <linux/uaccess.h>27#include <linux/module.h>28 29#include "hid-picolcd.h"30 31 32void picolcd_leds_set(struct picolcd_data *data)33{34 struct hid_report *report;35 unsigned long flags;36 37 if (!data->led[0])38 return;39 report = picolcd_out_report(REPORT_LED_STATE, data->hdev);40 if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)41 return;42 43 spin_lock_irqsave(&data->lock, flags);44 hid_set_field(report->field[0], 0, data->led_state);45 if (!(data->status & PICOLCD_FAILED))46 hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);47 spin_unlock_irqrestore(&data->lock, flags);48}49 50static void picolcd_led_set_brightness(struct led_classdev *led_cdev,51 enum led_brightness value)52{53 struct device *dev;54 struct hid_device *hdev;55 struct picolcd_data *data;56 int i, state = 0;57 58 dev = led_cdev->dev->parent;59 hdev = to_hid_device(dev);60 data = hid_get_drvdata(hdev);61 if (!data)62 return;63 for (i = 0; i < 8; i++) {64 if (led_cdev != data->led[i])65 continue;66 state = (data->led_state >> i) & 1;67 if (value == LED_OFF && state) {68 data->led_state &= ~(1 << i);69 picolcd_leds_set(data);70 } else if (value != LED_OFF && !state) {71 data->led_state |= 1 << i;72 picolcd_leds_set(data);73 }74 break;75 }76}77 78static enum led_brightness picolcd_led_get_brightness(struct led_classdev *led_cdev)79{80 struct device *dev;81 struct hid_device *hdev;82 struct picolcd_data *data;83 int i, value = 0;84 85 dev = led_cdev->dev->parent;86 hdev = to_hid_device(dev);87 data = hid_get_drvdata(hdev);88 for (i = 0; i < 8; i++)89 if (led_cdev == data->led[i]) {90 value = (data->led_state >> i) & 1;91 break;92 }93 return value ? LED_FULL : LED_OFF;94}95 96int picolcd_init_leds(struct picolcd_data *data, struct hid_report *report)97{98 struct device *dev = &data->hdev->dev;99 struct led_classdev *led;100 size_t name_sz = strlen(dev_name(dev)) + 8;101 char *name;102 int i, ret = 0;103 104 if (!report)105 return -ENODEV;106 if (report->maxfield != 1 || report->field[0]->report_count != 1 ||107 report->field[0]->report_size != 8) {108 dev_err(dev, "unsupported LED_STATE report");109 return -EINVAL;110 }111 112 for (i = 0; i < 8; i++) {113 led = kzalloc(sizeof(struct led_classdev)+name_sz, GFP_KERNEL);114 if (!led) {115 dev_err(dev, "can't allocate memory for LED %d\n", i);116 ret = -ENOMEM;117 goto err;118 }119 name = (void *)(&led[1]);120 snprintf(name, name_sz, "%s::GPO%d", dev_name(dev), i);121 led->name = name;122 led->brightness = 0;123 led->max_brightness = 1;124 led->brightness_get = picolcd_led_get_brightness;125 led->brightness_set = picolcd_led_set_brightness;126 127 data->led[i] = led;128 ret = led_classdev_register(dev, data->led[i]);129 if (ret) {130 data->led[i] = NULL;131 kfree(led);132 dev_err(dev, "can't register LED %d\n", i);133 goto err;134 }135 }136 return 0;137err:138 for (i = 0; i < 8; i++)139 if (data->led[i]) {140 led = data->led[i];141 data->led[i] = NULL;142 led_classdev_unregister(led);143 kfree(led);144 }145 return ret;146}147 148void picolcd_exit_leds(struct picolcd_data *data)149{150 struct led_classdev *led;151 int i;152 153 for (i = 0; i < 8; i++) {154 led = data->led[i];155 data->led[i] = NULL;156 if (!led)157 continue;158 led_classdev_unregister(led);159 kfree(led);160 }161}162 163 164