p2p_utils.c revision 44c957860ca714a86357591f39aff0bfa904c743
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * P2P - generic helper functions 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009, Atheros Communications 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 5c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * This software may be distributed under the terms of the BSD license. 6c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * See README for more details. 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "p2p_i.h" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * p2p_random - Generate random string for SSID and passphrase 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf: Buffer for returning the result 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Number of octets to write to the buffer 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, -1 on failure 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function generates a random string using the following character set: 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 'A'-'Z', 'a'-'z', '0'-'9'. 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint p2p_random(char *buf, size_t len) 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 val; 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 letters = 'Z' - 'A' + 1; 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 numbers = 10; 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_get_random((unsigned char *) buf, len)) 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Character set: 'A'-'Z', 'a'-'z', '0'-'9' */ 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < len; i++) { 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = buf[i]; 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val %= 2 * letters + numbers; 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (val < letters) 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[i] = 'A' + val; 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (val < 2 * letters) 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[i] = 'a' + (val - letters); 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[i] = '0' + (val - 2 * letters); 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 494b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt/** 504b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt * p2p_channel_to_freq - Convert channel info to frequency 514b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt * @op_class: Operating class 524b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt * @channel: Channel number 534b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt * Returns: Frequency in MHz or -1 if the specified channel is unknown 544b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt */ 554b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidtint p2p_channel_to_freq(int op_class, int channel) 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 574b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt /* Table E-4 in IEEE Std 802.11-2012 - Global operating classes */ 584b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt /* TODO: more operating classes */ 594b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt switch (op_class) { 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 81: 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* channels 1..13 */ 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel < 1 || channel > 13) 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 2407 + 5 * channel; 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 82: 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* channel 14 */ 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel != 14) 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 2414 + 5 * channel; 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 83: /* channels 1..9; 40 MHz */ 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 84: /* channels 5..13; 40 MHz */ 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel < 1 || channel > 13) 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 2407 + 5 * channel; 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 115: /* channels 36,40,44,48; indoor only */ 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 118: /* channels 52,56,60,64; dfs */ 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel < 36 || channel > 64) 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 5000 + 5 * channel; 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 124: /* channels 149,153,157,161 */ 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 125: /* channels 149,153,157,161,165,169 */ 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel < 149 || channel > 161) 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 5000 + 5 * channel; 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 116: /* channels 36,44; 40 MHz; indoor only */ 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 117: /* channels 40,48; 40 MHz; indoor only */ 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 119: /* channels 52,60; 40 MHz; dfs */ 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 120: /* channels 56,64; 40 MHz; dfs */ 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel < 36 || channel > 64) 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 5000 + 5 * channel; 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 126: /* channels 149,157; 40 MHz */ 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 127: /* channels 153,161; 40 MHz */ 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (channel < 149 || channel > 161) 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 5000 + 5 * channel; 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * p2p_freq_to_channel - Convert frequency into channel info 1044b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt * @op_class: Buffer for returning operating class 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @channel: Buffer for returning channel number 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, -1 if the specified frequency is unknown 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1084b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidtint p2p_freq_to_channel(unsigned int freq, u8 *op_class, u8 *channel) 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO: more operating classes */ 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq >= 2412 && freq <= 2472) { 1124b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt *op_class = 81; /* 2.407 GHz, channels 1..13 */ 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *channel = (freq - 2407) / 5; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq == 2484) { 1184b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt *op_class = 82; /* channel 14 */ 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *channel = 14; 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq >= 5180 && freq <= 5240) { 1244b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt *op_class = 115; /* 5 GHz, channels 36..48 */ 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *channel = (freq - 5000) / 5; 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq >= 5745 && freq <= 5805) { 1304b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt *op_class = 124; /* 5 GHz, channels 149..161 */ 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *channel = (freq - 5000) / 5; 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void p2p_reg_class_intersect(const struct p2p_reg_class *a, 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_reg_class *b, 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_reg_class *res) 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i, j; 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->reg_class = a->reg_class; 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < a->channels; i++) { 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (j = 0; j < b->channels; j++) { 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (a->channel[i] != b->channel[j]) 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->channel[res->channels] = a->channel[i]; 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->channels++; 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res->channels == P2P_MAX_REG_CLASS_CHANNELS) 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * p2p_channels_intersect - Intersection of supported channel lists 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @a: First set of supported channels 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @b: Second set of supported channels 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @res: Data structure for returning the intersection of support channels 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function can be used to find a common set of supported channels. Both 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * input channels sets are assumed to use the same country code. If different 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * country codes are used, the regulatory class numbers may not be matched 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * correctly and results are undefined. 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_channels_intersect(const struct p2p_channels *a, 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_channels *b, 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_channels *res) 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i, j; 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(res, 0, sizeof(*res)); 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < a->reg_classes; i++) { 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_reg_class *a_reg = &a->reg_class[i]; 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (j = 0; j < b->reg_classes; j++) { 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_reg_class *b_reg = &b->reg_class[j]; 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (a_reg->reg_class != b_reg->reg_class) 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_reg_class_intersect( 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt a_reg, b_reg, 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &res->reg_class[res->reg_classes]); 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res->reg_class[res->reg_classes].channels) { 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->reg_classes++; 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res->reg_classes == P2P_MAX_REG_CLASSES) 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * p2p_channels_includes - Check whether a channel is included in the list 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @channels: List of supported channels 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @reg_class: Regulatory class of the channel to search 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @channel: Channel number of the channel to search 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 1 if channel was found or 0 if not 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint p2p_channels_includes(const struct p2p_channels *channels, u8 reg_class, 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 channel) 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i, j; 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < channels->reg_classes; i++) { 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_reg_class *reg = &channels->reg_class[i]; 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (reg->reg_class != reg_class) 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (j = 0; j < reg->channels; j++) { 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (reg->channel[j] == channel) 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 1; 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2227a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidtint p2p_channels_includes_freq(const struct p2p_channels *channels, 2237a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt unsigned int freq) 2247a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt{ 2257a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt size_t i, j; 2267a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt for (i = 0; i < channels->reg_classes; i++) { 2277a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt const struct p2p_reg_class *reg = &channels->reg_class[i]; 2287a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt for (j = 0; j < reg->channels; j++) { 2294b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt if (p2p_channel_to_freq(reg->reg_class, 2304b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt reg->channel[j]) == (int) freq) 2317a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt return 1; 2327a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt } 2337a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt } 2347a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt return 0; 2357a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt} 2367a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt 2377a5e50a0554bee77a9da492ea3d86f46147f1671Dmitry Shmidt 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint p2p_supported_freq(struct p2p_data *p2p, unsigned int freq) 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 op_reg_class, op_channel; 2414b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt if (p2p_freq_to_channel(freq, &op_reg_class, &op_channel) < 0) 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return p2p_channels_includes(&p2p->cfg->channels, op_reg_class, 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_channel); 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24644c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt 24744c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt 24844c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidtunsigned int p2p_get_pref_freq(struct p2p_data *p2p, 24944c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt const struct p2p_channels *channels) 25044c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt{ 25144c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt unsigned int i; 25244c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt int freq = 0; 25344c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt 25444c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt if (channels == NULL) { 25544c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt if (p2p->cfg->num_pref_chan) { 25644c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt freq = p2p_channel_to_freq( 25744c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt p2p->cfg->pref_chan[0].op_class, 25844c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt p2p->cfg->pref_chan[0].chan); 25944c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt if (freq < 0) 26044c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt freq = 0; 26144c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt } 26244c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt return freq; 26344c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt } 26444c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt 26544c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt for (i = 0; p2p->cfg->pref_chan && i < p2p->cfg->num_pref_chan; i++) { 26644c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt freq = p2p_channel_to_freq(p2p->cfg->pref_chan[i].op_class, 26744c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt p2p->cfg->pref_chan[i].chan); 26844c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt if (p2p_channels_includes_freq(channels, freq)) 26944c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt return freq; 27044c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt } 27144c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt 27244c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt return 0; 27344c957860ca714a86357591f39aff0bfa904c743Dmitry Shmidt} 274