Orange Pi5 kernel

^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/lcd.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) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)  * lcd class device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) static int picolcd_get_contrast(struct lcd_device *ldev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	struct picolcd_data *data = lcd_get_data(ldev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	return data->lcd_contrast;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static int picolcd_set_contrast(struct lcd_device *ldev, int contrast)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	struct picolcd_data *data = lcd_get_data(ldev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	struct hid_report *report = picolcd_out_report(REPORT_CONTRAST, data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	data->lcd_contrast = contrast & 0x0ff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	spin_lock_irqsave(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	hid_set_field(report->field[0], 0, data->lcd_contrast);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	if (!(data->status & PICOLCD_FAILED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	spin_unlock_irqrestore(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) static int picolcd_check_lcd_fb(struct lcd_device *ldev, struct fb_info *fb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	return fb && fb == picolcd_fbinfo((struct picolcd_data *)lcd_get_data(ldev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static struct lcd_ops picolcd_lcdops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	.get_contrast   = picolcd_get_contrast,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	.set_contrast   = picolcd_set_contrast,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	.check_fb       = picolcd_check_lcd_fb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) int picolcd_init_lcd(struct picolcd_data *data, struct hid_report *report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	struct device *dev = &data->hdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	struct lcd_device *ldev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	if (!report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	if (report->maxfield != 1 || report->field[0]->report_count != 1 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 			report->field[0]->report_size != 8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 		dev_err(dev, "unsupported CONTRAST report");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	ldev = lcd_device_register(dev_name(dev), dev, data, &picolcd_lcdops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	if (IS_ERR(ldev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 		dev_err(dev, "failed to register LCD\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 		return PTR_ERR(ldev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 	ldev->props.max_contrast = 0x0ff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 	data->lcd_contrast = 0xe5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	data->lcd = ldev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 	picolcd_set_contrast(ldev, 0xe5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) void picolcd_exit_lcd(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 	struct lcd_device *ldev = data->lcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 	data->lcd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 	lcd_device_unregister(ldev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) int picolcd_resume_lcd(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) 	if (!data->lcd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) 	return picolcd_set_contrast(data->lcd, data->lcd_contrast);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)