1 // SPDX-License-Identifier: GPL-2.0
9 // Derived from ledtrig-timer.c which is:
10 //  Copyright 2005-2006 Openedhand Ltd.
36  * device_name - network device name to monitor
37  * interval - duration of LED blink, in milliseconds
38  * link -  LED's normal state reflects whether the link is up
40  * tx -  LED blinks on transmitted data
41  * rx -  LED blinks on receive data
42  * tx_err -  LED blinks on transmit error
43  * rx_err -  LED blinks on receive error
52  * -EOPNOTSUPP to the user, but still store the selected mode. This is needed
85 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in set_baseline_state()
88 	if (trigger_data->hw_control) {  in set_baseline_state()
89 		led_cdev->hw_control_set(led_cdev, trigger_data->mode);  in set_baseline_state()
90 		if (led_cdev->blink_set) {  in set_baseline_state()
91 			led_cdev->blink_set(led_cdev, &trigger_data->blink_delay,  in set_baseline_state()
92 					    &trigger_data->blink_delay);  in set_baseline_state()
98 	current_brightness = led_cdev->brightness;  in set_baseline_state()
100 		led_cdev->blink_brightness = current_brightness;  in set_baseline_state()
101 	if (!led_cdev->blink_brightness)  in set_baseline_state()
102 		led_cdev->blink_brightness = led_cdev->max_brightness;  in set_baseline_state()
104 	if (!trigger_data->carrier_link_up) {  in set_baseline_state()
109 		if (test_bit(TRIGGER_NETDEV_LINK, &trigger_data->mode))  in set_baseline_state()
112 		if (test_bit(TRIGGER_NETDEV_LINK_10, &trigger_data->mode) &&  in set_baseline_state()
113 		    trigger_data->link_speed == SPEED_10)  in set_baseline_state()
116 		if (test_bit(TRIGGER_NETDEV_LINK_100, &trigger_data->mode) &&  in set_baseline_state()
117 		    trigger_data->link_speed == SPEED_100)  in set_baseline_state()
120 		if (test_bit(TRIGGER_NETDEV_LINK_1000, &trigger_data->mode) &&  in set_baseline_state()
121 		    trigger_data->link_speed == SPEED_1000)  in set_baseline_state()
124 		if (test_bit(TRIGGER_NETDEV_LINK_2500, &trigger_data->mode) &&  in set_baseline_state()
125 		    trigger_data->link_speed == SPEED_2500)  in set_baseline_state()
128 		if (test_bit(TRIGGER_NETDEV_LINK_5000, &trigger_data->mode) &&  in set_baseline_state()
129 		    trigger_data->link_speed == SPEED_5000)  in set_baseline_state()
132 		if (test_bit(TRIGGER_NETDEV_LINK_10000, &trigger_data->mode) &&  in set_baseline_state()
133 		    trigger_data->link_speed == SPEED_10000)  in set_baseline_state()
136 		if (test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &trigger_data->mode) &&  in set_baseline_state()
137 		    trigger_data->duplex == DUPLEX_HALF)  in set_baseline_state()
140 		if (test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &trigger_data->mode) &&  in set_baseline_state()
141 		    trigger_data->duplex == DUPLEX_FULL)  in set_baseline_state()
146 					   led_cdev->blink_brightness);  in set_baseline_state()
153 		if (test_bit(TRIGGER_NETDEV_TX, &trigger_data->mode) ||  in set_baseline_state()
154 		    test_bit(TRIGGER_NETDEV_RX, &trigger_data->mode) ||  in set_baseline_state()
155 		    test_bit(TRIGGER_NETDEV_TX_ERR, &trigger_data->mode) ||  in set_baseline_state()
156 		    test_bit(TRIGGER_NETDEV_RX_ERR, &trigger_data->mode))  in set_baseline_state()
157 			schedule_delayed_work(&trigger_data->work, 0);  in set_baseline_state()
163 	if (!led_cdev->hw_control_get || !led_cdev->hw_control_set ||  in supports_hw_control()
164 	    !led_cdev->hw_control_is_supported)  in supports_hw_control()
167 	return !strcmp(led_cdev->hw_control_trigger, led_cdev->trigger->name);  in supports_hw_control()
171  * Validate the configured netdev is the same as the one associated with
177 	struct device *dev = led_cdev->hw_control_get_device(led_cdev);  in validate_net_dev()
191 	unsigned int interval = atomic_read(&trigger_data->interval);  in can_hw_control()
192 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in can_hw_control()
213 	if (!validate_net_dev(led_cdev, trigger_data->net_dev))  in can_hw_control()
217 	ret = led_cdev->hw_control_is_supported(led_cdev, trigger_data->mode);  in can_hw_control()
219 	if (ret == -EOPNOTSUPP)  in can_hw_control()
222 		dev_warn(led_cdev->dev,  in can_hw_control()
234 	trigger_data->carrier_link_up = netif_carrier_ok(trigger_data->net_dev);  in get_device_state()
236 	if (__ethtool_get_link_ksettings(trigger_data->net_dev, &cmd))  in get_device_state()
239 	if (trigger_data->carrier_link_up) {  in get_device_state()
240 		trigger_data->link_speed = cmd.base.speed;  in get_device_state()
241 		trigger_data->duplex = cmd.base.duplex;  in get_device_state()
248 	linkmode_copy(trigger_data->supported_link_modes, cmd.link_modes.supported);  in get_device_state()
257 	mutex_lock(&trigger_data->lock);  in device_name_show()
258 	len = sprintf(buf, "%s\n", trigger_data->device_name);  in device_name_show()
259 	mutex_unlock(&trigger_data->lock);  in device_name_show()
268 		return -EINVAL;  in set_device_name()
270 	cancel_delayed_work_sync(&trigger_data->work);  in set_device_name()
277 	mutex_lock(&trigger_data->lock);  in set_device_name()
279 	if (trigger_data->net_dev) {  in set_device_name()
280 		dev_put(trigger_data->net_dev);  in set_device_name()
281 		trigger_data->net_dev = NULL;  in set_device_name()
284 	memcpy(trigger_data->device_name, name, size);  in set_device_name()
285 	trigger_data->device_name[size] = 0;  in set_device_name()
286 	if (size > 0 && trigger_data->device_name[size - 1] == '\n')  in set_device_name()
287 		trigger_data->device_name[size - 1] = 0;  in set_device_name()
289 	if (trigger_data->device_name[0] != 0)  in set_device_name()
290 		trigger_data->net_dev =  in set_device_name()
291 		    dev_get_by_name(&init_net, trigger_data->device_name);  in set_device_name()
293 	trigger_data->carrier_link_up = false;  in set_device_name()
294 	trigger_data->link_speed = SPEED_UNKNOWN;  in set_device_name()
295 	trigger_data->duplex = DUPLEX_UNKNOWN;  in set_device_name()
296 	if (trigger_data->net_dev)  in set_device_name()
299 	trigger_data->last_activity = 0;  in set_device_name()
302 	if (!trigger_data->hw_control || led_get_trigger_data(trigger_data->led_cdev))  in set_device_name()
305 	mutex_unlock(&trigger_data->lock);  in set_device_name()
324 	sysfs_update_group(&dev->kobj, &netdev_trig_link_speed_attrs_group);  in device_name_store()
354 		return -EINVAL;  in netdev_led_attr_show()
357 	return sprintf(buf, "%u\n", test_bit(bit, &trigger_data->mode));  in netdev_led_attr_show()
364 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in netdev_led_attr_store()
365 	unsigned long state, mode = trigger_data->mode;  in netdev_led_attr_store()
390 		return -EINVAL;  in netdev_led_attr_store()
405 		return -EINVAL;  in netdev_led_attr_store()
407 	cancel_delayed_work_sync(&trigger_data->work);  in netdev_led_attr_store()
409 	trigger_data->mode = mode;  in netdev_led_attr_store()
410 	trigger_data->hw_control = can_hw_control(trigger_data);  in netdev_led_attr_store()
412 	if (!led_cdev->brightness_set && !led_cdev->brightness_set_blocking &&  in netdev_led_attr_store()
413 	    !trigger_data->hw_control)  in netdev_led_attr_store()
414 		return -EOPNOTSUPP;  in netdev_led_attr_store()
454 		       jiffies_to_msecs(atomic_read(&trigger_data->interval)));  in interval_show()
462 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in interval_store()
466 	if (trigger_data->hw_control && !led_cdev->blink_set)  in interval_store()
467 		return -EINVAL;  in interval_store()
475 		if (trigger_data->hw_control) {  in interval_store()
476 			trigger_data->blink_delay = value;  in interval_store()
478 			cancel_delayed_work_sync(&trigger_data->work);  in interval_store()
480 			atomic_set(&trigger_data->interval, msecs_to_jiffies(value));  in interval_store()
495 	return sprintf(buf, "%d\n", trigger_data->hw_control);  in offloaded_show()
504 			return attr->mode; \
516 	supported_link_modes = trigger_data->supported_link_modes;  in netdev_trig_link_speed_visible()
585 	struct led_classdev *led_cdev = trigger_data->led_cdev;  in netdev_trig_notify()
592 	if (!(dev == trigger_data->net_dev ||  in netdev_trig_notify()
593 	      (evt == NETDEV_CHANGENAME && !strcmp(dev->name, trigger_data->device_name)) ||  in netdev_trig_notify()
594 	      (evt == NETDEV_REGISTER && !strcmp(dev->name, trigger_data->device_name))))  in netdev_trig_notify()
597 	cancel_delayed_work_sync(&trigger_data->work);  in netdev_trig_notify()
599 	mutex_lock(&trigger_data->lock);  in netdev_trig_notify()
601 	trigger_data->carrier_link_up = false;  in netdev_trig_notify()
602 	trigger_data->link_speed = SPEED_UNKNOWN;  in netdev_trig_notify()
603 	trigger_data->duplex = DUPLEX_UNKNOWN;  in netdev_trig_notify()
607 		dev_put(trigger_data->net_dev);  in netdev_trig_notify()
609 		trigger_data->net_dev = dev;  in netdev_trig_notify()
614 		dev_put(trigger_data->net_dev);  in netdev_trig_notify()
615 		trigger_data->net_dev = NULL;  in netdev_trig_notify()
618 		trigger_data->hw_control = can_hw_control(trigger_data);  in netdev_trig_notify()
624 			sysfs_update_group(&led_cdev->dev->kobj,  in netdev_trig_notify()
631 	mutex_unlock(&trigger_data->lock);  in netdev_trig_notify()
647 	/* If we dont have a device, insure we are off */  in netdev_trig_work()
648 	if (!trigger_data->net_dev) {  in netdev_trig_work()
649 		led_set_brightness(trigger_data->led_cdev, LED_OFF);  in netdev_trig_work()
654 	if (!test_bit(TRIGGER_NETDEV_TX, &trigger_data->mode) &&  in netdev_trig_work()
655 	    !test_bit(TRIGGER_NETDEV_RX, &trigger_data->mode) &&  in netdev_trig_work()
656 	    !test_bit(TRIGGER_NETDEV_TX_ERR, &trigger_data->mode) &&  in netdev_trig_work()
657 	    !test_bit(TRIGGER_NETDEV_RX_ERR, &trigger_data->mode))  in netdev_trig_work()
660 	dev_stats = dev_get_stats(trigger_data->net_dev, &temp);  in netdev_trig_work()
662 	    (test_bit(TRIGGER_NETDEV_TX, &trigger_data->mode) ?  in netdev_trig_work()
663 		dev_stats->tx_packets : 0) +  in netdev_trig_work()
664 	    (test_bit(TRIGGER_NETDEV_RX, &trigger_data->mode) ?  in netdev_trig_work()
665 		dev_stats->rx_packets : 0) +  in netdev_trig_work()
666 	    (test_bit(TRIGGER_NETDEV_TX_ERR, &trigger_data->mode) ?  in netdev_trig_work()
667 		dev_stats->tx_errors : 0) +  in netdev_trig_work()
668 	    (test_bit(TRIGGER_NETDEV_RX_ERR, &trigger_data->mode) ?  in netdev_trig_work()
669 		dev_stats->rx_errors : 0);  in netdev_trig_work()
671 	if (trigger_data->last_activity != new_activity) {  in netdev_trig_work()
672 		led_stop_software_blink(trigger_data->led_cdev);  in netdev_trig_work()
674 		invert = test_bit(TRIGGER_NETDEV_LINK, &trigger_data->mode) ||  in netdev_trig_work()
675 			 test_bit(TRIGGER_NETDEV_LINK_10, &trigger_data->mode) ||  in netdev_trig_work()
676 			 test_bit(TRIGGER_NETDEV_LINK_100, &trigger_data->mode) ||  in netdev_trig_work()
677 			 test_bit(TRIGGER_NETDEV_LINK_1000, &trigger_data->mode) ||  in netdev_trig_work()
678 			 test_bit(TRIGGER_NETDEV_LINK_2500, &trigger_data->mode) ||  in netdev_trig_work()
679 			 test_bit(TRIGGER_NETDEV_LINK_5000, &trigger_data->mode) ||  in netdev_trig_work()
680 			 test_bit(TRIGGER_NETDEV_LINK_10000, &trigger_data->mode) ||  in netdev_trig_work()
681 			 test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &trigger_data->mode) ||  in netdev_trig_work()
682 			 test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &trigger_data->mode);  in netdev_trig_work()
684 				atomic_read(&trigger_data->interval));  in netdev_trig_work()
686 		led_blink_set_oneshot(trigger_data->led_cdev,  in netdev_trig_work()
690 		trigger_data->last_activity = new_activity;  in netdev_trig_work()
693 	schedule_delayed_work(&trigger_data->work,  in netdev_trig_work()
694 			(atomic_read(&trigger_data->interval)*2));  in netdev_trig_work()
706 		return -ENOMEM;  in netdev_trig_activate()
708 	mutex_init(&trigger_data->lock);  in netdev_trig_activate()
710 	trigger_data->notifier.notifier_call = netdev_trig_notify;  in netdev_trig_activate()
711 	trigger_data->notifier.priority = 10;  in netdev_trig_activate()
713 	INIT_DELAYED_WORK(&trigger_data->work, netdev_trig_work);  in netdev_trig_activate()
715 	trigger_data->led_cdev = led_cdev;  in netdev_trig_activate()
716 	trigger_data->net_dev = NULL;  in netdev_trig_activate()
717 	trigger_data->device_name[0] = 0;  in netdev_trig_activate()
719 	trigger_data->mode = 0;  in netdev_trig_activate()
720 	atomic_set(&trigger_data->interval, msecs_to_jiffies(NETDEV_LED_DEFAULT_INTERVAL));  in netdev_trig_activate()
721 	trigger_data->last_activity = 0;  in netdev_trig_activate()
727 		dev = led_cdev->hw_control_get_device(led_cdev);  in netdev_trig_activate()
731 			trigger_data->hw_control = true;  in netdev_trig_activate()
734 			rc = led_cdev->hw_control_get(led_cdev, &mode);  in netdev_trig_activate()
736 				trigger_data->mode = mode;  in netdev_trig_activate()
742 	rc = register_netdevice_notifier(&trigger_data->notifier);  in netdev_trig_activate()
753 	unregister_netdevice_notifier(&trigger_data->notifier);  in netdev_trig_deactivate()
755 	cancel_delayed_work_sync(&trigger_data->work);  in netdev_trig_deactivate()
757 	dev_put(trigger_data->net_dev);  in netdev_trig_deactivate()