15 #include <linux/mfd/motorola-cpcap.h>
23 #define CPCAP_LED_NO_CURRENT 0x0001
35 	.mask	= 0x03FF,
41 	.mask	= 0x03FF,
47 	.mask	= 0x03FF,
54 	.mask		= 0x000F,
56 	.init_mask	= 0x7FFF,
57 	.init_val	= 0x5FF0,
60 /* camera privacy led */
63 	.mask		= 0x0007,
65 	.init_mask	= 0x03FF,
66 	.init_val	= 0x0008,
70 	struct led_classdev led;  member
83 	current_limit &= 0x1f; /* 5 bit */  in cpcap_led_val()
84 	duty_cycle &= 0x0f; /* 4 bit */  in cpcap_led_val()
89 static int cpcap_led_set_power(struct cpcap_led *led, bool status)  in cpcap_led_set_power()  argument
93 	if (status == led->powered)  in cpcap_led_set_power()
94 		return 0;  in cpcap_led_set_power()
97 		err = regulator_enable(led->vdd);  in cpcap_led_set_power()
99 		err = regulator_disable(led->vdd);  in cpcap_led_set_power()
102 		dev_err(led->dev, "regulator failure: %d", err);  in cpcap_led_set_power()
106 	led->powered = status;  in cpcap_led_set_power()
108 	return 0;  in cpcap_led_set_power()
113 	struct cpcap_led *led = container_of(ledc, struct cpcap_led, led);  in cpcap_led_set()  local
117 	mutex_lock(&led->update_lock);  in cpcap_led_set()
120 		err = cpcap_led_set_power(led, true);  in cpcap_led_set()
127 		err = regmap_update_bits(led->regmap,  in cpcap_led_set()
128 			led->info->reg, led->info->mask, CPCAP_LED_NO_CURRENT);  in cpcap_led_set()
130 			dev_err(led->dev, "regmap failed: %d", err);  in cpcap_led_set()
139 	err = regmap_update_bits(led->regmap, led->info->reg, led->info->mask,  in cpcap_led_set()
142 		dev_err(led->dev, "regmap failed: %d", err);  in cpcap_led_set()
147 		err = cpcap_led_set_power(led, false);  in cpcap_led_set()
153 	mutex_unlock(&led->update_lock);  in cpcap_led_set()
158 	{ .compatible = "motorola,cpcap-led-red", .data = &cpcap_led_red },
159 	{ .compatible = "motorola,cpcap-led-green", .data = &cpcap_led_green },
160 	{ .compatible = "motorola,cpcap-led-blue",  .data = &cpcap_led_blue },
161 	{ .compatible = "motorola,cpcap-led-adl", .data = &cpcap_led_adl },
162 	{ .compatible = "motorola,cpcap-led-cp", .data = &cpcap_led_cp },
170 	struct cpcap_led *led;  in cpcap_led_probe()  local
173 	match = of_match_device(of_match_ptr(cpcap_led_of_match), &pdev->dev);  in cpcap_led_probe()
174 	if (!match || !match->data)  in cpcap_led_probe()
175 		return -EINVAL;  in cpcap_led_probe()
177 	led = devm_kzalloc(&pdev->dev, sizeof(*led), GFP_KERNEL);  in cpcap_led_probe()
178 	if (!led)  in cpcap_led_probe()
179 		return -ENOMEM;  in cpcap_led_probe()
180 	platform_set_drvdata(pdev, led);  in cpcap_led_probe()
181 	led->info = match->data;  in cpcap_led_probe()
182 	led->dev = &pdev->dev;  in cpcap_led_probe()
184 	if (led->info->reg == 0x0000) {  in cpcap_led_probe()
185 		dev_err(led->dev, "Unsupported LED");  in cpcap_led_probe()
186 		return -ENODEV;  in cpcap_led_probe()
189 	led->regmap = dev_get_regmap(pdev->dev.parent, NULL);  in cpcap_led_probe()
190 	if (!led->regmap)  in cpcap_led_probe()
191 		return -ENODEV;  in cpcap_led_probe()
193 	led->vdd = devm_regulator_get(&pdev->dev, "vdd");  in cpcap_led_probe()
194 	if (IS_ERR(led->vdd)) {  in cpcap_led_probe()
195 		err = PTR_ERR(led->vdd);  in cpcap_led_probe()
196 		dev_err(led->dev, "Couldn't get regulator: %d", err);  in cpcap_led_probe()
200 	err = device_property_read_string(&pdev->dev, "label", &led->led.name);  in cpcap_led_probe()
202 		dev_err(led->dev, "Couldn't read LED label: %d", err);  in cpcap_led_probe()
206 	if (led->info->init_mask) {  in cpcap_led_probe()
207 		err = regmap_update_bits(led->regmap, led->info->reg,  in cpcap_led_probe()
208 			led->info->init_mask, led->info->init_val);  in cpcap_led_probe()
210 			dev_err(led->dev, "regmap failed: %d", err);  in cpcap_led_probe()
215 	mutex_init(&led->update_lock);  in cpcap_led_probe()
217 	led->led.max_brightness = led->info->limit;  in cpcap_led_probe()
218 	led->led.brightness_set_blocking = cpcap_led_set;  in cpcap_led_probe()
219 	err = devm_led_classdev_register(&pdev->dev, &led->led);  in cpcap_led_probe()
221 		dev_err(led->dev, "Couldn't register LED: %d", err);  in cpcap_led_probe()
225 	return 0;  in cpcap_led_probe()
231 		.name = "cpcap-led",
237 MODULE_DESCRIPTION("CPCAP LED driver");