14 #include <linux/phy.h>
18 static struct phy_led_trigger *phy_speed_to_led_trigger(struct phy_device *phy,  in phy_speed_to_led_trigger()  argument
23 	for (i = 0; i < phy->phy_num_led_triggers; i++) {  in phy_speed_to_led_trigger()
24 		if (phy->phy_led_triggers[i].speed == speed)  in phy_speed_to_led_trigger()
25 			return &phy->phy_led_triggers[i];  in phy_speed_to_led_trigger()
30 static void phy_led_trigger_no_link(struct phy_device *phy)  in phy_led_trigger_no_link()  argument
32 	if (phy->last_triggered) {  in phy_led_trigger_no_link()
33 		led_trigger_event(&phy->last_triggered->trigger, LED_OFF);  in phy_led_trigger_no_link()
34 		led_trigger_event(&phy->led_link_trigger->trigger, LED_OFF);  in phy_led_trigger_no_link()
35 		phy->last_triggered = NULL;  in phy_led_trigger_no_link()
39 void phy_led_trigger_change_speed(struct phy_device *phy)  in phy_led_trigger_change_speed()  argument
43 	if (!phy->link)  in phy_led_trigger_change_speed()
44 		return phy_led_trigger_no_link(phy);  in phy_led_trigger_change_speed()
46 	if (phy->speed == 0)  in phy_led_trigger_change_speed()
49 	plt = phy_speed_to_led_trigger(phy, phy->speed);  in phy_led_trigger_change_speed()
51 		netdev_alert(phy->attached_dev,  in phy_led_trigger_change_speed()
52 			     "No phy led trigger registered for speed(%d)\n",  in phy_led_trigger_change_speed()
53 			     phy->speed);  in phy_led_trigger_change_speed()
54 		return phy_led_trigger_no_link(phy);  in phy_led_trigger_change_speed()
57 	if (plt != phy->last_triggered) {  in phy_led_trigger_change_speed()
58 		if (!phy->last_triggered)  in phy_led_trigger_change_speed()
59 			led_trigger_event(&phy->led_link_trigger->trigger,  in phy_led_trigger_change_speed()
62 			led_trigger_event(&phy->last_triggered->trigger, LED_OFF);  in phy_led_trigger_change_speed()
65 		phy->last_triggered = plt;  in phy_led_trigger_change_speed()
70 static void phy_led_trigger_format_name(struct phy_device *phy, char *buf,  in phy_led_trigger_format_name()  argument
74 		 phy->mdio.bus->id, phy->mdio.addr, suffix);  in phy_led_trigger_format_name()
77 static int phy_led_trigger_register(struct phy_device *phy,  in phy_led_trigger_register()  argument
93 	phy_led_trigger_format_name(phy, plt->name, sizeof(plt->name),  in phy_led_trigger_register()
105 int phy_led_triggers_register(struct phy_device *phy)  in phy_led_triggers_register()  argument
110 	phy->phy_num_led_triggers = phy_supported_speeds(phy, speeds,  in phy_led_triggers_register()
112 	if (!phy->phy_num_led_triggers)  in phy_led_triggers_register()
115 	phy->led_link_trigger = devm_kzalloc(&phy->mdio.dev,  in phy_led_triggers_register()
116 					     sizeof(*phy->led_link_trigger),  in phy_led_triggers_register()
118 	if (!phy->led_link_trigger) {  in phy_led_triggers_register()
123 	phy_led_trigger_format_name(phy, phy->led_link_trigger->name,  in phy_led_triggers_register()
124 				    sizeof(phy->led_link_trigger->name),  in phy_led_triggers_register()
126 	phy->led_link_trigger->trigger.name = phy->led_link_trigger->name;  in phy_led_triggers_register()
128 	err = led_trigger_register(&phy->led_link_trigger->trigger);  in phy_led_triggers_register()
132 	phy->phy_led_triggers = devm_kcalloc(&phy->mdio.dev,  in phy_led_triggers_register()
133 					    phy->phy_num_led_triggers,  in phy_led_triggers_register()
136 	if (!phy->phy_led_triggers) {  in phy_led_triggers_register()
141 	for (i = 0; i < phy->phy_num_led_triggers; i++) {  in phy_led_triggers_register()
142 		err = phy_led_trigger_register(phy, &phy->phy_led_triggers[i],  in phy_led_triggers_register()
148 	phy->last_triggered = NULL;  in phy_led_triggers_register()
149 	phy_led_trigger_change_speed(phy);  in phy_led_triggers_register()
154 		phy_led_trigger_unregister(&phy->phy_led_triggers[i]);  in phy_led_triggers_register()
155 	devm_kfree(&phy->mdio.dev, phy->phy_led_triggers);  in phy_led_triggers_register()
157 	phy_led_trigger_unregister(phy->led_link_trigger);  in phy_led_triggers_register()
159 	devm_kfree(&phy->mdio.dev, phy->led_link_trigger);  in phy_led_triggers_register()
160 	phy->led_link_trigger = NULL;  in phy_led_triggers_register()
162 	phy->phy_num_led_triggers = 0;  in phy_led_triggers_register()
167 void phy_led_triggers_unregister(struct phy_device *phy)  in phy_led_triggers_unregister()  argument
171 	for (i = 0; i < phy->phy_num_led_triggers; i++)  in phy_led_triggers_unregister()
172 		phy_led_trigger_unregister(&phy->phy_led_triggers[i]);  in phy_led_triggers_unregister()
174 	if (phy->led_link_trigger)  in phy_led_triggers_unregister()
175 		phy_led_trigger_unregister(phy->led_link_trigger);  in phy_led_triggers_unregister()