9 #include <linux/led-class-flash.h>
14 #include <media/v4l2-flash-led-class.h>
151 static int set_flash_module_en(struct qcom_flash_led *led, bool en)  in set_flash_module_en()  argument
153 	struct qcom_flash_data *flash_data = led->flash_data;  in set_flash_module_en()
157 	for (i = 0; i < led->chan_count; i++)  in set_flash_module_en()
158 		led_mask |= BIT(led->chan_id[i]);  in set_flash_module_en()
169 		dev_err(led->flash.led_cdev.dev, "write module_en failed, rc=%d\n", rc);  in set_flash_module_en()
175 static int set_flash_current(struct qcom_flash_led *led, u32 current_ma, enum led_mode mode)  in set_flash_current()  argument
177 	struct qcom_flash_data *flash_data = led->flash_data;  in set_flash_current()
186 	itarg_ua = (current_ma * UA_PER_MA) / led->chan_count + 1;  in set_flash_current()
189 	for (i = 0; i < led->chan_count; i++) {  in set_flash_current()
195 		chan_id = led->chan_id[i];  in set_flash_current()
214 			dev_err(led->flash.led_cdev.dev,  in set_flash_current()
223 static int set_flash_timeout(struct qcom_flash_led *led, u32 timeout_ms)  in set_flash_timeout()  argument
225 	struct qcom_flash_data *flash_data = led->flash_data;  in set_flash_timeout()
229 	/* set SAFETY_TIMER for all the channels connected to the same LED */  in set_flash_timeout()
230 	timeout_ms = min_t(u32, timeout_ms, led->max_timeout_ms);  in set_flash_timeout()
232 	for (i = 0; i < led->chan_count; i++) {  in set_flash_timeout()
233 		chan_id = led->chan_id[i];  in set_flash_timeout()
249 static int set_flash_strobe(struct qcom_flash_led *led, enum led_strobe strobe, bool state)  in set_flash_strobe()  argument
251 	struct qcom_flash_data *flash_data = led->flash_data;  in set_flash_strobe()
255 	/* Set SW strobe config for all channels connected to the LED */  in set_flash_strobe()
256 	for (i = 0; i < led->chan_count; i++) {  in set_flash_strobe()
257 		chan_id = led->chan_id[i];  in set_flash_strobe()
282 	led->enabled = state;  in set_flash_strobe()
293 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_brightness_set()  local
295 	led->flash_current_ma = min_t(u32, led->max_flash_current_ma, brightness / UA_PER_MA);  in qcom_flash_brightness_set()
301 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_timeout_set()  local
303 	led->flash_timeout_ms = timeout / USEC_PER_MSEC;  in qcom_flash_timeout_set()
309 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_strobe_set()  local
312 	rc = set_flash_strobe(led, SW_STROBE, false);  in qcom_flash_strobe_set()
316 	rc = set_flash_current(led, led->flash_current_ma, FLASH_MODE);  in qcom_flash_strobe_set()
320 	rc = set_flash_timeout(led, led->flash_timeout_ms);  in qcom_flash_strobe_set()
324 	rc = set_flash_module_en(led, state);  in qcom_flash_strobe_set()
328 	return set_flash_strobe(led, SW_STROBE, state);  in qcom_flash_strobe_set()
333 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_strobe_get()  local
335 	*state = led->enabled;  in qcom_flash_strobe_get()
341 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_fault_get()  local
342 	struct qcom_flash_data *flash_data = led->flash_data;  in qcom_flash_fault_get()
352 	for (i = 0; i < led->chan_count; i++) {  in qcom_flash_fault_get()
353 		chan_id = led->chan_id[i];  in qcom_flash_fault_get()
402 		for (i = 0; i < led->chan_count; i++) {  in qcom_flash_fault_get()
403 			chan_id = led->chan_id[i];  in qcom_flash_fault_get()
419 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_led_brightness_set()  local
420 	u32 current_ma = brightness * led->max_torch_current_ma / LED_FULL;  in qcom_flash_led_brightness_set()
424 	rc = set_flash_strobe(led, SW_STROBE, false);  in qcom_flash_led_brightness_set()
428 	rc = set_flash_module_en(led, false);  in qcom_flash_led_brightness_set()
432 	rc = set_flash_current(led, current_ma, TORCH_MODE);  in qcom_flash_led_brightness_set()
436 	/* Disable flash timeout for torch LED */  in qcom_flash_led_brightness_set()
437 	rc = set_flash_timeout(led, 0);  in qcom_flash_led_brightness_set()
441 	rc = set_flash_module_en(led, enable);  in qcom_flash_led_brightness_set()
445 	return set_flash_strobe(led, SW_STROBE, enable);  in qcom_flash_led_brightness_set()
460 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_external_strobe_set()  local
463 	rc = set_flash_module_en(led, enable);  in qcom_flash_external_strobe_set()
468 		return set_flash_strobe(led, HW_STROBE, true);  in qcom_flash_external_strobe_set()
470 		return set_flash_strobe(led, SW_STROBE, false);  in qcom_flash_external_strobe_set()
477 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_intensity_to_led_brightness()  local
480 	current_ma = min_t(u32, current_ma, led->max_torch_current_ma);  in qcom_flash_intensity_to_led_brightness()
484 	return (current_ma * LED_FULL) / led->max_torch_current_ma;  in qcom_flash_intensity_to_led_brightness()
491 	struct qcom_flash_led *led = flcdev_to_qcom_fled(fled_cdev);  in qcom_flash_brightness_to_led_intensity()  local
493 	return (brightness * led->max_torch_current_ma * UA_PER_MA) / LED_FULL;  in qcom_flash_brightness_to_led_intensity()
503 qcom_flash_v4l2_init(struct device *dev, struct qcom_flash_led *led, struct fwnode_handle *fwnode)  in qcom_flash_v4l2_init()  argument
505 	struct qcom_flash_data *flash_data = led->flash_data;  in qcom_flash_v4l2_init()
509 	if (!(led->flash.led_cdev.flags & LED_DEV_CAP_FLASH))  in qcom_flash_v4l2_init()
512 	intensity->min = intensity->step = TORCH_IRES_UA * led->chan_count;  in qcom_flash_v4l2_init()
513 	intensity->max = led->max_torch_current_ma * UA_PER_MA;  in qcom_flash_v4l2_init()
516 	strscpy(v4l2_cfg.dev_name, led->flash.led_cdev.dev->kobj.name,  in qcom_flash_v4l2_init()
527 		v4l2_flash_init(dev, fwnode, &led->flash, &qcom_v4l2_flash_ops, &v4l2_cfg);  in qcom_flash_v4l2_init()
532 qcom_flash_v4l2_init(struct device *dev, struct qcom_flash_led *led, struct fwnode_handle *fwnode)  in qcom_flash_v4l2_init()  argument
539 		struct fwnode_handle *node, struct qcom_flash_led *led)  in qcom_flash_register_led_device()  argument
541 	struct qcom_flash_data *flash_data = led->flash_data;  in qcom_flash_register_led_device()
543 	struct led_classdev_flash *flash = &led->flash;  in qcom_flash_register_led_device()
549 	count = fwnode_property_count_u32(node, "led-sources");  in qcom_flash_register_led_device()
551 		dev_err(dev, "No led-sources specified\n");  in qcom_flash_register_led_device()
556 		dev_err(dev, "led-sources count %u exceeds maximum channel count %u\n",  in qcom_flash_register_led_device()
561 	rc = fwnode_property_read_u32_array(node, "led-sources", channels, count);  in qcom_flash_register_led_device()
563 		dev_err(dev, "Failed to read led-sources property, rc=%d\n", rc);  in qcom_flash_register_led_device()
567 	led->chan_count = count;  in qcom_flash_register_led_device()
568 	led->chan_id = devm_kcalloc(dev, count, sizeof(u8), GFP_KERNEL);  in qcom_flash_register_led_device()
569 	if (!led->chan_id)  in qcom_flash_register_led_device()
574 			dev_err(dev, "led-source out of HW support range [1-%u]\n",  in qcom_flash_register_led_device()
580 		led->chan_id[i] = channels[i] - 1;  in qcom_flash_register_led_device()
583 	rc = fwnode_property_read_u32(node, "led-max-microamp", &current_ua);  in qcom_flash_register_led_device()
585 		dev_err(dev, "Failed to read led-max-microamp property, rc=%d\n", rc);  in qcom_flash_register_led_device()
590 		dev_err(dev, "led-max-microamp shouldn't be 0\n");  in qcom_flash_register_led_device()
594 	current_ua = min_t(u32, current_ua, TORCH_CURRENT_MAX_UA * led->chan_count);  in qcom_flash_register_led_device()
595 	led->max_torch_current_ma = current_ua / UA_PER_MA;  in qcom_flash_register_led_device()
607 		current_ua = min_t(u32, current_ua, FLASH_CURRENT_MAX_UA * led->chan_count);  in qcom_flash_register_led_device()
610 		/* Initialize flash class LED device brightness settings */  in qcom_flash_register_led_device()
612 		brightness->min = brightness->step = FLASH_IRES_UA * led->chan_count;  in qcom_flash_register_led_device()
616 		led->max_flash_current_ma = current_ua / UA_PER_MA;  in qcom_flash_register_led_device()
617 		led->flash_current_ma = brightness->val / UA_PER_MA;  in qcom_flash_register_led_device()
628 		/* Initialize flash class LED device timeout settings */  in qcom_flash_register_led_device()
633 		led->max_timeout_ms = led->flash_timeout_ms = timeout_us / USEC_PER_MSEC;  in qcom_flash_register_led_device()
647 		dev_err(dev, "Register flash LED classdev failed, rc=%d\n", rc);  in qcom_flash_register_led_device()
651 	return qcom_flash_v4l2_init(dev, led, node);  in qcom_flash_register_led_device()
657 	struct qcom_flash_led *led;  in qcom_flash_led_probe()  local
683 		dev_err(dev, "Read flash LED module type failed, rc=%d\n", rc);  in qcom_flash_led_probe()
688 		dev_err(dev, "type %#x is not a flash LED module\n", val);  in qcom_flash_led_probe()
694 		dev_err(dev, "Read flash LED module subtype failed, rc=%d\n", rc);  in qcom_flash_led_probe()
707 		dev_err(dev, "flash LED subtype %#x is not yet supported\n", val);  in qcom_flash_led_probe()
735 		led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL);  in qcom_flash_led_probe()
736 		if (!led) {  in qcom_flash_led_probe()
741 		led->flash_data = flash_data;  in qcom_flash_led_probe()
742 		rc = qcom_flash_register_led_device(dev, child, led);  in qcom_flash_led_probe()
770 	{ .compatible = "qcom,spmi-flash-led" },
786 MODULE_DESCRIPTION("QCOM Flash LED driver");