1/*
2 * Common code for mac80211 Prism54 drivers
3 *
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>
7 *
8 * Based on:
9 * - the islsm (softmac prism54) driver, which is:
10 *   Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
11 * - stlc45xx driver
12 *   Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies).
13 *
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.
17 */
18
19#include <linux/firmware.h>
20#include <linux/etherdevice.h>
21
22#include <net/mac80211.h>
23#ifdef CONFIG_P54_LEDS
24#include <linux/leds.h>
25#endif /* CONFIG_P54_LEDS */
26
27#include "p54.h"
28#include "lmac.h"
29
30static void p54_update_leds(struct work_struct *work)
31{
32	struct p54_common *priv = container_of(work, struct p54_common,
33					       led_work.work);
34	int err, i, tmp, blink_delay = 400;
35	bool rerun = false;
36
37	/* Don't toggle the LED, when the device is down. */
38	if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
39		return ;
40
41	for (i = 0; i < ARRAY_SIZE(priv->leds); i++)
42		if (priv->leds[i].toggled) {
43			priv->softled_state |= BIT(i);
44
45			tmp = 70 + 200 / (priv->leds[i].toggled);
46			if (tmp < blink_delay)
47				blink_delay = tmp;
48
49			if (priv->leds[i].led_dev.brightness == LED_OFF)
50				rerun = true;
51
52			priv->leds[i].toggled =
53				!!priv->leds[i].led_dev.brightness;
54		} else
55			priv->softled_state &= ~BIT(i);
56
57	err = p54_set_leds(priv);
58	if (err && net_ratelimit())
59		wiphy_err(priv->hw->wiphy,
60			  "failed to update LEDs (%d).\n", err);
61
62	if (rerun)
63		ieee80211_queue_delayed_work(priv->hw, &priv->led_work,
64			msecs_to_jiffies(blink_delay));
65}
66
67static void p54_led_brightness_set(struct led_classdev *led_dev,
68				   enum led_brightness brightness)
69{
70	struct p54_led_dev *led = container_of(led_dev, struct p54_led_dev,
71					       led_dev);
72	struct ieee80211_hw *dev = led->hw_dev;
73	struct p54_common *priv = dev->priv;
74
75	if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
76		return ;
77
78	if ((brightness) && (led->registered)) {
79		led->toggled++;
80		ieee80211_queue_delayed_work(priv->hw, &priv->led_work, HZ/10);
81	}
82}
83
84static int p54_register_led(struct p54_common *priv,
85			    unsigned int led_index,
86			    char *name, char *trigger)
87{
88	struct p54_led_dev *led = &priv->leds[led_index];
89	int err;
90
91	if (led->registered)
92		return -EEXIST;
93
94	snprintf(led->name, sizeof(led->name), "p54-%s::%s",
95		 wiphy_name(priv->hw->wiphy), name);
96	led->hw_dev = priv->hw;
97	led->index = led_index;
98	led->led_dev.name = led->name;
99	led->led_dev.default_trigger = trigger;
100	led->led_dev.brightness_set = p54_led_brightness_set;
101
102	err = led_classdev_register(wiphy_dev(priv->hw->wiphy), &led->led_dev);
103	if (err)
104		wiphy_err(priv->hw->wiphy,
105			  "Failed to register %s LED.\n", name);
106	else
107		led->registered = 1;
108
109	return err;
110}
111
112int p54_init_leds(struct p54_common *priv)
113{
114	int err;
115
116	/*
117	 * TODO:
118	 * Figure out if the EEPROM contains some hints about the number
119	 * of available/programmable LEDs of the device.
120	 */
121
122	INIT_DELAYED_WORK(&priv->led_work, p54_update_leds);
123
124	err = p54_register_led(priv, 0, "assoc",
125			       ieee80211_get_assoc_led_name(priv->hw));
126	if (err)
127		return err;
128
129	err = p54_register_led(priv, 1, "tx",
130			       ieee80211_get_tx_led_name(priv->hw));
131	if (err)
132		return err;
133
134	err = p54_register_led(priv, 2, "rx",
135			       ieee80211_get_rx_led_name(priv->hw));
136	if (err)
137		return err;
138
139	err = p54_register_led(priv, 3, "radio",
140			       ieee80211_get_radio_led_name(priv->hw));
141	if (err)
142		return err;
143
144	err = p54_set_leds(priv);
145	return err;
146}
147
148void p54_unregister_leds(struct p54_common *priv)
149{
150	int i;
151
152	for (i = 0; i < ARRAY_SIZE(priv->leds); i++) {
153		if (priv->leds[i].registered) {
154			priv->leds[i].registered = false;
155			priv->leds[i].toggled = 0;
156			led_classdev_unregister(&priv->leds[i].led_dev);
157		}
158	}
159
160	cancel_delayed_work_sync(&priv->led_work);
161}
162