1 // SPDX-License-Identifier: GPL-2.0
9 // Derived from ledtrig-timer.c which is:
10 //  Copyright 2005-2006 Openedhand Ltd.
34  * device_name - network device name to monitor
35  * interval - duration of LED blink, in milliseconds
36  * link -  LED's normal state reflects whether the link is up
38  * tx -  LED blinks on transmitted data
39  * rx -  LED blinks on receive data
48  * -EOPNOTSUPP to the user, but still store the selected mode. This is needed
77 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in set_baseline_state()
80 	if (trigger_data->hw_control) {  in set_baseline_state()
81 		led_cdev->hw_control_set(led_cdev, trigger_data->mode);  in set_baseline_state()
86 	current_brightness = led_cdev->brightness;  in set_baseline_state()
88 		led_cdev->blink_brightness = current_brightness;  in set_baseline_state()
89 	if (!led_cdev->blink_brightness)  in set_baseline_state()
90 		led_cdev->blink_brightness = led_cdev->max_brightness;  in set_baseline_state()
92 	if (!trigger_data->carrier_link_up) {  in set_baseline_state()
97 		if (test_bit(TRIGGER_NETDEV_LINK, &trigger_data->mode))  in set_baseline_state()
100 		if (test_bit(TRIGGER_NETDEV_LINK_10, &trigger_data->mode) &&  in set_baseline_state()
101 		    trigger_data->link_speed == SPEED_10)  in set_baseline_state()
104 		if (test_bit(TRIGGER_NETDEV_LINK_100, &trigger_data->mode) &&  in set_baseline_state()
105 		    trigger_data->link_speed == SPEED_100)  in set_baseline_state()
108 		if (test_bit(TRIGGER_NETDEV_LINK_1000, &trigger_data->mode) &&  in set_baseline_state()
109 		    trigger_data->link_speed == SPEED_1000)  in set_baseline_state()
112 		if (test_bit(TRIGGER_NETDEV_LINK_2500, &trigger_data->mode) &&  in set_baseline_state()
113 		    trigger_data->link_speed == SPEED_2500)  in set_baseline_state()
116 		if (test_bit(TRIGGER_NETDEV_LINK_5000, &trigger_data->mode) &&  in set_baseline_state()
117 		    trigger_data->link_speed == SPEED_5000)  in set_baseline_state()
120 		if (test_bit(TRIGGER_NETDEV_LINK_10000, &trigger_data->mode) &&  in set_baseline_state()
121 		    trigger_data->link_speed == SPEED_10000)  in set_baseline_state()
124 		if (test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &trigger_data->mode) &&  in set_baseline_state()
125 		    trigger_data->duplex == DUPLEX_HALF)  in set_baseline_state()
128 		if (test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &trigger_data->mode) &&  in set_baseline_state()
129 		    trigger_data->duplex == DUPLEX_FULL)  in set_baseline_state()
134 					   led_cdev->blink_brightness);  in set_baseline_state()
141 		if (test_bit(TRIGGER_NETDEV_TX, &trigger_data->mode) ||  in set_baseline_state()
142 		    test_bit(TRIGGER_NETDEV_RX, &trigger_data->mode))  in set_baseline_state()
143 			schedule_delayed_work(&trigger_data->work, 0);  in set_baseline_state()
149 	if (!led_cdev->hw_control_get || !led_cdev->hw_control_set ||  in supports_hw_control()
150 	    !led_cdev->hw_control_is_supported)  in supports_hw_control()
153 	return !strcmp(led_cdev->hw_control_trigger, led_cdev->trigger->name);  in supports_hw_control()
157  * Validate the configured netdev is the same as the one associated with
163 	struct device *dev = led_cdev->hw_control_get_device(led_cdev);  in validate_net_dev()
177 	unsigned int interval = atomic_read(&trigger_data->interval);  in can_hw_control()
178 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in can_hw_control()
199 	if (!validate_net_dev(led_cdev, trigger_data->net_dev))  in can_hw_control()
203 	ret = led_cdev->hw_control_is_supported(led_cdev, trigger_data->mode);  in can_hw_control()
205 	if (ret == -EOPNOTSUPP)  in can_hw_control()
208 		dev_warn(led_cdev->dev,  in can_hw_control()
220 	trigger_data->carrier_link_up = netif_carrier_ok(trigger_data->net_dev);  in get_device_state()
221 	if (!trigger_data->carrier_link_up)  in get_device_state()
224 	if (!__ethtool_get_link_ksettings(trigger_data->net_dev, &cmd)) {  in get_device_state()
225 		trigger_data->link_speed = cmd.base.speed;  in get_device_state()
226 		trigger_data->duplex = cmd.base.duplex;  in get_device_state()
236 	mutex_lock(&trigger_data->lock);  in device_name_show()
237 	len = sprintf(buf, "%s\n", trigger_data->device_name);  in device_name_show()
238 	mutex_unlock(&trigger_data->lock);  in device_name_show()
247 		return -EINVAL;  in set_device_name()
249 	cancel_delayed_work_sync(&trigger_data->work);  in set_device_name()
256 	mutex_lock(&trigger_data->lock);  in set_device_name()
258 	if (trigger_data->net_dev) {  in set_device_name()
259 		dev_put(trigger_data->net_dev);  in set_device_name()
260 		trigger_data->net_dev = NULL;  in set_device_name()
263 	memcpy(trigger_data->device_name, name, size);  in set_device_name()
264 	trigger_data->device_name[size] = 0;  in set_device_name()
265 	if (size > 0 && trigger_data->device_name[size - 1] == '\n')  in set_device_name()
266 		trigger_data->device_name[size - 1] = 0;  in set_device_name()
268 	if (trigger_data->device_name[0] != 0)  in set_device_name()
269 		trigger_data->net_dev =  in set_device_name()
270 		    dev_get_by_name(&init_net, trigger_data->device_name);  in set_device_name()
272 	trigger_data->carrier_link_up = false;  in set_device_name()
273 	trigger_data->link_speed = SPEED_UNKNOWN;  in set_device_name()
274 	trigger_data->duplex = DUPLEX_UNKNOWN;  in set_device_name()
275 	if (trigger_data->net_dev)  in set_device_name()
278 	trigger_data->last_activity = 0;  in set_device_name()
281 	mutex_unlock(&trigger_data->lock);  in set_device_name()
324 		return -EINVAL;  in netdev_led_attr_show()
327 	return sprintf(buf, "%u\n", test_bit(bit, &trigger_data->mode));  in netdev_led_attr_show()
334 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in netdev_led_attr_store()
335 	unsigned long state, mode = trigger_data->mode;  in netdev_led_attr_store()
358 		return -EINVAL;  in netdev_led_attr_store()
373 		return -EINVAL;  in netdev_led_attr_store()
375 	cancel_delayed_work_sync(&trigger_data->work);  in netdev_led_attr_store()
377 	trigger_data->mode = mode;  in netdev_led_attr_store()
378 	trigger_data->hw_control = can_hw_control(trigger_data);  in netdev_led_attr_store()
380 	if (!led_cdev->brightness_set && !led_cdev->brightness_set_blocking &&  in netdev_led_attr_store()
381 	    !trigger_data->hw_control)  in netdev_led_attr_store()
382 		return -EOPNOTSUPP;  in netdev_led_attr_store()
420 		       jiffies_to_msecs(atomic_read(&trigger_data->interval)));  in interval_show()
431 	if (trigger_data->hw_control)  in interval_store()
432 		return -EINVAL;  in interval_store()
440 		cancel_delayed_work_sync(&trigger_data->work);  in interval_store()
442 		atomic_set(&trigger_data->interval, msecs_to_jiffies(value));  in interval_store()
456 	return sprintf(buf, "%d\n", trigger_data->hw_control);  in offloaded_show()
493 	if (!(dev == trigger_data->net_dev ||  in netdev_trig_notify()
494 	      (evt == NETDEV_CHANGENAME && !strcmp(dev->name, trigger_data->device_name)) ||  in netdev_trig_notify()
495 	      (evt == NETDEV_REGISTER && !strcmp(dev->name, trigger_data->device_name))))  in netdev_trig_notify()
498 	cancel_delayed_work_sync(&trigger_data->work);  in netdev_trig_notify()
500 	mutex_lock(&trigger_data->lock);  in netdev_trig_notify()
502 	trigger_data->carrier_link_up = false;  in netdev_trig_notify()
503 	trigger_data->link_speed = SPEED_UNKNOWN;  in netdev_trig_notify()
504 	trigger_data->duplex = DUPLEX_UNKNOWN;  in netdev_trig_notify()
510 		dev_put(trigger_data->net_dev);  in netdev_trig_notify()
512 		trigger_data->net_dev = dev;  in netdev_trig_notify()
515 		dev_put(trigger_data->net_dev);  in netdev_trig_notify()
516 		trigger_data->net_dev = NULL;  in netdev_trig_notify()
526 	mutex_unlock(&trigger_data->lock);  in netdev_trig_notify()
542 	/* If we dont have a device, insure we are off */  in netdev_trig_work()
543 	if (!trigger_data->net_dev) {  in netdev_trig_work()
544 		led_set_brightness(trigger_data->led_cdev, LED_OFF);  in netdev_trig_work()
549 	if (!test_bit(TRIGGER_NETDEV_TX, &trigger_data->mode) &&  in netdev_trig_work()
550 	    !test_bit(TRIGGER_NETDEV_RX, &trigger_data->mode))  in netdev_trig_work()
553 	dev_stats = dev_get_stats(trigger_data->net_dev, &temp);  in netdev_trig_work()
555 	    (test_bit(TRIGGER_NETDEV_TX, &trigger_data->mode) ?  in netdev_trig_work()
556 		dev_stats->tx_packets : 0) +  in netdev_trig_work()
557 	    (test_bit(TRIGGER_NETDEV_RX, &trigger_data->mode) ?  in netdev_trig_work()
558 		dev_stats->rx_packets : 0);  in netdev_trig_work()
560 	if (trigger_data->last_activity != new_activity) {  in netdev_trig_work()
561 		led_stop_software_blink(trigger_data->led_cdev);  in netdev_trig_work()
563 		invert = test_bit(TRIGGER_NETDEV_LINK, &trigger_data->mode) ||  in netdev_trig_work()
564 			 test_bit(TRIGGER_NETDEV_LINK_10, &trigger_data->mode) ||  in netdev_trig_work()
565 			 test_bit(TRIGGER_NETDEV_LINK_100, &trigger_data->mode) ||  in netdev_trig_work()
566 			 test_bit(TRIGGER_NETDEV_LINK_1000, &trigger_data->mode) ||  in netdev_trig_work()
567 			 test_bit(TRIGGER_NETDEV_LINK_2500, &trigger_data->mode) ||  in netdev_trig_work()
568 			 test_bit(TRIGGER_NETDEV_LINK_5000, &trigger_data->mode) ||  in netdev_trig_work()
569 			 test_bit(TRIGGER_NETDEV_LINK_10000, &trigger_data->mode) ||  in netdev_trig_work()
570 			 test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &trigger_data->mode) ||  in netdev_trig_work()
571 			 test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &trigger_data->mode);  in netdev_trig_work()
573 				atomic_read(&trigger_data->interval));  in netdev_trig_work()
575 		led_blink_set_oneshot(trigger_data->led_cdev,  in netdev_trig_work()
579 		trigger_data->last_activity = new_activity;  in netdev_trig_work()
582 	schedule_delayed_work(&trigger_data->work,  in netdev_trig_work()
583 			(atomic_read(&trigger_data->interval)*2));  in netdev_trig_work()
595 		return -ENOMEM;  in netdev_trig_activate()
597 	mutex_init(&trigger_data->lock);  in netdev_trig_activate()
599 	trigger_data->notifier.notifier_call = netdev_trig_notify;  in netdev_trig_activate()
600 	trigger_data->notifier.priority = 10;  in netdev_trig_activate()
602 	INIT_DELAYED_WORK(&trigger_data->work, netdev_trig_work);  in netdev_trig_activate()
604 	trigger_data->led_cdev = led_cdev;  in netdev_trig_activate()
605 	trigger_data->net_dev = NULL;  in netdev_trig_activate()
606 	trigger_data->device_name[0] = 0;  in netdev_trig_activate()
608 	trigger_data->mode = 0;  in netdev_trig_activate()
609 	atomic_set(&trigger_data->interval, msecs_to_jiffies(NETDEV_LED_DEFAULT_INTERVAL));  in netdev_trig_activate()
610 	trigger_data->last_activity = 0;  in netdev_trig_activate()
616 		dev = led_cdev->hw_control_get_device(led_cdev);  in netdev_trig_activate()
621 			trigger_data->hw_control = true;  in netdev_trig_activate()
623 			rc = led_cdev->hw_control_get(led_cdev, &mode);  in netdev_trig_activate()
625 				trigger_data->mode = mode;  in netdev_trig_activate()
631 	rc = register_netdevice_notifier(&trigger_data->notifier);  in netdev_trig_activate()
642 	unregister_netdevice_notifier(&trigger_data->notifier);  in netdev_trig_deactivate()
644 	cancel_delayed_work_sync(&trigger_data->work);  in netdev_trig_deactivate()
648 	dev_put(trigger_data->net_dev);  in netdev_trig_deactivate()