1e691ac2fSRafał Miłecki /*
2e691ac2fSRafał Miłecki * Copyright (C) 2017 Rafał Miłecki <rafal@milecki.pl>
3e691ac2fSRafał Miłecki *
4e691ac2fSRafał Miłecki * Permission to use, copy, modify, and/or distribute this software for any
5e691ac2fSRafał Miłecki * purpose with or without fee is hereby granted, provided that the above
6e691ac2fSRafał Miłecki * copyright notice and this permission notice appear in all copies.
7e691ac2fSRafał Miłecki *
8e691ac2fSRafał Miłecki * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9e691ac2fSRafał Miłecki * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10e691ac2fSRafał Miłecki * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11e691ac2fSRafał Miłecki * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12e691ac2fSRafał Miłecki * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13e691ac2fSRafał Miłecki * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14e691ac2fSRafał Miłecki * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15e691ac2fSRafał Miłecki */
16e691ac2fSRafał Miłecki
17e691ac2fSRafał Miłecki #include <linux/of.h>
18e691ac2fSRafał Miłecki #include <net/cfg80211.h>
19e691ac2fSRafał Miłecki #include "core.h"
20e691ac2fSRafał Miłecki
wiphy_freq_limits_valid_chan(struct wiphy * wiphy,struct ieee80211_freq_range * freq_limits,unsigned int n_freq_limits,struct ieee80211_channel * chan)21e691ac2fSRafał Miłecki static bool wiphy_freq_limits_valid_chan(struct wiphy *wiphy,
22e691ac2fSRafał Miłecki struct ieee80211_freq_range *freq_limits,
23e691ac2fSRafał Miłecki unsigned int n_freq_limits,
24e691ac2fSRafał Miłecki struct ieee80211_channel *chan)
25e691ac2fSRafał Miłecki {
26e691ac2fSRafał Miłecki u32 bw = MHZ_TO_KHZ(20);
27e691ac2fSRafał Miłecki int i;
28e691ac2fSRafał Miłecki
29e691ac2fSRafał Miłecki for (i = 0; i < n_freq_limits; i++) {
30e691ac2fSRafał Miłecki struct ieee80211_freq_range *limit = &freq_limits[i];
31e691ac2fSRafał Miłecki
32e691ac2fSRafał Miłecki if (cfg80211_does_bw_fit_range(limit,
33e691ac2fSRafał Miłecki MHZ_TO_KHZ(chan->center_freq),
34e691ac2fSRafał Miłecki bw))
35e691ac2fSRafał Miłecki return true;
36e691ac2fSRafał Miłecki }
37e691ac2fSRafał Miłecki
38e691ac2fSRafał Miłecki return false;
39e691ac2fSRafał Miłecki }
40e691ac2fSRafał Miłecki
wiphy_freq_limits_apply(struct wiphy * wiphy,struct ieee80211_freq_range * freq_limits,unsigned int n_freq_limits)41e691ac2fSRafał Miłecki static void wiphy_freq_limits_apply(struct wiphy *wiphy,
42e691ac2fSRafał Miłecki struct ieee80211_freq_range *freq_limits,
43e691ac2fSRafał Miłecki unsigned int n_freq_limits)
44e691ac2fSRafał Miłecki {
45e691ac2fSRafał Miłecki enum nl80211_band band;
46e691ac2fSRafał Miłecki int i;
47e691ac2fSRafał Miłecki
48e691ac2fSRafał Miłecki if (WARN_ON(!n_freq_limits))
49e691ac2fSRafał Miłecki return;
50e691ac2fSRafał Miłecki
51e691ac2fSRafał Miłecki for (band = 0; band < NUM_NL80211_BANDS; band++) {
52e691ac2fSRafał Miłecki struct ieee80211_supported_band *sband = wiphy->bands[band];
53e691ac2fSRafał Miłecki
54e691ac2fSRafał Miłecki if (!sband)
55e691ac2fSRafał Miłecki continue;
56e691ac2fSRafał Miłecki
57e691ac2fSRafał Miłecki for (i = 0; i < sband->n_channels; i++) {
58e691ac2fSRafał Miłecki struct ieee80211_channel *chan = &sband->channels[i];
59e691ac2fSRafał Miłecki
60e691ac2fSRafał Miłecki if (chan->flags & IEEE80211_CHAN_DISABLED)
61e691ac2fSRafał Miłecki continue;
62e691ac2fSRafał Miłecki
63e691ac2fSRafał Miłecki if (!wiphy_freq_limits_valid_chan(wiphy, freq_limits,
64e691ac2fSRafał Miłecki n_freq_limits,
65e691ac2fSRafał Miłecki chan)) {
66e691ac2fSRafał Miłecki pr_debug("Disabling freq %d MHz as it's out of OF limits\n",
67e691ac2fSRafał Miłecki chan->center_freq);
68e691ac2fSRafał Miłecki chan->flags |= IEEE80211_CHAN_DISABLED;
69e691ac2fSRafał Miłecki }
70e691ac2fSRafał Miłecki }
71e691ac2fSRafał Miłecki }
72e691ac2fSRafał Miłecki }
73e691ac2fSRafał Miłecki
wiphy_read_of_freq_limits(struct wiphy * wiphy)74e691ac2fSRafał Miłecki void wiphy_read_of_freq_limits(struct wiphy *wiphy)
75e691ac2fSRafał Miłecki {
76e691ac2fSRafał Miłecki struct device *dev = wiphy_dev(wiphy);
77e691ac2fSRafał Miłecki struct device_node *np;
78e691ac2fSRafał Miłecki struct property *prop;
79e691ac2fSRafał Miłecki struct ieee80211_freq_range *freq_limits;
80e691ac2fSRafał Miłecki unsigned int n_freq_limits;
81e691ac2fSRafał Miłecki const __be32 *p;
82e691ac2fSRafał Miłecki int len, i;
83e691ac2fSRafał Miłecki int err = 0;
84e691ac2fSRafał Miłecki
85e691ac2fSRafał Miłecki if (!dev)
86e691ac2fSRafał Miłecki return;
87e691ac2fSRafał Miłecki np = dev_of_node(dev);
88e691ac2fSRafał Miłecki if (!np)
89e691ac2fSRafał Miłecki return;
90e691ac2fSRafał Miłecki
91e691ac2fSRafał Miłecki prop = of_find_property(np, "ieee80211-freq-limit", &len);
92e691ac2fSRafał Miłecki if (!prop)
93e691ac2fSRafał Miłecki return;
94e691ac2fSRafał Miłecki
95e691ac2fSRafał Miłecki if (!len || len % sizeof(u32) || len / sizeof(u32) % 2) {
96e691ac2fSRafał Miłecki dev_err(dev, "ieee80211-freq-limit wrong format");
97e691ac2fSRafał Miłecki return;
98e691ac2fSRafał Miłecki }
99e691ac2fSRafał Miłecki n_freq_limits = len / sizeof(u32) / 2;
100e691ac2fSRafał Miłecki
101e691ac2fSRafał Miłecki freq_limits = kcalloc(n_freq_limits, sizeof(*freq_limits), GFP_KERNEL);
102e691ac2fSRafał Miłecki if (!freq_limits) {
103e691ac2fSRafał Miłecki err = -ENOMEM;
104e691ac2fSRafał Miłecki goto out_kfree;
105e691ac2fSRafał Miłecki }
106e691ac2fSRafał Miłecki
107e691ac2fSRafał Miłecki p = NULL;
108e691ac2fSRafał Miłecki for (i = 0; i < n_freq_limits; i++) {
109e691ac2fSRafał Miłecki struct ieee80211_freq_range *limit = &freq_limits[i];
110e691ac2fSRafał Miłecki
111e691ac2fSRafał Miłecki p = of_prop_next_u32(prop, p, &limit->start_freq_khz);
112e691ac2fSRafał Miłecki if (!p) {
113e691ac2fSRafał Miłecki err = -EINVAL;
114e691ac2fSRafał Miłecki goto out_kfree;
115e691ac2fSRafał Miłecki }
116e691ac2fSRafał Miłecki
117e691ac2fSRafał Miłecki p = of_prop_next_u32(prop, p, &limit->end_freq_khz);
118e691ac2fSRafał Miłecki if (!p) {
119e691ac2fSRafał Miłecki err = -EINVAL;
120e691ac2fSRafał Miłecki goto out_kfree;
121e691ac2fSRafał Miłecki }
122e691ac2fSRafał Miłecki
123e691ac2fSRafał Miłecki if (!limit->start_freq_khz ||
124e691ac2fSRafał Miłecki !limit->end_freq_khz ||
125e691ac2fSRafał Miłecki limit->start_freq_khz >= limit->end_freq_khz) {
126e691ac2fSRafał Miłecki err = -EINVAL;
127e691ac2fSRafał Miłecki goto out_kfree;
128e691ac2fSRafał Miłecki }
129e691ac2fSRafał Miłecki }
130e691ac2fSRafał Miłecki
131e691ac2fSRafał Miłecki wiphy_freq_limits_apply(wiphy, freq_limits, n_freq_limits);
132e691ac2fSRafał Miłecki
133e691ac2fSRafał Miłecki out_kfree:
134e691ac2fSRafał Miłecki kfree(freq_limits);
135e691ac2fSRafał Miłecki if (err)
136e691ac2fSRafał Miłecki dev_err(dev, "Failed to get limits: %d\n", err);
137e691ac2fSRafał Miłecki }
138e691ac2fSRafał Miłecki EXPORT_SYMBOL(wiphy_read_of_freq_limits);
139