intersil/p54/led.c

29 	struct p54_common *priv = container_of(work, struct p54_common,
35 	if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
38 	for (i = 0; i < ARRAY_SIZE(priv->leds); i++)
39 		if (priv->leds[i].toggled) {
40 			priv->softled_state |= BIT(i);
42 			tmp = 70 + 200 / (priv->leds[i].toggled);
46 			if (priv->leds[i].led_dev.brightness == LED_OFF)
49 			priv->leds[i].toggled =
50 				!!priv->leds[i].led_dev.brightness;
52 			priv->softled_state &= ~BIT(i);
54 	err = p54_set_leds(priv);
56 		wiphy_err(priv->hw->wiphy,
60 		ieee80211_queue_delayed_work(priv->hw, &priv->led_work,
70 	struct p54_common *priv = dev->priv;
72 	if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
77 		ieee80211_queue_delayed_work(priv->hw, &priv->led_work, HZ/10);
81 static int p54_register_led(struct p54_common *priv,
85 	struct p54_led_dev *led = &priv->leds[led_index];
92 		 wiphy_name(priv->hw->wiphy), name);
93 	led->hw_dev = priv->hw;
99 	err = led_classdev_register(wiphy_dev(priv->hw->wiphy), &led->led_dev);
101 		wiphy_err(priv->hw->wiphy,
109 int p54_init_leds(struct p54_common *priv)
119 	INIT_DELAYED_WORK(&priv->led_work, p54_update_leds);
121 	err = p54_register_led(priv, 0, "assoc",
122 			       ieee80211_get_assoc_led_name(priv->hw));
126 	err = p54_register_led(priv, 1, "tx",
127 			       ieee80211_get_tx_led_name(priv->hw));
131 	err = p54_register_led(priv, 2, "rx",
132 			       ieee80211_get_rx_led_name(priv->hw));
136 	err = p54_register_led(priv, 3, "radio",
137 			       ieee80211_get_radio_led_name(priv->hw));
141 	err = p54_set_leds(priv);
145 void p54_unregister_leds(struct p54_common *priv)
149 	for (i = 0; i < ARRAY_SIZE(priv->leds); i++) {
150 		if (priv->leds[i].registered) {
151 			priv->leds[i].registered = false;
152 			priv->leds[i].toggled = 0;
153 			led_classdev_unregister(&priv->leds[i].led_dev);
157 	cancel_delayed_work_sync(&priv->led_work);