void b43_leds_init(struct b43_wldev *dev) { struct b43_led *led; unsigned int i; enum b43_led_behaviour behaviour; bool activelow; /* Sync the RF-kill LED state (if we have one) with radio and switch states. */ led = &dev->wl->leds.led_radio; if (led->wl) { if (dev->phy.radio_on && b43_is_hw_radio_enabled(dev)) { b43_led_turn_on(dev, led->index, led->activelow); led->hw_state = 1; atomic_set(&led->state, 1); } else { b43_led_turn_off(dev, led->index, led->activelow); led->hw_state = 0; atomic_set(&led->state, 0); } } /* Initialize TX/RX/ASSOC leds */ led = &dev->wl->leds.led_tx; if (led->wl) { b43_led_turn_off(dev, led->index, led->activelow); led->hw_state = 0; atomic_set(&led->state, 0); } led = &dev->wl->leds.led_rx; if (led->wl) { b43_led_turn_off(dev, led->index, led->activelow); led->hw_state = 0; atomic_set(&led->state, 0); } led = &dev->wl->leds.led_assoc; if (led->wl) { b43_led_turn_off(dev, led->index, led->activelow); led->hw_state = 0; atomic_set(&led->state, 0); } /* Initialize other LED states. */ for (i = 0; i < B43_MAX_NR_LEDS; i++) { b43_led_get_sprominfo(dev, i, &behaviour, &activelow); switch (behaviour) { case B43_LED_OFF: b43_led_turn_off(dev, i, activelow); break; case B43_LED_ON: b43_led_turn_on(dev, i, activelow); break; default: /* Leave others as-is. */ break; } } dev->wl->leds.stop = 0; }
void b43_leds_exit(struct b43_wldev *dev) { struct b43_leds *leds = &dev->wl->leds; b43_led_turn_off(dev, leds->led_tx.index, leds->led_tx.activelow); b43_led_turn_off(dev, leds->led_rx.index, leds->led_rx.activelow); b43_led_turn_off(dev, leds->led_assoc.index, leds->led_assoc.activelow); b43_led_turn_off(dev, leds->led_radio.index, leds->led_radio.activelow); }
static void b43_led_update(struct b43_wldev *dev, struct b43_led *led) { bool radio_enabled; bool turn_on; if (!led->wl) return; radio_enabled = (dev->phy.radio_on && dev->radio_hw_enable); /* The led->state read is racy, but we don't care. In case we raced * with the brightness_set handler, we will be called again soon * to fixup our state. */ if (radio_enabled) turn_on = atomic_read(&led->state) != LED_OFF; else turn_on = 0; if (turn_on == led->hw_state) return; led->hw_state = turn_on; if (turn_on) b43_led_turn_on(dev, led->index, led->activelow); else b43_led_turn_off(dev, led->index, led->activelow); }
static int b43_register_led(struct b43_wldev *dev, struct b43_led *led, const char *name, char *default_trigger, u8 led_index, bool activelow) { int err; b43_led_turn_off(dev, led_index, activelow); if (led->dev) return -EEXIST; if (!default_trigger) return -EINVAL; led->dev = dev; led->index = led_index; led->activelow = activelow; strncpy(led->name, name, sizeof(led->name)); led->led_dev.name = led->name; led->led_dev.default_trigger = default_trigger; led->led_dev.brightness_set = b43_led_brightness_set; err = led_classdev_register(dev->dev->dev, &led->led_dev); if (err) { b43warn(dev->wl, "LEDs: Failed to register %s\n", name); led->dev = NULL; return err; } return 0; }
static void b43_map_led(struct b43_wldev *dev, u8 led_index, enum b43_led_behaviour behaviour, bool activelow) { struct ieee80211_hw *hw = dev->wl->hw; char name[B43_LED_MAX_NAME_LEN + 1]; /* Map the b43 specific LED behaviour value to the * generic LED triggers. */ switch (behaviour) { case B43_LED_INACTIVE: break; case B43_LED_OFF: b43_led_turn_off(dev, led_index, activelow); break; case B43_LED_ON: b43_led_turn_on(dev, led_index, activelow); break; case B43_LED_ACTIVITY: case B43_LED_TRANSFER: case B43_LED_APTRANSFER: snprintf(name, sizeof(name), "b43-%s::tx", wiphy_name(hw->wiphy)); b43_register_led(dev, &dev->led_tx, name, ieee80211_get_tx_led_name(hw), led_index, activelow); snprintf(name, sizeof(name), "b43-%s::rx", wiphy_name(hw->wiphy)); b43_register_led(dev, &dev->led_rx, name, ieee80211_get_rx_led_name(hw), led_index, activelow); break; case B43_LED_RADIO_ALL: case B43_LED_RADIO_A: case B43_LED_RADIO_B: case B43_LED_MODE_BG: snprintf(name, sizeof(name), "b43-%s::radio", wiphy_name(hw->wiphy)); b43_register_led(dev, &dev->led_radio, name, b43_rfkill_led_name(dev), led_index, activelow); /* Sync the RF-kill LED state with the switch state. */ if (dev->radio_hw_enable) b43_led_turn_on(dev, led_index, activelow); break; case B43_LED_WEIRD: case B43_LED_ASSOC: snprintf(name, sizeof(name), "b43-%s::assoc", wiphy_name(hw->wiphy)); b43_register_led(dev, &dev->led_assoc, name, ieee80211_get_assoc_led_name(hw), led_index, activelow); break; default: b43warn(dev->wl, "LEDs: Unknown behaviour 0x%02X\n", behaviour); break; } }
static void b43_unregister_led(struct b43_led *led) { if (!led->dev) return; led_classdev_unregister(&led->led_dev); b43_led_turn_off(led->dev, led->index, led->activelow); led->dev = NULL; }
/* Callback from the LED subsystem. */ static void b43_led_brightness_set(struct led_classdev *led_dev, enum led_brightness brightness) { struct b43_led *led = container_of(led_dev, struct b43_led, led_dev); struct b43_wldev *dev = led->dev; bool radio_enabled; if (unlikely(b43_status(dev) < B43_STAT_INITIALIZED)) return; /* Checking the radio-enabled status here is slightly racy, * but we want to avoid the locking overhead and we don't care * whether the LED has the wrong state for a second. */ radio_enabled = (dev->phy.radio_on && dev->radio_hw_enable); if (brightness == LED_OFF || !radio_enabled) b43_led_turn_off(dev, led->index, led->activelow); else b43_led_turn_on(dev, led->index, led->activelow); }