2 * This file contains functions for 802.11D.
4 #include <linux/ctype.h>
5 #include <linux/kernel.h>
6 #include <linux/wireless.h>
14 #define TX_PWR_DEFAULT 10
16 static struct region_code_mapping region_code_mapping[] = {
17 {"US ", 0x10}, /* US FCC */
18 {"CA ", 0x10}, /* IC Canada */
19 {"SG ", 0x10}, /* Singapore */
20 {"EU ", 0x30}, /* ETSI */
21 {"AU ", 0x30}, /* Australia */
22 {"KR ", 0x30}, /* Republic Of Korea */
23 {"ES ", 0x31}, /* Spain */
24 {"FR ", 0x32}, /* France */
25 {"JP ", 0x40}, /* Japan */
28 /* Following 2 structure defines the supported channels */
29 static struct chan_freq_power channel_freq_power_UN_BG[] = {
30 {1, 2412, TX_PWR_DEFAULT},
31 {2, 2417, TX_PWR_DEFAULT},
32 {3, 2422, TX_PWR_DEFAULT},
33 {4, 2427, TX_PWR_DEFAULT},
34 {5, 2432, TX_PWR_DEFAULT},
35 {6, 2437, TX_PWR_DEFAULT},
36 {7, 2442, TX_PWR_DEFAULT},
37 {8, 2447, TX_PWR_DEFAULT},
38 {9, 2452, TX_PWR_DEFAULT},
39 {10, 2457, TX_PWR_DEFAULT},
40 {11, 2462, TX_PWR_DEFAULT},
41 {12, 2467, TX_PWR_DEFAULT},
42 {13, 2472, TX_PWR_DEFAULT},
43 {14, 2484, TX_PWR_DEFAULT}
46 static u8 lbs_region_2_code(u8 *region)
50 for (i = 0; region[i] && i < COUNTRY_CODE_LEN; i++)
51 region[i] = toupper(region[i]);
53 for (i = 0; i < ARRAY_SIZE(region_code_mapping); i++) {
54 if (!memcmp(region, region_code_mapping[i].region,
56 return (region_code_mapping[i].code);
60 return (region_code_mapping[0].code);
63 static u8 *lbs_code_2_region(u8 code)
67 for (i = 0; i < ARRAY_SIZE(region_code_mapping); i++) {
68 if (region_code_mapping[i].code == code)
69 return (region_code_mapping[i].region);
72 return (region_code_mapping[0].region);
76 * @brief This function finds the nrchan-th chan after the firstchan
78 * @param firstchan first channel number
79 * @param nrchan number of channels
80 * @return the nrchan-th chan number
82 static u8 lbs_get_chan_11d(u8 band, u8 firstchan, u8 nrchan, u8 *chan)
83 /*find the nrchan-th chan after the firstchan*/
86 struct chan_freq_power *cfp;
89 cfp = channel_freq_power_UN_BG;
90 cfp_no = ARRAY_SIZE(channel_freq_power_UN_BG);
92 for (i = 0; i < cfp_no; i++) {
93 if ((cfp + i)->channel == firstchan) {
94 lbs_deb_11d("firstchan found\n");
100 /*if beyond the boundary */
101 if (i + nrchan < cfp_no) {
102 *chan = (cfp + i + nrchan)->channel;
111 * @brief This function Checks if chan txpwr is learned from AP/IBSS
112 * @param chan chan number
113 * @param parsed_region_chan pointer to parsed_region_chan_11d
114 * @return TRUE; FALSE
116 static u8 lbs_channel_known_11d(u8 chan,
117 struct parsed_region_chan_11d * parsed_region_chan)
119 struct chan_power_11d *chanpwr = parsed_region_chan->chanpwr;
120 u8 nr_chan = parsed_region_chan->nr_chan;
123 lbs_deb_hex(LBS_DEB_11D, "parsed_region_chan", (char *)chanpwr,
124 sizeof(struct chan_power_11d) * nr_chan);
126 for (i = 0; i < nr_chan; i++) {
127 if (chan == chanpwr[i].chan) {
128 lbs_deb_11d("found chan %d\n", chan);
133 lbs_deb_11d("chan %d not found\n", chan);
137 u32 lbs_chan_2_freq(u8 chan, u8 band)
139 struct chan_freq_power *cf;
143 cf = channel_freq_power_UN_BG;
145 for (i = 0; i < ARRAY_SIZE(channel_freq_power_UN_BG); i++) {
146 if (chan == cf[i].channel)
153 static int generate_domain_info_11d(struct parsed_region_chan_11d
155 struct lbs_802_11d_domain_reg *domaininfo)
159 u8 nr_chan = parsed_region_chan->nr_chan;
160 u8 nr_parsedchan = 0;
162 u8 firstchan = 0, nextchan = 0, maxpwr = 0;
166 memcpy(domaininfo->countrycode, parsed_region_chan->countrycode,
169 lbs_deb_11d("nrchan %d\n", nr_chan);
170 lbs_deb_hex(LBS_DEB_11D, "parsed_region_chan", (char *)parsed_region_chan,
171 sizeof(struct parsed_region_chan_11d));
173 for (i = 0; i < nr_chan; i++) {
176 nextchan = firstchan =
177 parsed_region_chan->chanpwr[i].chan;
178 maxpwr = parsed_region_chan->chanpwr[i].pwr;
183 if (parsed_region_chan->chanpwr[i].chan == nextchan + 1 &&
184 parsed_region_chan->chanpwr[i].pwr == maxpwr) {
188 domaininfo->subband[nr_subband].firstchan = firstchan;
189 domaininfo->subband[nr_subband].nrchan =
191 domaininfo->subband[nr_subband].maxtxpwr = maxpwr;
193 nextchan = firstchan =
194 parsed_region_chan->chanpwr[i].chan;
195 maxpwr = parsed_region_chan->chanpwr[i].pwr;
200 domaininfo->subband[nr_subband].firstchan = firstchan;
201 domaininfo->subband[nr_subband].nrchan = nr_parsedchan;
202 domaininfo->subband[nr_subband].maxtxpwr = maxpwr;
205 domaininfo->nr_subband = nr_subband;
207 lbs_deb_11d("nr_subband=%x\n", domaininfo->nr_subband);
208 lbs_deb_hex(LBS_DEB_11D, "domaininfo", (char *)domaininfo,
209 COUNTRY_CODE_LEN + 1 +
210 sizeof(struct ieeetypes_subbandset) * nr_subband);
215 * @brief This function generates parsed_region_chan from Domain Info learned from AP/IBSS
216 * @param region_chan pointer to struct region_channel
217 * @param *parsed_region_chan pointer to parsed_region_chan_11d
220 static void lbs_generate_parsed_region_chan_11d(struct region_channel *region_chan,
221 struct parsed_region_chan_11d *
225 struct chan_freq_power *cfp;
227 if (region_chan == NULL) {
228 lbs_deb_11d("region_chan is NULL\n");
232 cfp = region_chan->CFP;
234 lbs_deb_11d("cfp is NULL \n");
238 parsed_region_chan->band = region_chan->band;
239 parsed_region_chan->region = region_chan->region;
240 memcpy(parsed_region_chan->countrycode,
241 lbs_code_2_region(region_chan->region), COUNTRY_CODE_LEN);
243 lbs_deb_11d("region 0x%x, band %d\n", parsed_region_chan->region,
244 parsed_region_chan->band);
246 for (i = 0; i < region_chan->nrcfp; i++, cfp++) {
247 parsed_region_chan->chanpwr[i].chan = cfp->channel;
248 parsed_region_chan->chanpwr[i].pwr = cfp->maxtxpower;
249 lbs_deb_11d("chan %d, pwr %d\n",
250 parsed_region_chan->chanpwr[i].chan,
251 parsed_region_chan->chanpwr[i].pwr);
253 parsed_region_chan->nr_chan = region_chan->nrcfp;
255 lbs_deb_11d("nrchan %d\n", parsed_region_chan->nr_chan);
261 * @brief generate parsed_region_chan from Domain Info learned from AP/IBSS
262 * @param region region ID
267 static u8 lbs_region_chan_supported_11d(u8 region, u8 band, u8 chan)
269 struct chan_freq_power *cfp;
274 lbs_deb_enter(LBS_DEB_11D);
276 cfp = lbs_get_region_cfp_table(region, band, &cfp_no);
280 for (idx = 0; idx < cfp_no; idx++) {
281 if (chan == (cfp + idx)->channel) {
282 /* If Mrvl Chip Supported? */
283 if ((cfp + idx)->unsupported) {
292 /*chan is not in the region table */
295 lbs_deb_leave_args(LBS_DEB_11D, "ret %d", ret);
300 * @brief This function checks if chan txpwr is learned from AP/IBSS
301 * @param chan chan number
302 * @param parsed_region_chan pointer to parsed_region_chan_11d
305 static int parse_domain_info_11d(struct ieeetypes_countryinfofullset*
308 struct parsed_region_chan_11d *
311 u8 nr_subband, nrchan;
312 u8 lastchan, firstchan;
316 u8 idx = 0; /*chan index in parsed_region_chan */
320 lbs_deb_enter(LBS_DEB_11D);
324 2. First Chan increment
325 3. channel range no overlap
327 5. channel is supported by region?
331 lbs_deb_hex(LBS_DEB_11D, "countryinfo", (u8 *) countryinfo, 30);
333 if ((*(countryinfo->countrycode)) == 0
334 || (countryinfo->len <= COUNTRY_CODE_LEN)) {
335 /* No region Info or Wrong region info: treat as No 11D info */
339 /*Step1: check region_code */
340 parsed_region_chan->region = region =
341 lbs_region_2_code(countryinfo->countrycode);
343 lbs_deb_11d("regioncode=%x\n", (u8) parsed_region_chan->region);
344 lbs_deb_hex(LBS_DEB_11D, "countrycode", (char *)countryinfo->countrycode,
347 parsed_region_chan->band = band;
349 memcpy(parsed_region_chan->countrycode, countryinfo->countrycode,
352 nr_subband = (countryinfo->len - COUNTRY_CODE_LEN) /
353 sizeof(struct ieeetypes_subbandset);
355 for (j = 0, lastchan = 0; j < nr_subband; j++) {
357 if (countryinfo->subband[j].firstchan <= lastchan) {
358 /*Step2&3. Check First Chan Num increment and no overlap */
359 lbs_deb_11d("chan %d>%d, overlap\n",
360 countryinfo->subband[j].firstchan, lastchan);
364 firstchan = countryinfo->subband[j].firstchan;
365 nrchan = countryinfo->subband[j].nrchan;
367 for (i = 0; idx < MAX_NO_OF_CHAN && i < nrchan; i++) {
368 /*step4: channel is supported? */
370 if (!lbs_get_chan_11d(band, firstchan, i, &curchan)) {
371 /* Chan is not found in UN table */
372 lbs_deb_11d("chan is not supported: %d \n", i);
378 if (lbs_region_chan_supported_11d
379 (region, band, curchan)) {
380 /*step5: Check if curchan is supported by mrvl in region */
381 parsed_region_chan->chanpwr[idx].chan = curchan;
382 parsed_region_chan->chanpwr[idx].pwr =
383 countryinfo->subband[j].maxtxpwr;
386 /*not supported and ignore the chan */
388 "i %d, chan %d unsupported in region %x, band %d\n",
389 i, curchan, region, band);
393 /*Step6: Add other checking if any */
397 parsed_region_chan->nr_chan = idx;
399 lbs_deb_11d("nrchan=%x\n", parsed_region_chan->nr_chan);
400 lbs_deb_hex(LBS_DEB_11D, "parsed_region_chan", (u8 *) parsed_region_chan,
401 2 + COUNTRY_CODE_LEN + sizeof(struct parsed_region_chan_11d) * idx);
404 lbs_deb_enter(LBS_DEB_11D);
409 * @brief This function calculates the scan type for channels
410 * @param chan chan number
411 * @param parsed_region_chan pointer to parsed_region_chan_11d
412 * @return PASSIVE if chan is unknown; ACTIVE if chan is known
414 u8 lbs_get_scan_type_11d(u8 chan,
415 struct parsed_region_chan_11d * parsed_region_chan)
417 u8 scan_type = CMD_SCAN_TYPE_PASSIVE;
419 lbs_deb_enter(LBS_DEB_11D);
421 if (lbs_channel_known_11d(chan, parsed_region_chan)) {
422 lbs_deb_11d("found, do active scan\n");
423 scan_type = CMD_SCAN_TYPE_ACTIVE;
425 lbs_deb_11d("not found, do passive scan\n");
428 lbs_deb_leave_args(LBS_DEB_11D, "ret scan_type %d", scan_type);
433 void lbs_init_11d(struct lbs_private *priv)
436 memset(&(priv->parsed_region_chan), 0,
437 sizeof(struct parsed_region_chan_11d));
442 * @brief This function sets DOMAIN INFO to FW
443 * @param priv pointer to struct lbs_private
446 static int set_domain_info_11d(struct lbs_private *priv)
450 if (!priv->enable11d) {
451 lbs_deb_11d("dnld domain Info with 11d disabled\n");
455 ret = lbs_prepare_and_send_command(priv, CMD_802_11D_DOMAIN_INFO,
457 CMD_OPTION_WAITFORRSP, 0, NULL);
459 lbs_deb_11d("fail to dnld domain info\n");
465 * @brief This function setups scan channels
466 * @param priv pointer to struct lbs_private
470 int lbs_set_universaltable(struct lbs_private *priv, u8 band)
472 u16 size = sizeof(struct chan_freq_power);
475 memset(priv->universal_channel, 0,
476 sizeof(priv->universal_channel));
478 priv->universal_channel[i].nrcfp =
479 sizeof(channel_freq_power_UN_BG) / size;
480 lbs_deb_11d("BG-band nrcfp %d\n",
481 priv->universal_channel[i].nrcfp);
483 priv->universal_channel[i].CFP = channel_freq_power_UN_BG;
484 priv->universal_channel[i].valid = 1;
485 priv->universal_channel[i].region = UNIVERSAL_REGION_CODE;
486 priv->universal_channel[i].band = band;
493 * @brief This function implements command CMD_802_11D_DOMAIN_INFO
494 * @param priv pointer to struct lbs_private
495 * @param cmd pointer to cmd buffer
496 * @param cmdno cmd ID
497 * @param cmdOption cmd action
500 int lbs_cmd_802_11d_domain_info(struct lbs_private *priv,
501 struct cmd_ds_command *cmd, u16 cmdno,
504 struct cmd_ds_802_11d_domain_info *pdomaininfo =
505 &cmd->params.domaininfo;
506 struct mrvlietypes_domainparamset *domain = &pdomaininfo->domain;
507 u8 nr_subband = priv->domainreg.nr_subband;
509 lbs_deb_enter(LBS_DEB_11D);
511 lbs_deb_11d("nr_subband=%x\n", nr_subband);
513 cmd->command = cpu_to_le16(cmdno);
514 pdomaininfo->action = cpu_to_le16(cmdoption);
515 if (cmdoption == CMD_ACT_GET) {
517 cpu_to_le16(sizeof(pdomaininfo->action) + S_DS_GEN);
518 lbs_deb_hex(LBS_DEB_11D, "802_11D_DOMAIN_INFO", (u8 *) cmd,
519 le16_to_cpu(cmd->size));
523 domain->header.type = cpu_to_le16(TLV_TYPE_DOMAIN);
524 memcpy(domain->countrycode, priv->domainreg.countrycode,
525 sizeof(domain->countrycode));
528 cpu_to_le16(nr_subband * sizeof(struct ieeetypes_subbandset) +
529 sizeof(domain->countrycode));
532 memcpy(domain->subband, priv->domainreg.subband,
533 nr_subband * sizeof(struct ieeetypes_subbandset));
535 cmd->size = cpu_to_le16(sizeof(pdomaininfo->action) +
536 le16_to_cpu(domain->header.len) +
537 sizeof(struct mrvlietypesheader) +
541 cpu_to_le16(sizeof(pdomaininfo->action) + S_DS_GEN);
544 lbs_deb_hex(LBS_DEB_11D, "802_11D_DOMAIN_INFO", (u8 *) cmd, le16_to_cpu(cmd->size));
547 lbs_deb_enter(LBS_DEB_11D);
552 * @brief This function parses countryinfo from AP and download country info to FW
553 * @param priv pointer to struct lbs_private
554 * @param resp pointer to command response buffer
557 int lbs_ret_802_11d_domain_info(struct lbs_private *priv,
558 struct cmd_ds_command *resp)
560 struct cmd_ds_802_11d_domain_info *domaininfo = &resp->params.domaininforesp;
561 struct mrvlietypes_domainparamset *domain = &domaininfo->domain;
562 u16 action = le16_to_cpu(domaininfo->action);
566 lbs_deb_enter(LBS_DEB_11D);
568 lbs_deb_hex(LBS_DEB_11D, "domain info resp", (u8 *) resp,
569 (int)le16_to_cpu(resp->size));
571 nr_subband = (le16_to_cpu(domain->header.len) - COUNTRY_CODE_LEN) /
572 sizeof(struct ieeetypes_subbandset);
574 lbs_deb_11d("domain info resp: nr_subband %d\n", nr_subband);
576 if (nr_subband > MRVDRV_MAX_SUBBAND_802_11D) {
577 lbs_deb_11d("Invalid Numrer of Subband returned!!\n");
582 case CMD_ACT_SET: /*Proc Set action */
588 lbs_deb_11d("Invalid action:%d\n", domaininfo->action);
593 lbs_deb_leave_args(LBS_DEB_11D, "ret %d", ret);
598 * @brief This function parses countryinfo from AP and download country info to FW
599 * @param priv pointer to struct lbs_private
602 int lbs_parse_dnld_countryinfo_11d(struct lbs_private *priv,
603 struct bss_descriptor * bss)
607 lbs_deb_enter(LBS_DEB_11D);
608 if (priv->enable11d) {
609 memset(&priv->parsed_region_chan, 0,
610 sizeof(struct parsed_region_chan_11d));
611 ret = parse_domain_info_11d(&bss->countryinfo, 0,
612 &priv->parsed_region_chan);
615 lbs_deb_11d("error parsing domain_info from AP\n");
619 memset(&priv->domainreg, 0,
620 sizeof(struct lbs_802_11d_domain_reg));
621 generate_domain_info_11d(&priv->parsed_region_chan,
624 ret = set_domain_info_11d(priv);
627 lbs_deb_11d("error setting domain info\n");
634 lbs_deb_leave_args(LBS_DEB_11D, "ret %d", ret);
639 * @brief This function generates 11D info from user specified regioncode and download to FW
640 * @param priv pointer to struct lbs_private
643 int lbs_create_dnld_countryinfo_11d(struct lbs_private *priv)
646 struct region_channel *region_chan;
649 lbs_deb_enter(LBS_DEB_11D);
650 lbs_deb_11d("curbssparams.band %d\n", priv->curbssparams.band);
652 if (priv->enable11d) {
653 /* update parsed_region_chan_11; dnld domaininf to FW */
655 for (j = 0; j < ARRAY_SIZE(priv->region_channel); j++) {
656 region_chan = &priv->region_channel[j];
658 lbs_deb_11d("%d region_chan->band %d\n", j,
661 if (!region_chan || !region_chan->valid
662 || !region_chan->CFP)
664 if (region_chan->band != priv->curbssparams.band)
669 if (j >= ARRAY_SIZE(priv->region_channel)) {
670 lbs_deb_11d("region_chan not found, band %d\n",
671 priv->curbssparams.band);
676 memset(&priv->parsed_region_chan, 0,
677 sizeof(struct parsed_region_chan_11d));
678 lbs_generate_parsed_region_chan_11d(region_chan,
682 memset(&priv->domainreg, 0,
683 sizeof(struct lbs_802_11d_domain_reg));
684 generate_domain_info_11d(&priv->parsed_region_chan,
687 ret = set_domain_info_11d(priv);
690 lbs_deb_11d("error setting domain info\n");
698 lbs_deb_leave_args(LBS_DEB_11D, "ret %d", ret);