4 #include <linux/phy.h>
10 static struct phy_led_trigger *phy_speed_to_led_trigger(struct phy_device *phy,  in phy_speed_to_led_trigger()  argument
15 	for (i = 0; i < phy->phy_num_led_triggers; i++) {  in phy_speed_to_led_trigger()
16 		if (phy->phy_led_triggers[i].speed == speed)  in phy_speed_to_led_trigger()
17 			return &phy->phy_led_triggers[i];  in phy_speed_to_led_trigger()
22 static void phy_led_trigger_no_link(struct phy_device *phy)  in phy_led_trigger_no_link()  argument
24 	if (phy->last_triggered) {  in phy_led_trigger_no_link()
25 		led_trigger_event(&phy->last_triggered->trigger, LED_OFF);  in phy_led_trigger_no_link()
26 		led_trigger_event(&phy->led_link_trigger->trigger, LED_OFF);  in phy_led_trigger_no_link()
27 		phy->last_triggered = NULL;  in phy_led_trigger_no_link()
31 void phy_led_trigger_change_speed(struct phy_device *phy)  in phy_led_trigger_change_speed()  argument
35 	if (!phy->link)  in phy_led_trigger_change_speed()
36 		return phy_led_trigger_no_link(phy);  in phy_led_trigger_change_speed()
38 	if (phy->speed == 0)  in phy_led_trigger_change_speed()
41 	plt = phy_speed_to_led_trigger(phy, phy->speed);  in phy_led_trigger_change_speed()
43 		netdev_alert(phy->attached_dev,  in phy_led_trigger_change_speed()
44 			     "No phy led trigger registered for speed(%d)\n",  in phy_led_trigger_change_speed()
45 			     phy->speed);  in phy_led_trigger_change_speed()
46 		return phy_led_trigger_no_link(phy);  in phy_led_trigger_change_speed()
49 	if (plt != phy->last_triggered) {  in phy_led_trigger_change_speed()
50 		if (!phy->last_triggered)  in phy_led_trigger_change_speed()
51 			led_trigger_event(&phy->led_link_trigger->trigger,  in phy_led_trigger_change_speed()
54 			led_trigger_event(&phy->last_triggered->trigger, LED_OFF);  in phy_led_trigger_change_speed()
57 		phy->last_triggered = plt;  in phy_led_trigger_change_speed()
62 static void phy_led_trigger_format_name(struct phy_device *phy, char *buf,  in phy_led_trigger_format_name()  argument
66 		 phy->mdio.bus->id, phy->mdio.addr, suffix);  in phy_led_trigger_format_name()
69 static int phy_led_trigger_register(struct phy_device *phy,  in phy_led_trigger_register()  argument
75 	phy_led_trigger_format_name(phy, plt->name, sizeof(plt->name), suffix);  in phy_led_trigger_register()
86 int phy_led_triggers_register(struct phy_device *phy)  in phy_led_triggers_register()  argument
91 	phy->phy_num_led_triggers = phy_supported_speeds(phy, speeds,  in phy_led_triggers_register()
93 	if (!phy->phy_num_led_triggers)  in phy_led_triggers_register()
96 	phy->led_link_trigger = kzalloc(sizeof(*phy->led_link_trigger),  in phy_led_triggers_register()
98 	if (!phy->led_link_trigger) {  in phy_led_triggers_register()
103 	err = phy_led_trigger_register(phy, phy->led_link_trigger, 0, "link");  in phy_led_triggers_register()
107 	phy->phy_led_triggers = kcalloc(phy->phy_num_led_triggers,  in phy_led_triggers_register()
110 	if (!phy->phy_led_triggers) {  in phy_led_triggers_register()
115 	for (i = 0; i < phy->phy_num_led_triggers; i++) {  in phy_led_triggers_register()
116 		err = phy_led_trigger_register(phy, &phy->phy_led_triggers[i],  in phy_led_triggers_register()
123 	phy->last_triggered = NULL;  in phy_led_triggers_register()
124 	phy_led_trigger_change_speed(phy);  in phy_led_triggers_register()
129 		phy_led_trigger_unregister(&phy->phy_led_triggers[i]);  in phy_led_triggers_register()
130 	kfree(phy->phy_led_triggers);  in phy_led_triggers_register()
132 	phy_led_trigger_unregister(phy->led_link_trigger);  in phy_led_triggers_register()
134 	kfree(phy->led_link_trigger);  in phy_led_triggers_register()
135 	phy->led_link_trigger = NULL;  in phy_led_triggers_register()
137 	phy->phy_num_led_triggers = 0;  in phy_led_triggers_register()
142 void phy_led_triggers_unregister(struct phy_device *phy)  in phy_led_triggers_unregister()  argument
146 	for (i = 0; i < phy->phy_num_led_triggers; i++)  in phy_led_triggers_unregister()
147 		phy_led_trigger_unregister(&phy->phy_led_triggers[i]);  in phy_led_triggers_unregister()
148 	kfree(phy->phy_led_triggers);  in phy_led_triggers_unregister()
149 	phy->phy_led_triggers = NULL;  in phy_led_triggers_unregister()
151 	if (phy->led_link_trigger) {  in phy_led_triggers_unregister()
152 		phy_led_trigger_unregister(phy->led_link_trigger);  in phy_led_triggers_unregister()
153 		kfree(phy->led_link_trigger);  in phy_led_triggers_unregister()
154 		phy->led_link_trigger = NULL;  in phy_led_triggers_unregister()