forked from ~ljy/RK356X_SDK_RELEASE

blame | history | patch | commit | commitdiff
hc
2024-02-20 102a0743326a03cd1a1202ceda21e175b7d3575c 
 kernel/drivers/leds/leds-lp5523.c
....@@ -1,3 +1,4 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
12 /*
23  * lp5523.c - LP5523, LP55231 LED Driver
34  *
....@@ -6,20 +7,6 @@
67  *
78  * Contact: Samu Onkalo <samu.p.onkalo@nokia.com>
89  *          Milo(Woogyom) Kim <milo.kim@ti.com>
9
- *
10
- * This program is free software; you can redistribute it and/or
11
- * modify it under the terms of the GNU General Public License
12
- * version 2 as published by the Free Software Foundation.
13
- *
14
- * This program is distributed in the hope that it will be useful, but
15
- * WITHOUT ANY WARRANTY; without even the implied warranty of
16
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17
- * General Public License for more details.
18
- *
19
- * You should have received a copy of the GNU General Public License
20
- * along with this program; if not, write to the Free Software
21
- * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
22
- * 02110-1301 USA
2310  */
2411 
2512 #include <linux/delay.h>
....@@ -36,13 +23,13 @@
3623 
3724 #define LP5523_PROGRAM_LENGTH		32	/* bytes */
3825 /* Memory is used like this:
39
-   0x00 engine 1 program
40
-   0x10 engine 2 program
41
-   0x20 engine 3 program
42
-   0x30 engine 1 muxing info
43
-   0x40 engine 2 muxing info
44
-   0x50 engine 3 muxing info
45
-*/
26
+ * 0x00 engine 1 program
27
+ * 0x10 engine 2 program
28
+ * 0x20 engine 3 program
29
+ * 0x30 engine 1 muxing info
30
+ * 0x40 engine 2 muxing info
31
+ * 0x50 engine 3 muxing info
32
+ */
4633 #define LP5523_MAX_LEDS			9
4734 
4835 /* Registers */
....@@ -339,7 +326,7 @@
339326 					const u8 *data, size_t size)
340327 {
341328 	u8 pattern[LP5523_PROGRAM_LENGTH] = {0};
342
-	unsigned cmd;
329
+	unsigned int cmd;
343330 	char c[3];
344331 	int nrchars;
345332 	int ret;
....@@ -481,6 +468,7 @@
481468 static void lp5523_mux_to_array(u16 led_mux, char *array)
482469 {
483470 	int i, pos = 0;
471
+
484472 	for (i = 0; i < LP5523_MAX_LEDS; i++)
485473 		pos += sprintf(array + pos, "%x", LED_ACTIVE(led_mux, i));
486474 
....@@ -519,7 +507,7 @@
519507 	if (ret)
520508 		return ret;
521509 
522
-	ret = lp55xx_write(chip, LP5523_REG_PROG_MEM , (u8)(mux >> 8));
510
+	ret = lp55xx_write(chip, LP5523_REG_PROG_MEM, (u8)(mux >> 8));
523511 	if (ret)
524512 		return ret;
525513 
....@@ -804,6 +792,25 @@
804792 	return ret;
805793 }
806794 
795
+static int lp5523_multicolor_brightness(struct lp55xx_led *led)
796
+{
797
+	struct lp55xx_chip *chip = led->chip;
798
+	int ret;
799
+	int i;
800
+
801
+	mutex_lock(&chip->lock);
802
+	for (i = 0; i < led->mc_cdev.num_colors; i++) {
803
+		ret = lp55xx_write(chip,
804
+				   LP5523_REG_LED_PWM_BASE +
805
+				   led->mc_cdev.subled_info[i].channel,
806
+				   led->mc_cdev.subled_info[i].brightness);
807
+		if (ret)
808
+			break;
809
+	}
810
+	mutex_unlock(&chip->lock);
811
+	return ret;
812
+}
813
+
807814 static int lp5523_led_brightness(struct lp55xx_led *led)
808815 {
809816 	struct lp55xx_chip *chip = led->chip;
....@@ -870,6 +877,7 @@
870877 	.max_channel  = LP5523_MAX_LEDS,
871878 	.post_init_device   = lp5523_post_init_device,
872879 	.brightness_fn      = lp5523_led_brightness,
880
+	.multicolor_brightness_fn = lp5523_multicolor_brightness,
873881 	.set_led_current    = lp5523_set_led_current,
874882 	.firmware_cb        = lp5523_firmware_loaded,
875883 	.run_engine         = lp5523_run_engine,
....@@ -883,11 +891,18 @@
883891 	struct lp55xx_chip *chip;
884892 	struct lp55xx_led *led;
885893 	struct lp55xx_platform_data *pdata = dev_get_platdata(&client->dev);
886
-	struct device_node *np = client->dev.of_node;
894
+	struct device_node *np = dev_of_node(&client->dev);
895
+
896
+	chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
897
+	if (!chip)
898
+		return -ENOMEM;
899
+
900
+	chip->cfg = &lp5523_cfg;
887901 
888902 	if (!pdata) {
889903 		if (np) {
890
-			pdata = lp55xx_of_populate_pdata(&client->dev, np);
904
+			pdata = lp55xx_of_populate_pdata(&client->dev, np,
905
+							 chip);
891906 			if (IS_ERR(pdata))
892907 				return PTR_ERR(pdata);
893908 		} else {
....@@ -896,10 +911,6 @@
896911 		}
897912 	}
898913 
899
-	chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
900
-	if (!chip)
901
-		return -ENOMEM;
902
-
903914 	led = devm_kcalloc(&client->dev,
904915 			pdata->num_channels, sizeof(*led), GFP_KERNEL);
905916 	if (!led)
....@@ -907,7 +918,6 @@
907918 
908919 	chip->cl = client;
909920 	chip->pdata = pdata;
910
-	chip->cfg = &lp5523_cfg;
911921 
912922 	mutex_init(&chip->lock);
913923 
....@@ -921,19 +931,17 @@
921931 
922932 	ret = lp55xx_register_leds(led, chip);
923933 	if (ret)
924
-		goto err_register_leds;
934
+		goto err_out;
925935 
926936 	ret = lp55xx_register_sysfs(chip);
927937 	if (ret) {
928938 		dev_err(&client->dev, "registering sysfs failed\n");
929
-		goto err_register_sysfs;
939
+		goto err_out;
930940 	}
931941 
932942 	return 0;
933943 
934
-err_register_sysfs:
935
-	lp55xx_unregister_leds(led, chip);
936
-err_register_leds:
944
+err_out:
937945 	lp55xx_deinit_device(chip);
938946 err_init:
939947 	return ret;
....@@ -946,7 +954,6 @@
946954 
947955 	lp5523_stop_all_engines(chip);
948956 	lp55xx_unregister_sysfs(chip);
949
-	lp55xx_unregister_leds(led, chip);
950957 	lp55xx_deinit_device(chip);
951958 
952959 	return 0;