Commit 3928ee64 authored by Maciej S. Szmigiero's avatar Maciej S. Szmigiero Committed by David S. Miller

net: phy: leds: Add support for "link" trigger

Currently, we create a LED trigger for any link speed known to a PHY.
These triggers only fire when their exact link speed had been negotiated
(they aren't cumulative, that is, they don't fire for "their or any higher"
link speed).

What we are missing, however, is a trigger which will fire on any link
speed known to the PHY. Such trigger can then be used for implementing a
poor man's substitute of the "link" LED on boards that lack it.
Let's add it.
Signed-off-by: default avatarMaciej S. Szmigiero <mail@maciej.szmigiero.name>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent ff198cdb
...@@ -191,11 +191,14 @@ config LED_TRIGGER_PHY ...@@ -191,11 +191,14 @@ config LED_TRIGGER_PHY
Adds support for a set of LED trigger events per-PHY. Link Adds support for a set of LED trigger events per-PHY. Link
state change will trigger the events, for consumption by an state change will trigger the events, for consumption by an
LED class driver. There are triggers for each link speed currently LED class driver. There are triggers for each link speed currently
supported by the phy, and are of the form: supported by the PHY and also a one common "link" trigger as a
logical-or of all the link speed ones.
All these triggers are named according to the following pattern:
<mii bus id>:<phy>:<speed> <mii bus id>:<phy>:<speed>
Where speed is in the form: Where speed is in the form:
<Speed in megabits>Mbps or <Speed in gigabits>Gbps <Speed in megabits>Mbps OR <Speed in gigabits>Gbps OR link
for any speed known to the PHY.
comment "MII PHY device drivers" comment "MII PHY device drivers"
......
...@@ -31,6 +31,7 @@ static void phy_led_trigger_no_link(struct phy_device *phy) ...@@ -31,6 +31,7 @@ static void phy_led_trigger_no_link(struct phy_device *phy)
{ {
if (phy->last_triggered) { if (phy->last_triggered) {
led_trigger_event(&phy->last_triggered->trigger, LED_OFF); led_trigger_event(&phy->last_triggered->trigger, LED_OFF);
led_trigger_event(&phy->led_link_trigger->trigger, LED_OFF);
phy->last_triggered = NULL; phy->last_triggered = NULL;
} }
} }
...@@ -54,6 +55,10 @@ void phy_led_trigger_change_speed(struct phy_device *phy) ...@@ -54,6 +55,10 @@ void phy_led_trigger_change_speed(struct phy_device *phy)
} }
if (plt != phy->last_triggered) { if (plt != phy->last_triggered) {
if (!phy->last_triggered)
led_trigger_event(&phy->led_link_trigger->trigger,
LED_FULL);
led_trigger_event(&phy->last_triggered->trigger, LED_OFF); led_trigger_event(&phy->last_triggered->trigger, LED_OFF);
led_trigger_event(&plt->trigger, LED_FULL); led_trigger_event(&plt->trigger, LED_FULL);
phy->last_triggered = plt; phy->last_triggered = plt;
...@@ -61,6 +66,13 @@ void phy_led_trigger_change_speed(struct phy_device *phy) ...@@ -61,6 +66,13 @@ void phy_led_trigger_change_speed(struct phy_device *phy)
} }
EXPORT_SYMBOL_GPL(phy_led_trigger_change_speed); EXPORT_SYMBOL_GPL(phy_led_trigger_change_speed);
static void phy_led_trigger_format_name(struct phy_device *phy, char *buf,
size_t size, char *suffix)
{
snprintf(buf, size, PHY_ID_FMT ":%s",
phy->mdio.bus->id, phy->mdio.addr, suffix);
}
static int phy_led_trigger_register(struct phy_device *phy, static int phy_led_trigger_register(struct phy_device *phy,
struct phy_led_trigger *plt, struct phy_led_trigger *plt,
unsigned int speed) unsigned int speed)
...@@ -77,8 +89,8 @@ static int phy_led_trigger_register(struct phy_device *phy, ...@@ -77,8 +89,8 @@ static int phy_led_trigger_register(struct phy_device *phy,
snprintf(name_suffix, sizeof(name_suffix), "%dGbps", snprintf(name_suffix, sizeof(name_suffix), "%dGbps",
DIV_ROUND_CLOSEST(speed, 1000)); DIV_ROUND_CLOSEST(speed, 1000));
snprintf(plt->name, sizeof(plt->name), PHY_ID_FMT ":%s", phy_led_trigger_format_name(phy, plt->name, sizeof(plt->name),
phy->mdio.bus->id, phy->mdio.addr, name_suffix); name_suffix);
plt->trigger.name = plt->name; plt->trigger.name = plt->name;
return led_trigger_register(&plt->trigger); return led_trigger_register(&plt->trigger);
...@@ -99,13 +111,30 @@ int phy_led_triggers_register(struct phy_device *phy) ...@@ -99,13 +111,30 @@ int phy_led_triggers_register(struct phy_device *phy)
if (!phy->phy_num_led_triggers) if (!phy->phy_num_led_triggers)
return 0; return 0;
phy->led_link_trigger = devm_kzalloc(&phy->mdio.dev,
sizeof(*phy->led_link_trigger),
GFP_KERNEL);
if (!phy->led_link_trigger) {
err = -ENOMEM;
goto out_clear;
}
phy_led_trigger_format_name(phy, phy->led_link_trigger->name,
sizeof(phy->led_link_trigger->name),
"link");
phy->led_link_trigger->trigger.name = phy->led_link_trigger->name;
err = led_trigger_register(&phy->led_link_trigger->trigger);
if (err)
goto out_free_link;
phy->phy_led_triggers = devm_kzalloc(&phy->mdio.dev, phy->phy_led_triggers = devm_kzalloc(&phy->mdio.dev,
sizeof(struct phy_led_trigger) * sizeof(struct phy_led_trigger) *
phy->phy_num_led_triggers, phy->phy_num_led_triggers,
GFP_KERNEL); GFP_KERNEL);
if (!phy->phy_led_triggers) { if (!phy->phy_led_triggers) {
err = -ENOMEM; err = -ENOMEM;
goto out_clear; goto out_unreg_link;
} }
for (i = 0; i < phy->phy_num_led_triggers; i++) { for (i = 0; i < phy->phy_num_led_triggers; i++) {
...@@ -123,6 +152,11 @@ int phy_led_triggers_register(struct phy_device *phy) ...@@ -123,6 +152,11 @@ int phy_led_triggers_register(struct phy_device *phy)
while (i--) while (i--)
phy_led_trigger_unregister(&phy->phy_led_triggers[i]); phy_led_trigger_unregister(&phy->phy_led_triggers[i]);
devm_kfree(&phy->mdio.dev, phy->phy_led_triggers); devm_kfree(&phy->mdio.dev, phy->phy_led_triggers);
out_unreg_link:
phy_led_trigger_unregister(phy->led_link_trigger);
out_free_link:
devm_kfree(&phy->mdio.dev, phy->led_link_trigger);
phy->led_link_trigger = NULL;
out_clear: out_clear:
phy->phy_num_led_triggers = 0; phy->phy_num_led_triggers = 0;
return err; return err;
...@@ -135,5 +169,8 @@ void phy_led_triggers_unregister(struct phy_device *phy) ...@@ -135,5 +169,8 @@ void phy_led_triggers_unregister(struct phy_device *phy)
for (i = 0; i < phy->phy_num_led_triggers; i++) for (i = 0; i < phy->phy_num_led_triggers; i++)
phy_led_trigger_unregister(&phy->phy_led_triggers[i]); phy_led_trigger_unregister(&phy->phy_led_triggers[i]);
if (phy->led_link_trigger)
phy_led_trigger_unregister(phy->led_link_trigger);
} }
EXPORT_SYMBOL_GPL(phy_led_triggers_unregister); EXPORT_SYMBOL_GPL(phy_led_triggers_unregister);
...@@ -451,6 +451,8 @@ struct phy_device { ...@@ -451,6 +451,8 @@ struct phy_device {
struct phy_led_trigger *phy_led_triggers; struct phy_led_trigger *phy_led_triggers;
unsigned int phy_num_led_triggers; unsigned int phy_num_led_triggers;
struct phy_led_trigger *last_triggered; struct phy_led_trigger *last_triggered;
struct phy_led_trigger *led_link_trigger;
#endif #endif
/* /*
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment