Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /***************************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *   Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org>  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *                                                                         *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *   Based on Logitech G13 driver (v0.4)                                   *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *     Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu>   *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *                                                                         *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  ***************************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/hid.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/backlight.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include "hid-picolcd.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) static int picolcd_get_brightness(struct backlight_device *bdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 	struct picolcd_data *data = bl_get_data(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 	return data->lcd_brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) static int picolcd_set_brightness(struct backlight_device *bdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	struct picolcd_data *data = bl_get_data(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	struct hid_report *report = picolcd_out_report(REPORT_BRIGHTNESS, data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	data->lcd_brightness = bdev->props.brightness & 0x0ff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	data->lcd_power      = bdev->props.power;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	spin_lock_irqsave(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	hid_set_field(report->field[0], 0, data->lcd_power == FB_BLANK_UNBLANK ? data->lcd_brightness : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	if (!(data->status & PICOLCD_FAILED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 		hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	spin_unlock_irqrestore(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) static int picolcd_check_bl_fb(struct backlight_device *bdev, struct fb_info *fb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	return fb && fb == picolcd_fbinfo((struct picolcd_data *)bl_get_data(bdev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) static const struct backlight_ops picolcd_blops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	.update_status  = picolcd_set_brightness,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	.get_brightness = picolcd_get_brightness,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	.check_fb       = picolcd_check_bl_fb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) int picolcd_init_backlight(struct picolcd_data *data, struct hid_report *report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	struct device *dev = &data->hdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	struct backlight_device *bdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	struct backlight_properties props;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	if (!report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	if (report->maxfield != 1 || report->field[0]->report_count != 1 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 			report->field[0]->report_size != 8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 		dev_err(dev, "unsupported BRIGHTNESS report");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	memset(&props, 0, sizeof(props));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	props.type = BACKLIGHT_RAW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	props.max_brightness = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	bdev = backlight_device_register(dev_name(dev), dev, data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 			&picolcd_blops, &props);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	if (IS_ERR(bdev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 		dev_err(dev, "failed to register backlight\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 		return PTR_ERR(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	bdev->props.brightness     = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	data->lcd_brightness       = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	data->backlight            = bdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	picolcd_set_brightness(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) void picolcd_exit_backlight(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	struct backlight_device *bdev = data->backlight;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	data->backlight = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	backlight_device_unregister(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) int picolcd_resume_backlight(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	if (!data->backlight)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	return picolcd_set_brightness(data->backlight);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) #ifdef CONFIG_PM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) void picolcd_suspend_backlight(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	int bl_power = data->lcd_power;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	if (!data->backlight)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	data->backlight->props.power = FB_BLANK_POWERDOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	picolcd_set_brightness(data->backlight);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	data->lcd_power = data->backlight->props.power = bl_power;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) #endif /* CONFIG_PM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)