Orange Pi5 kernel

// SPDX-License-Identifier: GPL-2.0-only
/***************************************************************************
 *   Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org>  *
 *                                                                         *
 *   Based on Logitech G13 driver (v0.4)                                   *
 *     Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu>   *
 *                                                                         *
 ***************************************************************************/
 
#include <linux/hid.h>
#include <linux/hid-debug.h>
#include <linux/input.h>
#include "hid-ids.h"
 
#include <linux/fb.h>
#include <linux/vmalloc.h>
#include <linux/backlight.h>
#include <linux/lcd.h>
 
#include <linux/leds.h>
 
#include <linux/seq_file.h>
#include <linux/debugfs.h>
 
#include <linux/completion.h>
#include <linux/uaccess.h>
#include <linux/module.h>
 
#include "hid-picolcd.h"
 
 
void picolcd_leds_set(struct picolcd_data *data)
{
<------>struct hid_report *report;
<------>unsigned long flags;
 
<------>if (!data->led[0])
<------><------>return;
<------>report = picolcd_out_report(REPORT_LED_STATE, data->hdev);
<------>if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)
<------><------>return;
 
<------>spin_lock_irqsave(&data->lock, flags);
<------>hid_set_field(report->field[0], 0, data->led_state);
<------>if (!(data->status & PICOLCD_FAILED))
<------><------>hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
<------>spin_unlock_irqrestore(&data->lock, flags);
}
 
static void picolcd_led_set_brightness(struct led_classdev *led_cdev,
<------><------><------>enum led_brightness value)
{
<------>struct device *dev;
<------>struct hid_device *hdev;
<------>struct picolcd_data *data;
<------>int i, state = 0;
 
<------>dev  = led_cdev->dev->parent;
<------>hdev = to_hid_device(dev);
<------>data = hid_get_drvdata(hdev);
<------>if (!data)
<------><------>return;
<------>for (i = 0; i < 8; i++) {
<------><------>if (led_cdev != data->led[i])
<------><------><------>continue;
<------><------>state = (data->led_state >> i) & 1;
<------><------>if (value == LED_OFF && state) {
<------><------><------>data->led_state &= ~(1 << i);
<------><------><------>picolcd_leds_set(data);
<------><------>} else if (value != LED_OFF && !state) {
<------><------><------>data->led_state |= 1 << i;
<------><------><------>picolcd_leds_set(data);
<------><------>}
<------><------>break;
<------>}
}
 
static enum led_brightness picolcd_led_get_brightness(struct led_classdev *led_cdev)
{
<------>struct device *dev;
<------>struct hid_device *hdev;
<------>struct picolcd_data *data;
<------>int i, value = 0;
 
<------>dev  = led_cdev->dev->parent;
<------>hdev = to_hid_device(dev);
<------>data = hid_get_drvdata(hdev);
<------>for (i = 0; i < 8; i++)
<------><------>if (led_cdev == data->led[i]) {
<------><------><------>value = (data->led_state >> i) & 1;
<------><------><------>break;
<------><------>}
<------>return value ? LED_FULL : LED_OFF;
}
 
int picolcd_init_leds(struct picolcd_data *data, struct hid_report *report)
{
<------>struct device *dev = &data->hdev->dev;
<------>struct led_classdev *led;
<------>size_t name_sz = strlen(dev_name(dev)) + 8;
<------>char *name;
<------>int i, ret = 0;
 
<------>if (!report)
<------><------>return -ENODEV;
<------>if (report->maxfield != 1 || report->field[0]->report_count != 1 ||
<------><------><------>report->field[0]->report_size != 8) {
<------><------>dev_err(dev, "unsupported LED_STATE report");
<------><------>return -EINVAL;
<------>}
 
<------>for (i = 0; i < 8; i++) {
<------><------>led = kzalloc(sizeof(struct led_classdev)+name_sz, GFP_KERNEL);
<------><------>if (!led) {
<------><------><------>dev_err(dev, "can't allocate memory for LED %d\n", i);
<------><------><------>ret = -ENOMEM;
<------><------><------>goto err;
<------><------>}
<------><------>name = (void *)(&led[1]);
<------><------>snprintf(name, name_sz, "%s::GPO%d", dev_name(dev), i);
<------><------>led->name = name;
<------><------>led->brightness = 0;
<------><------>led->max_brightness = 1;
<------><------>led->brightness_get = picolcd_led_get_brightness;
<------><------>led->brightness_set = picolcd_led_set_brightness;
 
<------><------>data->led[i] = led;
<------><------>ret = led_classdev_register(dev, data->led[i]);
<------><------>if (ret) {
<------><------><------>data->led[i] = NULL;
<------><------><------>kfree(led);
<------><------><------>dev_err(dev, "can't register LED %d\n", i);
<------><------><------>goto err;
<------><------>}
<------>}
<------>return 0;
err:
<------>for (i = 0; i < 8; i++)
<------><------>if (data->led[i]) {
<------><------><------>led = data->led[i];
<------><------><------>data->led[i] = NULL;
<------><------><------>led_classdev_unregister(led);
<------><------><------>kfree(led);
<------><------>}
<------>return ret;
}
 
void picolcd_exit_leds(struct picolcd_data *data)
{
<------>struct led_classdev *led;
<------>int i;
 
<------>for (i = 0; i < 8; i++) {
<------><------>led = data->led[i];
<------><------>data->led[i] = NULL;
<------><------>if (!led)
<------><------><------>continue;
<------><------>led_classdev_unregister(led);
<------><------>kfree(led);
<------>}
}