wl1251: fix ELP_CTRL register reads
[pandora-wifi.git] / drivers / net / wireless / ipw2x00 / libipw_geo.c
1 /******************************************************************************
2
3   Copyright(c) 2005 Intel Corporation. All rights reserved.
4
5   This program is free software; you can redistribute it and/or modify it
6   under the terms of version 2 of the GNU General Public License as
7   published by the Free Software Foundation.
8
9   This program is distributed in the hope that it will be useful, but WITHOUT
10   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12   more details.
13
14   You should have received a copy of the GNU General Public License along with
15   this program; if not, write to the Free Software Foundation, Inc., 59
16   Temple Place - Suite 330, Boston, MA  02111-1307, USA.
17
18   The full GNU General Public License is included in this distribution in the
19   file called LICENSE.
20
21   Contact Information:
22   Intel Linux Wireless <ilw@linux.intel.com>
23   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
24
25 ******************************************************************************/
26 #include <linux/compiler.h>
27 #include <linux/errno.h>
28 #include <linux/if_arp.h>
29 #include <linux/in6.h>
30 #include <linux/in.h>
31 #include <linux/ip.h>
32 #include <linux/kernel.h>
33 #include <linux/module.h>
34 #include <linux/netdevice.h>
35 #include <linux/proc_fs.h>
36 #include <linux/skbuff.h>
37 #include <linux/slab.h>
38 #include <linux/tcp.h>
39 #include <linux/types.h>
40 #include <linux/wireless.h>
41 #include <linux/etherdevice.h>
42 #include <asm/uaccess.h>
43
44 #include "libipw.h"
45
46 int libipw_is_valid_channel(struct libipw_device *ieee, u8 channel)
47 {
48         int i;
49
50         /* Driver needs to initialize the geography map before using
51          * these helper functions */
52         if (ieee->geo.bg_channels == 0 && ieee->geo.a_channels == 0)
53                 return 0;
54
55         if (ieee->freq_band & LIBIPW_24GHZ_BAND)
56                 for (i = 0; i < ieee->geo.bg_channels; i++)
57                         /* NOTE: If G mode is currently supported but
58                          * this is a B only channel, we don't see it
59                          * as valid. */
60                         if ((ieee->geo.bg[i].channel == channel) &&
61                             !(ieee->geo.bg[i].flags & LIBIPW_CH_INVALID) &&
62                             (!(ieee->mode & IEEE_G) ||
63                              !(ieee->geo.bg[i].flags & LIBIPW_CH_B_ONLY)))
64                                 return LIBIPW_24GHZ_BAND;
65
66         if (ieee->freq_band & LIBIPW_52GHZ_BAND)
67                 for (i = 0; i < ieee->geo.a_channels; i++)
68                         if ((ieee->geo.a[i].channel == channel) &&
69                             !(ieee->geo.a[i].flags & LIBIPW_CH_INVALID))
70                                 return LIBIPW_52GHZ_BAND;
71
72         return 0;
73 }
74
75 int libipw_channel_to_index(struct libipw_device *ieee, u8 channel)
76 {
77         int i;
78
79         /* Driver needs to initialize the geography map before using
80          * these helper functions */
81         if (ieee->geo.bg_channels == 0 && ieee->geo.a_channels == 0)
82                 return -1;
83
84         if (ieee->freq_band & LIBIPW_24GHZ_BAND)
85                 for (i = 0; i < ieee->geo.bg_channels; i++)
86                         if (ieee->geo.bg[i].channel == channel)
87                                 return i;
88
89         if (ieee->freq_band & LIBIPW_52GHZ_BAND)
90                 for (i = 0; i < ieee->geo.a_channels; i++)
91                         if (ieee->geo.a[i].channel == channel)
92                                 return i;
93
94         return -1;
95 }
96
97 u32 libipw_channel_to_freq(struct libipw_device * ieee, u8 channel)
98 {
99         const struct libipw_channel * ch;
100
101         /* Driver needs to initialize the geography map before using
102          * these helper functions */
103         if (ieee->geo.bg_channels == 0 && ieee->geo.a_channels == 0)
104                 return 0;
105
106         ch = libipw_get_channel(ieee, channel);
107         if (!ch->channel)
108                 return 0;
109         return ch->freq;
110 }
111
112 u8 libipw_freq_to_channel(struct libipw_device * ieee, u32 freq)
113 {
114         int i;
115
116         /* Driver needs to initialize the geography map before using
117          * these helper functions */
118         if (ieee->geo.bg_channels == 0 && ieee->geo.a_channels == 0)
119                 return 0;
120
121         freq /= 100000;
122
123         if (ieee->freq_band & LIBIPW_24GHZ_BAND)
124                 for (i = 0; i < ieee->geo.bg_channels; i++)
125                         if (ieee->geo.bg[i].freq == freq)
126                                 return ieee->geo.bg[i].channel;
127
128         if (ieee->freq_band & LIBIPW_52GHZ_BAND)
129                 for (i = 0; i < ieee->geo.a_channels; i++)
130                         if (ieee->geo.a[i].freq == freq)
131                                 return ieee->geo.a[i].channel;
132
133         return 0;
134 }
135
136 int libipw_set_geo(struct libipw_device *ieee,
137                       const struct libipw_geo *geo)
138 {
139         memcpy(ieee->geo.name, geo->name, 3);
140         ieee->geo.name[3] = '\0';
141         ieee->geo.bg_channels = geo->bg_channels;
142         ieee->geo.a_channels = geo->a_channels;
143         memcpy(ieee->geo.bg, geo->bg, geo->bg_channels *
144                sizeof(struct libipw_channel));
145         memcpy(ieee->geo.a, geo->a, ieee->geo.a_channels *
146                sizeof(struct libipw_channel));
147         return 0;
148 }
149
150 const struct libipw_geo *libipw_get_geo(struct libipw_device *ieee)
151 {
152         return &ieee->geo;
153 }
154
155 u8 libipw_get_channel_flags(struct libipw_device * ieee, u8 channel)
156 {
157         int index = libipw_channel_to_index(ieee, channel);
158
159         if (index == -1)
160                 return LIBIPW_CH_INVALID;
161
162         if (channel <= LIBIPW_24GHZ_CHANNELS)
163                 return ieee->geo.bg[index].flags;
164
165         return ieee->geo.a[index].flags;
166 }
167
168 static const struct libipw_channel bad_channel = {
169         .channel = 0,
170         .flags = LIBIPW_CH_INVALID,
171         .max_power = 0,
172 };
173
174 const struct libipw_channel *libipw_get_channel(struct libipw_device
175                                                       *ieee, u8 channel)
176 {
177         int index = libipw_channel_to_index(ieee, channel);
178
179         if (index == -1)
180                 return &bad_channel;
181
182         if (channel <= LIBIPW_24GHZ_CHANNELS)
183                 return &ieee->geo.bg[index];
184
185         return &ieee->geo.a[index];
186 }
187
188 EXPORT_SYMBOL(libipw_get_channel);
189 EXPORT_SYMBOL(libipw_get_channel_flags);
190 EXPORT_SYMBOL(libipw_is_valid_channel);
191 EXPORT_SYMBOL(libipw_freq_to_channel);
192 EXPORT_SYMBOL(libipw_channel_to_freq);
193 EXPORT_SYMBOL(libipw_channel_to_index);
194 EXPORT_SYMBOL(libipw_set_geo);
195 EXPORT_SYMBOL(libipw_get_geo);