2 * Common code for mac80211 Prism54 drivers
4 * Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
5 * Copyright (c) 2007-2009, Christian Lamparter <chunkeey@web.de>
6 * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
9 * - the islsm (softmac prism54) driver, which is:
10 * Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
12 * Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies).
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License version 2 as
16 * published by the Free Software Foundation.
19 #include <linux/init.h>
20 #include <linux/firmware.h>
21 #include <linux/etherdevice.h>
23 #include <net/mac80211.h>
24 #ifdef CONFIG_P54_LEDS
25 #include <linux/leds.h>
26 #endif /* CONFIG_P54_LEDS */
31 static void p54_update_leds(struct work_struct
*work
)
33 struct p54_common
*priv
= container_of(work
, struct p54_common
,
35 int err
, i
, tmp
, blink_delay
= 400;
38 /* Don't toggle the LED, when the device is down. */
39 if (priv
->mode
== NL80211_IFTYPE_UNSPECIFIED
)
42 for (i
= 0; i
< ARRAY_SIZE(priv
->leds
); i
++)
43 if (priv
->leds
[i
].toggled
) {
44 priv
->softled_state
|= BIT(i
);
46 tmp
= 70 + 200 / (priv
->leds
[i
].toggled
);
47 if (tmp
< blink_delay
)
50 if (priv
->leds
[i
].led_dev
.brightness
== LED_OFF
)
53 priv
->leds
[i
].toggled
=
54 !!priv
->leds
[i
].led_dev
.brightness
;
56 priv
->softled_state
&= ~BIT(i
);
58 err
= p54_set_leds(priv
);
59 if (err
&& net_ratelimit())
60 printk(KERN_ERR
"%s: failed to update LEDs (%d).\n",
61 wiphy_name(priv
->hw
->wiphy
), err
);
64 queue_delayed_work(priv
->hw
->workqueue
, &priv
->led_work
,
65 msecs_to_jiffies(blink_delay
));
68 static void p54_led_brightness_set(struct led_classdev
*led_dev
,
69 enum led_brightness brightness
)
71 struct p54_led_dev
*led
= container_of(led_dev
, struct p54_led_dev
,
73 struct ieee80211_hw
*dev
= led
->hw_dev
;
74 struct p54_common
*priv
= dev
->priv
;
76 if (priv
->mode
== NL80211_IFTYPE_UNSPECIFIED
)
79 if ((brightness
) && (led
->registered
)) {
81 queue_delayed_work(priv
->hw
->workqueue
, &priv
->led_work
,
86 static int p54_register_led(struct p54_common
*priv
,
87 unsigned int led_index
,
88 char *name
, char *trigger
)
90 struct p54_led_dev
*led
= &priv
->leds
[led_index
];
96 snprintf(led
->name
, sizeof(led
->name
), "p54-%s::%s",
97 wiphy_name(priv
->hw
->wiphy
), name
);
98 led
->hw_dev
= priv
->hw
;
99 led
->index
= led_index
;
100 led
->led_dev
.name
= led
->name
;
101 led
->led_dev
.default_trigger
= trigger
;
102 led
->led_dev
.brightness_set
= p54_led_brightness_set
;
104 err
= led_classdev_register(wiphy_dev(priv
->hw
->wiphy
), &led
->led_dev
);
106 printk(KERN_ERR
"%s: Failed to register %s LED.\n",
107 wiphy_name(priv
->hw
->wiphy
), name
);
114 int p54_init_leds(struct p54_common
*priv
)
120 * Figure out if the EEPROM contains some hints about the number
121 * of available/programmable LEDs of the device.
124 INIT_DELAYED_WORK(&priv
->led_work
, p54_update_leds
);
126 err
= p54_register_led(priv
, 0, "assoc",
127 ieee80211_get_assoc_led_name(priv
->hw
));
131 err
= p54_register_led(priv
, 1, "tx",
132 ieee80211_get_tx_led_name(priv
->hw
));
136 err
= p54_register_led(priv
, 2, "rx",
137 ieee80211_get_rx_led_name(priv
->hw
));
141 err
= p54_register_led(priv
, 3, "radio",
142 ieee80211_get_radio_led_name(priv
->hw
));
146 err
= p54_set_leds(priv
);
150 void p54_unregister_leds(struct p54_common
*priv
)
154 for (i
= 0; i
< ARRAY_SIZE(priv
->leds
); i
++) {
155 if (priv
->leds
[i
].registered
) {
156 priv
->leds
[i
].registered
= false;
157 priv
->leds
[i
].toggled
= 0;
158 led_classdev_unregister(&priv
->leds
[i
].led_dev
);
162 cancel_delayed_work_sync(&priv
->led_work
);