Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2008 Pavel Machek <pavel@suse.cz> |
| 3 | * |
| 4 | * Distribute under GPLv2. |
Pekka Enberg | 7c49a0a | 2009-04-08 11:14:05 +0300 | [diff] [blame] | 5 | * |
| 6 | * The original driver was written by: |
| 7 | * Jeff Lee <YY_Lee@issc.com.tw> |
| 8 | * |
| 9 | * and was adapted to the 2.6 kernel by: |
| 10 | * Costantino Leandro (Rxart Desktop) <le_costantino@pixartargentina.com.ar> |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 11 | */ |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 12 | #include <net/mac80211.h> |
Pekka Enberg | 80aba53 | 2008-10-30 13:04:29 +0200 | [diff] [blame] | 13 | #include <linux/usb.h> |
| 14 | |
Pekka Enberg | cc18071 | 2008-10-30 16:14:35 +0200 | [diff] [blame] | 15 | #include "core.h" |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 16 | #include "mds_f.h" |
Pekka Enberg | 9ce922f | 2008-10-30 13:05:42 +0200 | [diff] [blame] | 17 | #include "mlmetxrx_f.h" |
Pekka Enberg | 64328c8 | 2009-01-07 17:33:45 +0200 | [diff] [blame] | 18 | #include "mto.h" |
Pekka Enberg | 9ce922f | 2008-10-30 13:05:42 +0200 | [diff] [blame] | 19 | #include "wbhal_f.h" |
| 20 | #include "wblinux_f.h" |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 21 | |
Pekka Enberg | 7b9a79b | 2008-10-30 18:12:01 +0200 | [diff] [blame] | 22 | MODULE_DESCRIPTION("IS89C35 802.11bg WLAN USB Driver"); |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 23 | MODULE_LICENSE("GPL"); |
| 24 | MODULE_VERSION("0.1"); |
| 25 | |
Németh Márton | a457732 | 2010-01-10 00:18:34 +0100 | [diff] [blame] | 26 | static const struct usb_device_id wb35_table[] __devinitconst = { |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 27 | { USB_DEVICE(0x0416, 0x0035) }, |
| 28 | { USB_DEVICE(0x18E8, 0x6201) }, |
| 29 | { USB_DEVICE(0x18E8, 0x6206) }, |
| 30 | { USB_DEVICE(0x18E8, 0x6217) }, |
| 31 | { USB_DEVICE(0x18E8, 0x6230) }, |
| 32 | { USB_DEVICE(0x18E8, 0x6233) }, |
| 33 | { USB_DEVICE(0x1131, 0x2035) }, |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 34 | { 0, } |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 35 | }; |
| 36 | |
Pekka Enberg | dd38da4 | 2008-10-21 13:01:42 +0300 | [diff] [blame] | 37 | MODULE_DEVICE_TABLE(usb, wb35_table); |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 38 | |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 39 | static struct ieee80211_rate wbsoft_rates[] = { |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 40 | { .bitrate = 10, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, |
| 41 | }; |
| 42 | |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 43 | static struct ieee80211_channel wbsoft_channels[] = { |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 44 | { .center_freq = 2412 }, |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 45 | }; |
| 46 | |
Pekka Enberg | a36e089 | 2008-10-28 00:20:03 +0200 | [diff] [blame] | 47 | static struct ieee80211_supported_band wbsoft_band_2GHz = { |
| 48 | .channels = wbsoft_channels, |
| 49 | .n_channels = ARRAY_SIZE(wbsoft_channels), |
| 50 | .bitrates = wbsoft_rates, |
| 51 | .n_bitrates = ARRAY_SIZE(wbsoft_rates), |
| 52 | }; |
| 53 | |
Pekka Enberg | 4074e77 | 2009-09-21 12:52:15 +0300 | [diff] [blame] | 54 | static void hal_set_beacon_period(struct hw_data *pHwData, u16 beacon_period) |
| 55 | { |
| 56 | u32 tmp; |
| 57 | |
| 58 | if (pHwData->SurpriseRemove) |
| 59 | return; |
| 60 | |
| 61 | pHwData->BeaconPeriod = beacon_period; |
| 62 | tmp = pHwData->BeaconPeriod << 16; |
| 63 | tmp |= pHwData->ProbeDelay; |
| 64 | Wb35Reg_Write(pHwData, 0x0848, tmp); |
| 65 | } |
| 66 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 67 | static int wbsoft_add_interface(struct ieee80211_hw *dev, |
Greg Kroah-Hartman | a71b676 | 2010-03-04 08:44:13 -0800 | [diff] [blame] | 68 | struct ieee80211_vif *vif) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 69 | { |
Pekka Enberg | 4074e77 | 2009-09-21 12:52:15 +0300 | [diff] [blame] | 70 | struct wbsoft_priv *priv = dev->priv; |
| 71 | |
Greg Kroah-Hartman | a71b676 | 2010-03-04 08:44:13 -0800 | [diff] [blame] | 72 | hal_set_beacon_period(&priv->sHwData, vif->bss_conf.beacon_int); |
Pekka Enberg | 4074e77 | 2009-09-21 12:52:15 +0300 | [diff] [blame] | 73 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 74 | return 0; |
| 75 | } |
| 76 | |
| 77 | static void wbsoft_remove_interface(struct ieee80211_hw *dev, |
Greg Kroah-Hartman | a71b676 | 2010-03-04 08:44:13 -0800 | [diff] [blame] | 78 | struct ieee80211_vif *vif) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 79 | { |
| 80 | printk("wbsoft_remove interface called\n"); |
| 81 | } |
| 82 | |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 83 | static void wbsoft_stop(struct ieee80211_hw *hw) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 84 | { |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 85 | printk(KERN_INFO "%s called\n", __func__); |
| 86 | } |
| 87 | |
| 88 | static int wbsoft_get_stats(struct ieee80211_hw *hw, |
| 89 | struct ieee80211_low_level_stats *stats) |
| 90 | { |
| 91 | printk(KERN_INFO "%s called\n", __func__); |
| 92 | return 0; |
| 93 | } |
| 94 | |
Jeff Mahoney | 6d7fd64 | 2009-10-08 17:27:51 -0400 | [diff] [blame] | 95 | static u64 wbsoft_prepare_multicast(struct ieee80211_hw *hw, int mc_count, |
| 96 | struct dev_addr_list *mc_list) |
| 97 | { |
| 98 | return mc_count; |
| 99 | } |
| 100 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 101 | static void wbsoft_configure_filter(struct ieee80211_hw *dev, |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 102 | unsigned int changed_flags, |
| 103 | unsigned int *total_flags, |
Jeff Mahoney | 6d7fd64 | 2009-10-08 17:27:51 -0400 | [diff] [blame] | 104 | u64 multicast) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 105 | { |
Pekka Enberg | 6ab3212 | 2009-03-27 19:46:45 +0200 | [diff] [blame] | 106 | unsigned int new_flags; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 107 | |
| 108 | new_flags = 0; |
| 109 | |
Pekka Enberg | 6ab3212 | 2009-03-27 19:46:45 +0200 | [diff] [blame] | 110 | if (*total_flags & FIF_PROMISC_IN_BSS) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 111 | new_flags |= FIF_PROMISC_IN_BSS; |
Jeff Mahoney | 6d7fd64 | 2009-10-08 17:27:51 -0400 | [diff] [blame] | 112 | else if ((*total_flags & FIF_ALLMULTI) || (multicast > 32)) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 113 | new_flags |= FIF_ALLMULTI; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 114 | |
| 115 | dev->flags &= ~IEEE80211_HW_RX_INCLUDES_FCS; |
| 116 | |
| 117 | *total_flags = new_flags; |
| 118 | } |
| 119 | |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 120 | static int wbsoft_tx(struct ieee80211_hw *dev, struct sk_buff *skb) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 121 | { |
Pekka Enberg | cc18071 | 2008-10-30 16:14:35 +0200 | [diff] [blame] | 122 | struct wbsoft_priv *priv = dev->priv; |
| 123 | |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 124 | MLMESendFrame(priv, skb->data, skb->len, FRAME_TYPE_802_11_MANAGEMENT); |
Pekka Enberg | 16d3659 | 2008-10-28 00:14:38 +0200 | [diff] [blame] | 125 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 126 | return NETDEV_TX_OK; |
| 127 | } |
| 128 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 129 | static int wbsoft_start(struct ieee80211_hw *dev) |
| 130 | { |
Pekka Enberg | c930e0c0 | 2008-10-30 18:12:04 +0200 | [diff] [blame] | 131 | struct wbsoft_priv *priv = dev->priv; |
| 132 | |
| 133 | priv->enabled = true; |
| 134 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 135 | return 0; |
| 136 | } |
| 137 | |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 138 | static void hal_set_radio_mode(struct hw_data *pHwData, unsigned char radio_off) |
| 139 | { |
| 140 | struct wb35_reg *reg = &pHwData->reg; |
| 141 | |
| 142 | if (pHwData->SurpriseRemove) |
| 143 | return; |
| 144 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 145 | if (radio_off) { /* disable Baseband receive off */ |
| 146 | pHwData->CurrentRadioSw = 1; /* off */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 147 | reg->M24_MacControl &= 0xffffffbf; |
| 148 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 149 | pHwData->CurrentRadioSw = 0; /* on */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 150 | reg->M24_MacControl |= 0x00000040; |
| 151 | } |
| 152 | Wb35Reg_Write(pHwData, 0x0824, reg->M24_MacControl); |
| 153 | } |
| 154 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 155 | static void hal_set_current_channel_ex(struct hw_data *pHwData, struct chan_info channel) |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 156 | { |
| 157 | struct wb35_reg *reg = &pHwData->reg; |
| 158 | |
| 159 | if (pHwData->SurpriseRemove) |
| 160 | return; |
| 161 | |
| 162 | printk("Going to channel: %d/%d\n", channel.band, channel.ChanNo); |
| 163 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 164 | RFSynthesizer_SwitchingChannel(pHwData, channel); /* Switch channel */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 165 | pHwData->Channel = channel.ChanNo; |
| 166 | pHwData->band = channel.band; |
| 167 | #ifdef _PE_STATE_DUMP_ |
| 168 | printk("Set channel is %d, band =%d\n", pHwData->Channel, |
| 169 | pHwData->band); |
| 170 | #endif |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 171 | reg->M28_MacControl &= ~0xff; /* Clean channel information field */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 172 | reg->M28_MacControl |= channel.ChanNo; |
| 173 | Wb35Reg_WriteWithCallbackValue(pHwData, 0x0828, reg->M28_MacControl, |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 174 | (s8 *) &channel, |
| 175 | sizeof(struct chan_info)); |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 176 | } |
| 177 | |
Pekka Enberg | 440a233 | 2009-12-18 23:08:18 +0200 | [diff] [blame] | 178 | static void hal_set_current_channel(struct hw_data *pHwData, struct chan_info channel) |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 179 | { |
| 180 | hal_set_current_channel_ex(pHwData, channel); |
| 181 | } |
| 182 | |
| 183 | static void hal_set_accept_broadcast(struct hw_data *pHwData, u8 enable) |
| 184 | { |
| 185 | struct wb35_reg *reg = &pHwData->reg; |
| 186 | |
| 187 | if (pHwData->SurpriseRemove) |
| 188 | return; |
| 189 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 190 | reg->M00_MacControl &= ~0x02000000; /* The HW value */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 191 | |
| 192 | if (enable) |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 193 | reg->M00_MacControl |= 0x02000000; /* The HW value */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 194 | |
| 195 | Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl); |
| 196 | } |
| 197 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 198 | /* For wep key error detection, we need to accept broadcast packets to be received temporary. */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 199 | static void hal_set_accept_promiscuous(struct hw_data *pHwData, u8 enable) |
| 200 | { |
| 201 | struct wb35_reg *reg = &pHwData->reg; |
| 202 | |
| 203 | if (pHwData->SurpriseRemove) |
| 204 | return; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 205 | |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 206 | if (enable) { |
| 207 | reg->M00_MacControl |= 0x00400000; |
| 208 | Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl); |
| 209 | } else { |
| 210 | reg->M00_MacControl &= ~0x00400000; |
| 211 | Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl); |
| 212 | } |
| 213 | } |
| 214 | |
| 215 | static void hal_set_accept_multicast(struct hw_data *pHwData, u8 enable) |
| 216 | { |
| 217 | struct wb35_reg *reg = &pHwData->reg; |
| 218 | |
| 219 | if (pHwData->SurpriseRemove) |
| 220 | return; |
| 221 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 222 | reg->M00_MacControl &= ~0x01000000; /* The HW value */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 223 | if (enable) |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 224 | reg->M00_MacControl |= 0x01000000; /* The HW value */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 225 | Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl); |
| 226 | } |
| 227 | |
| 228 | static void hal_set_accept_beacon(struct hw_data *pHwData, u8 enable) |
| 229 | { |
| 230 | struct wb35_reg *reg = &pHwData->reg; |
| 231 | |
| 232 | if (pHwData->SurpriseRemove) |
| 233 | return; |
| 234 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 235 | if (!enable) /* Due to SME and MLME are not suitable for 35 */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 236 | return; |
| 237 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 238 | reg->M00_MacControl &= ~0x04000000; /* The HW value */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 239 | if (enable) |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 240 | reg->M00_MacControl |= 0x04000000; /* The HW value */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 241 | |
| 242 | Wb35Reg_Write(pHwData, 0x0800, reg->M00_MacControl); |
| 243 | } |
| 244 | |
Greg Kroah-Hartman | f02466f | 2009-01-05 10:46:00 -0800 | [diff] [blame] | 245 | static int wbsoft_config(struct ieee80211_hw *dev, u32 changed) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 246 | { |
Pekka Enberg | cc18071 | 2008-10-30 16:14:35 +0200 | [diff] [blame] | 247 | struct wbsoft_priv *priv = dev->priv; |
Pekka Enberg | 440a233 | 2009-12-18 23:08:18 +0200 | [diff] [blame] | 248 | struct chan_info ch; |
Greg Kroah-Hartman | f02466f | 2009-01-05 10:46:00 -0800 | [diff] [blame] | 249 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 250 | printk("wbsoft_config called\n"); |
| 251 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 252 | /* Should use channel_num, or something, as that is already pre-translated */ |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 253 | ch.band = 1; |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 254 | ch.ChanNo = 1; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 255 | |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 256 | hal_set_current_channel(&priv->sHwData, ch); |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 257 | hal_set_accept_broadcast(&priv->sHwData, 1); |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 258 | hal_set_accept_promiscuous(&priv->sHwData, 1); |
| 259 | hal_set_accept_multicast(&priv->sHwData, 1); |
| 260 | hal_set_accept_beacon(&priv->sHwData, 1); |
| 261 | hal_set_radio_mode(&priv->sHwData, 0); |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 262 | |
| 263 | return 0; |
| 264 | } |
| 265 | |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 266 | static u64 wbsoft_get_tsf(struct ieee80211_hw *dev) |
| 267 | { |
| 268 | printk("wbsoft_get_tsf called\n"); |
| 269 | return 0; |
| 270 | } |
| 271 | |
| 272 | static const struct ieee80211_ops wbsoft_ops = { |
| 273 | .tx = wbsoft_tx, |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 274 | .start = wbsoft_start, |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 275 | .stop = wbsoft_stop, |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 276 | .add_interface = wbsoft_add_interface, |
| 277 | .remove_interface = wbsoft_remove_interface, |
| 278 | .config = wbsoft_config, |
Jeff Mahoney | 6d7fd64 | 2009-10-08 17:27:51 -0400 | [diff] [blame] | 279 | .prepare_multicast = wbsoft_prepare_multicast, |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 280 | .configure_filter = wbsoft_configure_filter, |
Greg Kroah-Hartman | 68ab0c9 | 2008-10-21 10:41:45 -0700 | [diff] [blame] | 281 | .get_stats = wbsoft_get_stats, |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 282 | .get_tsf = wbsoft_get_tsf, |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 283 | }; |
| 284 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 285 | static void hal_set_ethernet_address(struct hw_data *pHwData, u8 *current_address) |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 286 | { |
| 287 | u32 ltmp[2]; |
| 288 | |
| 289 | if (pHwData->SurpriseRemove) |
| 290 | return; |
| 291 | |
| 292 | memcpy(pHwData->CurrentMacAddress, current_address, ETH_ALEN); |
| 293 | |
| 294 | ltmp[0] = cpu_to_le32(*(u32 *) pHwData->CurrentMacAddress); |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 295 | ltmp[1] = cpu_to_le32(*(u32 *) (pHwData->CurrentMacAddress + 4)) & 0xffff; |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 296 | |
| 297 | Wb35Reg_BurstWrite(pHwData, 0x03e8, ltmp, 2, AUTO_INCREMENT); |
| 298 | } |
| 299 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 300 | static void hal_get_permanent_address(struct hw_data *pHwData, u8 *pethernet_address) |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 301 | { |
| 302 | if (pHwData->SurpriseRemove) |
| 303 | return; |
| 304 | |
| 305 | memcpy(pethernet_address, pHwData->PermanentMacAddress, 6); |
| 306 | } |
| 307 | |
| 308 | static void hal_stop(struct hw_data *pHwData) |
| 309 | { |
| 310 | struct wb35_reg *reg = &pHwData->reg; |
| 311 | |
| 312 | pHwData->Wb35Rx.rx_halt = 1; |
| 313 | Wb35Rx_stop(pHwData); |
| 314 | |
| 315 | pHwData->Wb35Tx.tx_halt = 1; |
| 316 | Wb35Tx_stop(pHwData); |
| 317 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 318 | reg->D00_DmaControl &= ~0xc0000000; /* Tx Off, Rx Off */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 319 | Wb35Reg_Write(pHwData, 0x0400, reg->D00_DmaControl); |
| 320 | } |
| 321 | |
| 322 | static unsigned char hal_idle(struct hw_data *pHwData) |
| 323 | { |
| 324 | struct wb35_reg *reg = &pHwData->reg; |
| 325 | struct wb_usb *pWbUsb = &pHwData->WbUsb; |
| 326 | |
| 327 | if (!pHwData->SurpriseRemove |
| 328 | && (pWbUsb->DetectCount || reg->EP0vm_state != VM_STOP)) |
| 329 | return false; |
| 330 | |
| 331 | return true; |
| 332 | } |
| 333 | |
| 334 | u8 hal_get_antenna_number(struct hw_data *pHwData) |
| 335 | { |
| 336 | struct wb35_reg *reg = &pHwData->reg; |
| 337 | |
| 338 | if ((reg->BB2C & BIT(11)) == 0) |
| 339 | return 0; |
| 340 | else |
| 341 | return 1; |
| 342 | } |
| 343 | |
| 344 | /* 0 : radio on; 1: radio off */ |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 345 | static u8 hal_get_hw_radio_off(struct hw_data *pHwData) |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 346 | { |
| 347 | struct wb35_reg *reg = &pHwData->reg; |
| 348 | |
| 349 | if (pHwData->SurpriseRemove) |
| 350 | return 1; |
| 351 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 352 | /* read the bit16 of register U1B0 */ |
Pekka Enberg | 22a82bc | 2009-04-08 11:51:20 +0300 | [diff] [blame] | 353 | Wb35Reg_Read(pHwData, 0x3b0, ®->U1B0); |
| 354 | if ((reg->U1B0 & 0x00010000)) { |
| 355 | pHwData->CurrentRadioHw = 1; |
| 356 | return 1; |
| 357 | } else { |
| 358 | pHwData->CurrentRadioHw = 0; |
| 359 | return 0; |
| 360 | } |
| 361 | } |
| 362 | |
Pekka Enberg | 833d0cd | 2009-04-08 11:14:06 +0300 | [diff] [blame] | 363 | static u8 LED_GRAY[20] = { |
| 364 | 0, 3, 4, 6, 8, 10, 11, 12, 13, 14, 15, 14, 13, 12, 11, 10, 8, 6, 4, 2 |
| 365 | }; |
| 366 | |
| 367 | static u8 LED_GRAY2[30] = { |
| 368 | 7, 8, 9, 10, 11, 12, 13, 14, 15, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 369 | 0, 15, 14, 13, 12, 11, 10, 9, 8 |
| 370 | }; |
| 371 | |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 372 | static void hal_led_control(unsigned long data) |
| 373 | { |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 374 | struct wbsoft_priv *adapter = (struct wbsoft_priv *)data; |
| 375 | struct hw_data *pHwData = &adapter->sHwData; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 376 | struct wb35_reg *reg = &pHwData->reg; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 377 | u32 LEDSet = (pHwData->SoftwareSet & HAL_LED_SET_MASK) >> HAL_LED_SET_SHIFT; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 378 | u32 TimeInterval = 500, ltmp, ltmp2; |
| 379 | ltmp = 0; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 380 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 381 | if (pHwData->SurpriseRemove) |
| 382 | return; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 383 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 384 | if (pHwData->LED_control) { |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 385 | ltmp2 = pHwData->LED_control & 0xff; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 386 | if (ltmp2 == 5) { /* 5 is WPS mode */ |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 387 | TimeInterval = 100; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 388 | ltmp2 = (pHwData->LED_control >> 8) & 0xff; |
| 389 | switch (ltmp2) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 390 | case 1: /* [0.2 On][0.1 Off]... */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 391 | pHwData->LED_Blinking %= 3; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 392 | ltmp = 0x1010; /* Led 1 & 0 Green and Red */ |
| 393 | if (pHwData->LED_Blinking == 2) /* Turn off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 394 | ltmp = 0; |
| 395 | break; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 396 | case 2: /* [0.1 On][0.1 Off]... */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 397 | pHwData->LED_Blinking %= 2; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 398 | ltmp = 0x0010; /* Led 0 red color */ |
| 399 | if (pHwData->LED_Blinking) /* Turn off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 400 | ltmp = 0; |
| 401 | break; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 402 | case 3: /* [0.1 On][0.1 Off][0.1 On][0.1 Off][0.1 On][0.1 Off][0.1 On][0.1 Off][0.1 On][0.1 Off][0.5 Off]... */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 403 | pHwData->LED_Blinking %= 15; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 404 | ltmp = 0x0010; /* Led 0 red color */ |
| 405 | if ((pHwData->LED_Blinking >= 9) || (pHwData->LED_Blinking % 2)) /* Turn off 0.6 sec */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 406 | ltmp = 0; |
| 407 | break; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 408 | case 4: /* [300 On][ off ] */ |
| 409 | ltmp = 0x1000; /* Led 1 Green color */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 410 | if (pHwData->LED_Blinking >= 3000) |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 411 | ltmp = 0; /* led maybe on after 300sec * 32bit counter overlap. */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 412 | break; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 413 | } |
| 414 | pHwData->LED_Blinking++; |
| 415 | |
| 416 | reg->U1BC_LEDConfigure = ltmp; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 417 | if (LEDSet != 7) { /* Only 111 mode has 2 LEDs on PCB. */ |
| 418 | reg->U1BC_LEDConfigure |= (ltmp & 0xff) << 8; /* Copy LED result to each LED control register */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 419 | reg->U1BC_LEDConfigure |= (ltmp & 0xff00) >> 8; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 420 | } |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 421 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 422 | } |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 423 | } else if (pHwData->CurrentRadioSw || pHwData->CurrentRadioHw) { /* If radio off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 424 | if (reg->U1BC_LEDConfigure & 0x1010) { |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 425 | reg->U1BC_LEDConfigure &= ~0x1010; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 426 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 427 | } |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 428 | } else { |
| 429 | switch (LEDSet) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 430 | case 4: /* [100] Only 1 Led be placed on PCB and use pin 21 of IC. Use LED_0 for showing */ |
| 431 | if (!pHwData->LED_LinkOn) { /* Blink only if not Link On */ |
| 432 | /* Blinking if scanning is on progress */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 433 | if (pHwData->LED_Scanning) { |
| 434 | if (pHwData->LED_Blinking == 0) { |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 435 | reg->U1BC_LEDConfigure |= 0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 436 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 On */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 437 | pHwData->LED_Blinking = 1; |
| 438 | TimeInterval = 300; |
| 439 | } else { |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 440 | reg->U1BC_LEDConfigure &= ~0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 441 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 442 | pHwData->LED_Blinking = 0; |
| 443 | TimeInterval = 300; |
| 444 | } |
| 445 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 446 | /* Turn Off LED_0 */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 447 | if (reg->U1BC_LEDConfigure & 0x10) { |
| 448 | reg->U1BC_LEDConfigure &= ~0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 449 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 Off */ |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 450 | } |
| 451 | } |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 452 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 453 | /* Turn On LED_0 */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 454 | if ((reg->U1BC_LEDConfigure & 0x10) == 0) { |
| 455 | reg->U1BC_LEDConfigure |= 0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 456 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 457 | } |
| 458 | } |
| 459 | break; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 460 | case 6: /* [110] Only 1 Led be placed on PCB and use pin 21 of IC. Use LED_0 for showing */ |
| 461 | if (!pHwData->LED_LinkOn) { /* Blink only if not Link On */ |
| 462 | /* Blinking if scanning is on progress */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 463 | if (pHwData->LED_Scanning) { |
| 464 | if (pHwData->LED_Blinking == 0) { |
| 465 | reg->U1BC_LEDConfigure &= ~0xf; |
| 466 | reg->U1BC_LEDConfigure |= 0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 467 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 On */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 468 | pHwData->LED_Blinking = 1; |
| 469 | TimeInterval = 300; |
| 470 | } else { |
| 471 | reg->U1BC_LEDConfigure &= ~0x1f; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 472 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 473 | pHwData->LED_Blinking = 0; |
| 474 | TimeInterval = 300; |
| 475 | } |
| 476 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 477 | /* Gray blinking if in disconnect state and not scanning */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 478 | ltmp = reg->U1BC_LEDConfigure; |
| 479 | reg->U1BC_LEDConfigure &= ~0x1f; |
Pekka Enberg | 833d0cd | 2009-04-08 11:14:06 +0300 | [diff] [blame] | 480 | if (LED_GRAY2[(pHwData->LED_Blinking % 30)]) { |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 481 | reg->U1BC_LEDConfigure |= 0x10; |
| 482 | reg->U1BC_LEDConfigure |= |
Pekka Enberg | 833d0cd | 2009-04-08 11:14:06 +0300 | [diff] [blame] | 483 | LED_GRAY2[(pHwData->LED_Blinking % 30)]; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 484 | } |
| 485 | pHwData->LED_Blinking++; |
| 486 | if (reg->U1BC_LEDConfigure != ltmp) |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 487 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 488 | TimeInterval = 100; |
| 489 | } |
| 490 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 491 | /* Turn On LED_0 */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 492 | if ((reg->U1BC_LEDConfigure & 0x10) == 0) { |
| 493 | reg->U1BC_LEDConfigure |= 0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 494 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_0 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 495 | } |
| 496 | } |
| 497 | break; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 498 | case 5: /* [101] Only 1 Led be placed on PCB and use LED_1 for showing */ |
| 499 | if (!pHwData->LED_LinkOn) { /* Blink only if not Link On */ |
| 500 | /* Blinking if scanning is on progress */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 501 | if (pHwData->LED_Scanning) { |
| 502 | if (pHwData->LED_Blinking == 0) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 503 | reg->U1BC_LEDConfigure |= 0x1000; |
| 504 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_1 On */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 505 | pHwData->LED_Blinking = 1; |
| 506 | TimeInterval = 300; |
| 507 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 508 | reg->U1BC_LEDConfigure &= ~0x1000; |
| 509 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_1 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 510 | pHwData->LED_Blinking = 0; |
| 511 | TimeInterval = 300; |
| 512 | } |
| 513 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 514 | /* Turn Off LED_1 */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 515 | if (reg->U1BC_LEDConfigure & 0x1000) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 516 | reg->U1BC_LEDConfigure &= ~0x1000; |
| 517 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_1 Off */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 518 | } |
| 519 | } |
| 520 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 521 | /* Is transmitting/receiving ?? */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 522 | if ((adapter->RxByteCount != |
| 523 | pHwData->RxByteCountLast) |
| 524 | || (adapter->TxByteCount != |
| 525 | pHwData->TxByteCountLast)) { |
| 526 | if ((reg->U1BC_LEDConfigure & 0x3000) != |
| 527 | 0x3000) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 528 | reg->U1BC_LEDConfigure |= 0x3000; |
| 529 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_1 On */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 530 | } |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 531 | /* Update variable */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 532 | pHwData->RxByteCountLast = |
| 533 | adapter->RxByteCount; |
| 534 | pHwData->TxByteCountLast = |
| 535 | adapter->TxByteCount; |
| 536 | TimeInterval = 200; |
| 537 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 538 | /* Turn On LED_1 and blinking if transmitting/receiving */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 539 | if ((reg->U1BC_LEDConfigure & 0x3000) != |
| 540 | 0x1000) { |
| 541 | reg->U1BC_LEDConfigure &= |
| 542 | ~0x3000; |
| 543 | reg->U1BC_LEDConfigure |= |
| 544 | 0x1000; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 545 | Wb35Reg_Write(pHwData, 0x03bc, reg->U1BC_LEDConfigure); /* LED_1 On */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 546 | } |
| 547 | } |
| 548 | } |
| 549 | break; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 550 | default: /* Default setting. 2 LED be placed on PCB. LED_0: Link On LED_1 Active */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 551 | if ((reg->U1BC_LEDConfigure & 0x3000) != 0x3000) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 552 | reg->U1BC_LEDConfigure |= 0x3000; /* LED_1 is always on and event enable */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 553 | Wb35Reg_Write(pHwData, 0x03bc, |
| 554 | reg->U1BC_LEDConfigure); |
| 555 | } |
| 556 | |
| 557 | if (pHwData->LED_Blinking) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 558 | /* Gray blinking */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 559 | reg->U1BC_LEDConfigure &= ~0x0f; |
| 560 | reg->U1BC_LEDConfigure |= 0x10; |
| 561 | reg->U1BC_LEDConfigure |= |
Pekka Enberg | 833d0cd | 2009-04-08 11:14:06 +0300 | [diff] [blame] | 562 | LED_GRAY[(pHwData->LED_Blinking - 1) % 20]; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 563 | Wb35Reg_Write(pHwData, 0x03bc, |
| 564 | reg->U1BC_LEDConfigure); |
| 565 | |
| 566 | pHwData->LED_Blinking += 2; |
| 567 | if (pHwData->LED_Blinking < 40) |
| 568 | TimeInterval = 100; |
| 569 | else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 570 | pHwData->LED_Blinking = 0; /* Stop blinking */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 571 | reg->U1BC_LEDConfigure &= ~0x0f; |
| 572 | Wb35Reg_Write(pHwData, 0x03bc, |
| 573 | reg->U1BC_LEDConfigure); |
| 574 | } |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 575 | break; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 576 | } |
| 577 | |
| 578 | if (pHwData->LED_LinkOn) { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 579 | if (!(reg->U1BC_LEDConfigure & 0x10)) { /* Check the LED_0 */ |
| 580 | /* Try to turn ON LED_0 after gray blinking */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 581 | reg->U1BC_LEDConfigure |= 0x10; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 582 | pHwData->LED_Blinking = 1; /* Start blinking */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 583 | TimeInterval = 50; |
| 584 | } |
| 585 | } else { |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 586 | if (reg->U1BC_LEDConfigure & 0x10) { /* Check the LED_0 */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 587 | reg->U1BC_LEDConfigure &= ~0x10; |
| 588 | Wb35Reg_Write(pHwData, 0x03bc, |
| 589 | reg->U1BC_LEDConfigure); |
| 590 | } |
| 591 | } |
| 592 | break; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 593 | } |
| 594 | |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 595 | /* Active send null packet to avoid AP disconnect */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 596 | if (pHwData->LED_LinkOn) { |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 597 | pHwData->NullPacketCount += TimeInterval; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 598 | if (pHwData->NullPacketCount >= |
| 599 | DEFAULT_NULL_PACKET_COUNT) { |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 600 | pHwData->NullPacketCount = 0; |
| 601 | } |
| 602 | } |
| 603 | } |
| 604 | |
| 605 | pHwData->time_count += TimeInterval; |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 606 | Wb35Tx_CurrentTime(adapter, pHwData->time_count); |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 607 | pHwData->LEDTimer.expires = jiffies + msecs_to_jiffies(TimeInterval); |
| 608 | add_timer(&pHwData->LEDTimer); |
| 609 | } |
| 610 | |
Pekka Enberg | cfe31f8 | 2009-04-08 11:13:58 +0300 | [diff] [blame] | 611 | static int hal_init_hardware(struct ieee80211_hw *hw) |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 612 | { |
| 613 | struct wbsoft_priv *priv = hw->priv; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 614 | struct hw_data *pHwData = &priv->sHwData; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 615 | u16 SoftwareSet; |
| 616 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 617 | pHwData->MaxReceiveLifeTime = DEFAULT_MSDU_LIFE_TIME; |
| 618 | pHwData->FragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 619 | |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 620 | if (!Wb35Reg_initial(pHwData)) |
Pekka Enberg | a39ee67 | 2009-04-08 11:14:00 +0300 | [diff] [blame] | 621 | goto error_reg_destroy; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 622 | |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 623 | if (!Wb35Tx_initial(pHwData)) |
Pekka Enberg | a39ee67 | 2009-04-08 11:14:00 +0300 | [diff] [blame] | 624 | goto error_tx_destroy; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 625 | |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 626 | if (!Wb35Rx_initial(pHwData)) |
Pekka Enberg | a39ee67 | 2009-04-08 11:14:00 +0300 | [diff] [blame] | 627 | goto error_rx_destroy; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 628 | |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 629 | init_timer(&pHwData->LEDTimer); |
| 630 | pHwData->LEDTimer.function = hal_led_control; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 631 | pHwData->LEDTimer.data = (unsigned long)priv; |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 632 | pHwData->LEDTimer.expires = jiffies + msecs_to_jiffies(1000); |
| 633 | add_timer(&pHwData->LEDTimer); |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 634 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 635 | SoftwareSet = hal_software_set(pHwData); |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 636 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 637 | #ifdef Vendor2 |
Lars Lindley | e5851c2 | 2010-04-02 10:57:35 +0200 | [diff] [blame^] | 638 | /* Try to make sure the EEPROM contain */ |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 639 | SoftwareSet >>= 8; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 640 | if (SoftwareSet != 0x82) |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 641 | return false; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 642 | #endif |
Pekka Enberg | 00e2e05 | 2009-04-08 11:13:59 +0300 | [diff] [blame] | 643 | |
| 644 | Wb35Rx_start(hw); |
| 645 | Wb35Tx_EP2VM_start(priv); |
| 646 | |
| 647 | return 0; |
| 648 | |
Pekka Enberg | a39ee67 | 2009-04-08 11:14:00 +0300 | [diff] [blame] | 649 | error_rx_destroy: |
| 650 | Wb35Rx_destroy(pHwData); |
| 651 | error_tx_destroy: |
| 652 | Wb35Tx_destroy(pHwData); |
| 653 | error_reg_destroy: |
| 654 | Wb35Reg_destroy(pHwData); |
| 655 | |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 656 | pHwData->SurpriseRemove = 1; |
Pekka Enberg | cfe31f8 | 2009-04-08 11:13:58 +0300 | [diff] [blame] | 657 | return -EINVAL; |
Pekka Enberg | 80767e6 | 2009-04-08 11:13:57 +0300 | [diff] [blame] | 658 | } |
| 659 | |
Pekka Enberg | 2659851 | 2009-04-08 11:13:56 +0300 | [diff] [blame] | 660 | static int wb35_hw_init(struct ieee80211_hw *hw) |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 661 | { |
| 662 | struct wbsoft_priv *priv = hw->priv; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 663 | struct hw_data *pHwData = &priv->sHwData; |
| 664 | u8 EEPROM_region; |
| 665 | u8 HwRadioOff; |
| 666 | u8 *pMacAddr2; |
| 667 | u8 *pMacAddr; |
Pekka Enberg | 2659851 | 2009-04-08 11:13:56 +0300 | [diff] [blame] | 668 | int err; |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 669 | |
Pekka Enberg | 9ca748c | 2009-04-08 11:14:03 +0300 | [diff] [blame] | 670 | pHwData->phy_type = RF_DECIDE_BY_INF; |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 671 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 672 | priv->Mds.TxRTSThreshold = DEFAULT_RTSThreshold; |
| 673 | priv->Mds.TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD; |
| 674 | |
| 675 | priv->sLocalPara.region_INF = REGION_AUTO; |
| 676 | priv->sLocalPara.TxRateMode = RATE_AUTO; |
| 677 | priv->sLocalPara.bMacOperationMode = MODE_802_11_BG; |
| 678 | priv->sLocalPara.MTUsize = MAX_ETHERNET_PACKET_SIZE; |
| 679 | priv->sLocalPara.bPreambleMode = AUTO_MODE; |
| 680 | priv->sLocalPara.bWepKeyError = false; |
| 681 | priv->sLocalPara.bToSelfPacketReceived = false; |
| 682 | priv->sLocalPara.WepKeyDetectTimerCount = 2 * 100; /* 2 seconds */ |
| 683 | |
| 684 | priv->sLocalPara.RadioOffStatus.boSwRadioOff = false; |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 685 | |
Pekka Enberg | cfe31f8 | 2009-04-08 11:13:58 +0300 | [diff] [blame] | 686 | err = hal_init_hardware(hw); |
| 687 | if (err) |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 688 | goto error; |
| 689 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 690 | EEPROM_region = hal_get_region_from_EEPROM(pHwData); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 691 | if (EEPROM_region != REGION_AUTO) |
| 692 | priv->sLocalPara.region = EEPROM_region; |
| 693 | else { |
| 694 | if (priv->sLocalPara.region_INF != REGION_AUTO) |
| 695 | priv->sLocalPara.region = priv->sLocalPara.region_INF; |
| 696 | else |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 697 | priv->sLocalPara.region = REGION_USA; /* default setting */ |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 698 | } |
| 699 | |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 700 | Mds_initial(priv); |
| 701 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 702 | /* |
| 703 | * If no user-defined address in the registry, use the addresss |
| 704 | * "burned" on the NIC instead. |
| 705 | */ |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 706 | pMacAddr = priv->sLocalPara.ThisMacAddress; |
| 707 | pMacAddr2 = priv->sLocalPara.PermanentAddress; |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 708 | |
| 709 | /* Reading ethernet address from EEPROM */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 710 | hal_get_permanent_address(pHwData, priv->sLocalPara.PermanentAddress); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 711 | if (memcmp(pMacAddr, "\x00\x00\x00\x00\x00\x00", MAC_ADDR_LENGTH) == 0) |
| 712 | memcpy(pMacAddr, pMacAddr2, MAC_ADDR_LENGTH); |
| 713 | else { |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 714 | /* Set the user define MAC address */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 715 | hal_set_ethernet_address(pHwData, |
| 716 | priv->sLocalPara.ThisMacAddress); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 717 | } |
| 718 | |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 719 | priv->sLocalPara.bAntennaNo = hal_get_antenna_number(pHwData); |
| 720 | #ifdef _PE_STATE_DUMP_ |
Pekka Enberg | 0c59dba | 2009-01-08 11:31:59 +0200 | [diff] [blame] | 721 | printk("Driver init, antenna no = %d\n", psLOCAL->bAntennaNo); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 722 | #endif |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 723 | hal_get_hw_radio_off(pHwData); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 724 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 725 | /* Waiting for HAL setting OK */ |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 726 | while (!hal_idle(pHwData)) |
| 727 | msleep(10); |
| 728 | |
| 729 | MTO_Init(priv); |
| 730 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 731 | HwRadioOff = hal_get_hw_radio_off(pHwData); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 732 | priv->sLocalPara.RadioOffStatus.boHwRadioOff = !!HwRadioOff; |
| 733 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 734 | hal_set_radio_mode(pHwData, |
| 735 | (unsigned char)(priv->sLocalPara.RadioOffStatus. |
| 736 | boSwRadioOff |
| 737 | || priv->sLocalPara.RadioOffStatus. |
| 738 | boHwRadioOff)); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 739 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 740 | /* Notify hal that the driver is ready now. */ |
| 741 | hal_driver_init_OK(pHwData) = 1; |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 742 | |
| 743 | error: |
Pekka Enberg | 2659851 | 2009-04-08 11:13:56 +0300 | [diff] [blame] | 744 | return err; |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 745 | } |
| 746 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 747 | static int wb35_probe(struct usb_interface *intf, |
| 748 | const struct usb_device_id *id_table) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 749 | { |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 750 | struct usb_device *udev = interface_to_usbdev(intf); |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 751 | struct usb_endpoint_descriptor *endpoint; |
| 752 | struct usb_host_interface *interface; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 753 | struct ieee80211_hw *dev; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 754 | struct wbsoft_priv *priv; |
| 755 | struct wb_usb *pWbUsb; |
Pekka Enberg | acfa511 | 2009-01-30 11:32:47 +0200 | [diff] [blame] | 756 | int nr, err; |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 757 | u32 ltmp; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 758 | |
| 759 | usb_get_dev(udev); |
| 760 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 761 | /* Check the device if it already be opened */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 762 | nr = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), |
| 763 | 0x01, |
| 764 | USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, |
| 765 | 0x0, 0x400, <mp, 4, HZ * 100); |
Pekka Enberg | acfa511 | 2009-01-30 11:32:47 +0200 | [diff] [blame] | 766 | if (nr < 0) { |
| 767 | err = nr; |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 768 | goto error; |
Pekka Enberg | acfa511 | 2009-01-30 11:32:47 +0200 | [diff] [blame] | 769 | } |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 770 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 771 | /* Is already initialized? */ |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 772 | ltmp = cpu_to_le32(ltmp); |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 773 | if (ltmp) { |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 774 | err = -EBUSY; |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 775 | goto error; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 776 | } |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 777 | |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 778 | dev = ieee80211_alloc_hw(sizeof(*priv), &wbsoft_ops); |
Pekka Enberg | acfa511 | 2009-01-30 11:32:47 +0200 | [diff] [blame] | 779 | if (!dev) { |
| 780 | err = -ENOMEM; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 781 | goto error; |
Pekka Enberg | acfa511 | 2009-01-30 11:32:47 +0200 | [diff] [blame] | 782 | } |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 783 | |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 784 | priv = dev->priv; |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 785 | |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 786 | spin_lock_init(&priv->SpinLock); |
| 787 | |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 788 | pWbUsb = &priv->sHwData.WbUsb; |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 789 | pWbUsb->udev = udev; |
| 790 | |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 791 | interface = intf->cur_altsetting; |
| 792 | endpoint = &interface->endpoint[0].desc; |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 793 | |
| 794 | if (endpoint[2].wMaxPacketSize == 512) { |
| 795 | printk("[w35und] Working on USB 2.0\n"); |
| 796 | pWbUsb->IsUsb20 = 1; |
| 797 | } |
| 798 | |
Pekka Enberg | 2659851 | 2009-04-08 11:13:56 +0300 | [diff] [blame] | 799 | err = wb35_hw_init(dev); |
| 800 | if (err) |
Pekka Enberg | 1e8a2b6 | 2008-10-30 16:14:38 +0200 | [diff] [blame] | 801 | goto error_free_hw; |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 802 | |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 803 | SET_IEEE80211_DEV(dev, &udev->dev); |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 804 | { |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 805 | struct hw_data *pHwData = &priv->sHwData; |
| 806 | unsigned char dev_addr[MAX_ADDR_LEN]; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 807 | hal_get_permanent_address(pHwData, dev_addr); |
| 808 | SET_IEEE80211_PERM_ADDR(dev, dev_addr); |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 809 | } |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 810 | |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 811 | dev->extra_tx_headroom = 12; /* FIXME */ |
Pavel Machek | 05e361c | 2009-01-30 10:05:25 +0100 | [diff] [blame] | 812 | dev->flags = IEEE80211_HW_SIGNAL_UNSPEC; |
| 813 | dev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION); |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 814 | |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 815 | dev->channel_change_time = 1000; |
Pavel Machek | 05e361c | 2009-01-30 10:05:25 +0100 | [diff] [blame] | 816 | dev->max_signal = 100; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 817 | dev->queues = 1; |
| 818 | |
Pekka Enberg | a36e089 | 2008-10-28 00:20:03 +0200 | [diff] [blame] | 819 | dev->wiphy->bands[IEEE80211_BAND_2GHZ] = &wbsoft_band_2GHz; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 820 | |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 821 | err = ieee80211_register_hw(dev); |
| 822 | if (err) |
| 823 | goto error_free_hw; |
| 824 | |
Pekka Enberg | 82fbb01 | 2009-04-16 14:43:14 +0300 | [diff] [blame] | 825 | usb_set_intfdata(intf, dev); |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 826 | |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 827 | return 0; |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 828 | |
| 829 | error_free_hw: |
| 830 | ieee80211_free_hw(dev); |
Pekka Enberg | dc7e04f | 2008-10-21 12:14:58 +0300 | [diff] [blame] | 831 | error: |
Pekka Enberg | 4af12e5 | 2008-10-27 23:29:31 +0200 | [diff] [blame] | 832 | usb_put_dev(udev); |
Pekka Enberg | 1523ddc | 2008-10-22 11:04:23 +0300 | [diff] [blame] | 833 | return err; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 834 | } |
| 835 | |
Pekka Enberg | f592a85 | 2009-04-08 11:14:01 +0300 | [diff] [blame] | 836 | static void hal_halt(struct hw_data *pHwData) |
| 837 | { |
| 838 | del_timer_sync(&pHwData->LEDTimer); |
| 839 | /* XXX: Wait for Timer DPC exit. */ |
| 840 | msleep(100); |
| 841 | Wb35Rx_destroy(pHwData); |
| 842 | Wb35Tx_destroy(pHwData); |
| 843 | Wb35Reg_destroy(pHwData); |
| 844 | } |
| 845 | |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 846 | static void wb35_hw_halt(struct wbsoft_priv *adapter) |
| 847 | { |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 848 | Mds_Destroy(adapter); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 849 | |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 850 | /* Turn off Rx and Tx hardware ability */ |
Pekka Enberg | a32b981 | 2009-04-08 11:14:04 +0300 | [diff] [blame] | 851 | hal_stop(&adapter->sHwData); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 852 | #ifdef _PE_USB_INI_DUMP_ |
Pekka Enberg | 0c59dba | 2009-01-08 11:31:59 +0200 | [diff] [blame] | 853 | printk("[w35und] Hal_stop O.K.\n"); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 854 | #endif |
Pekka Enberg | bdbb883 | 2009-04-08 11:14:02 +0300 | [diff] [blame] | 855 | /* Waiting Irp completed */ |
| 856 | msleep(100); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 857 | |
Pekka Enberg | f592a85 | 2009-04-08 11:14:01 +0300 | [diff] [blame] | 858 | hal_halt(&adapter->sHwData); |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 859 | } |
| 860 | |
Pekka Enberg | 302bae8 | 2008-10-22 19:05:54 +0300 | [diff] [blame] | 861 | static void wb35_disconnect(struct usb_interface *intf) |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 862 | { |
Pekka Enberg | 82fbb01 | 2009-04-16 14:43:14 +0300 | [diff] [blame] | 863 | struct ieee80211_hw *hw = usb_get_intfdata(intf); |
| 864 | struct wbsoft_priv *priv = hw->priv; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 865 | |
Pekka Enberg | 912b209 | 2008-10-30 18:12:02 +0200 | [diff] [blame] | 866 | wb35_hw_halt(priv); |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 867 | |
Pekka Enberg | 82fbb01 | 2009-04-16 14:43:14 +0300 | [diff] [blame] | 868 | ieee80211_stop_queues(hw); |
| 869 | ieee80211_unregister_hw(hw); |
| 870 | ieee80211_free_hw(hw); |
| 871 | |
Pekka Enberg | 4af12e5 | 2008-10-27 23:29:31 +0200 | [diff] [blame] | 872 | usb_set_intfdata(intf, NULL); |
| 873 | usb_put_dev(interface_to_usbdev(intf)); |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 874 | } |
| 875 | |
Pekka Enberg | dd38da4 | 2008-10-21 13:01:42 +0300 | [diff] [blame] | 876 | static struct usb_driver wb35_driver = { |
| 877 | .name = "w35und", |
| 878 | .id_table = wb35_table, |
| 879 | .probe = wb35_probe, |
| 880 | .disconnect = wb35_disconnect, |
| 881 | }; |
Pavel Machek | 66101de | 2008-10-01 14:36:56 +0200 | [diff] [blame] | 882 | |
Pekka Enberg | dd38da4 | 2008-10-21 13:01:42 +0300 | [diff] [blame] | 883 | static int __init wb35_init(void) |
| 884 | { |
| 885 | return usb_register(&wb35_driver); |
| 886 | } |
| 887 | |
| 888 | static void __exit wb35_exit(void) |
| 889 | { |
| 890 | usb_deregister(&wb35_driver); |
| 891 | } |
| 892 | |
| 893 | module_init(wb35_init); |
| 894 | module_exit(wb35_exit); |