d4087a0b28f89771c942ec093aff51f1a3314480
[openwrt.git] / package / mac80211 / patches / 512-ath9k_channelbw_debugfs.patch
1 --- a/drivers/net/wireless/ath/ath9k/ath9k.h
2 +++ b/drivers/net/wireless/ath/ath9k/ath9k.h
3 @@ -659,6 +659,7 @@ struct ath_softc {
4         struct ieee80211_hw *hw;
5         struct device *dev;
6  
7 +       u32 chan_bw;
8         struct survey_info *cur_survey;
9         struct survey_info survey[ATH9K_NUM_CHANNELS];
10  
11 @@ -734,6 +735,7 @@ struct ath_softc {
12  #endif
13  };
14  
15 +int ath9k_config(struct ieee80211_hw *hw, u32 changed);
16  void ath9k_tasklet(unsigned long data);
17  int ath_cabq_update(struct ath_softc *);
18  
19 --- a/drivers/net/wireless/ath/ath9k/debug.c
20 +++ b/drivers/net/wireless/ath/ath9k/debug.c
21 @@ -1579,6 +1579,50 @@ static const struct file_operations fops
22         .owner = THIS_MODULE
23  };
24  
25 +
26 +static ssize_t read_file_chan_bw(struct file *file, char __user *user_buf,
27 +                            size_t count, loff_t *ppos)
28 +{
29 +       struct ath_softc *sc = file->private_data;
30 +       char buf[32];
31 +       unsigned int len;
32 +
33 +       len = sprintf(buf, "0x%08x\n", sc->chan_bw);
34 +       return simple_read_from_buffer(user_buf, count, ppos, buf, len);
35 +}
36 +
37 +static ssize_t write_file_chan_bw(struct file *file, const char __user *user_buf,
38 +                            size_t count, loff_t *ppos)
39 +{
40 +       struct ath_softc *sc = file->private_data;
41 +       unsigned long chan_bw;
42 +       char buf[32];
43 +       ssize_t len;
44 +
45 +       len = min(count, sizeof(buf) - 1);
46 +       if (copy_from_user(buf, user_buf, len))
47 +               return -EFAULT;
48 +
49 +       buf[len] = '\0';
50 +       if (strict_strtoul(buf, 0, &chan_bw))
51 +               return -EINVAL;
52 +
53 +       sc->chan_bw = chan_bw;
54 +       if (!(sc->sc_flags & SC_OP_INVALID))
55 +               ath9k_config(sc->hw, IEEE80211_CONF_CHANGE_CHANNEL);
56 +
57 +       return count;
58 +}
59 +
60 +static const struct file_operations fops_chanbw = {
61 +       .read = read_file_chan_bw,
62 +       .write = write_file_chan_bw,
63 +       .open = simple_open,
64 +       .owner = THIS_MODULE,
65 +       .llseek = default_llseek,
66 +};
67 +
68 +
69  int ath9k_init_debug(struct ath_hw *ah)
70  {
71         struct ath_common *common = ath9k_hw_common(ah);
72 @@ -1653,5 +1697,8 @@ int ath9k_init_debug(struct ath_hw *ah)
73         debugfs_create_file("eeprom", S_IRUSR, sc->debug.debugfs_phy, sc,
74                             &fops_eeprom);
75  
76 +       debugfs_create_file("chanbw", S_IRUSR | S_IWUSR, sc->debug.debugfs_phy,
77 +                           sc, &fops_chanbw);
78 +
79         return 0;
80  }
81 --- a/drivers/net/wireless/ath/ath9k/main.c
82 +++ b/drivers/net/wireless/ath/ath9k/main.c
83 @@ -1127,7 +1127,7 @@ static void ath9k_disable_ps(struct ath_
84         ath_dbg(common, PS, "PowerSave disabled\n");
85  }
86  
87 -static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
88 +int ath9k_config(struct ieee80211_hw *hw, u32 changed)
89  {
90         struct ath_softc *sc = hw->priv;
91         struct ath_hw *ah = sc->sc_ah;
92 @@ -1181,9 +1181,11 @@ static int ath9k_config(struct ieee80211
93  
94         if ((changed & IEEE80211_CONF_CHANGE_CHANNEL) || reset_channel) {
95                 struct ieee80211_channel *curchan = hw->conf.channel;
96 +               struct ath9k_channel *hchan;
97                 int pos = curchan->hw_value;
98                 int old_pos = -1;
99                 unsigned long flags;
100 +               u32 oldflags;
101  
102                 if (ah->curchan)
103                         old_pos = ah->curchan - &ah->channels[0];
104 @@ -1226,7 +1228,23 @@ static int ath9k_config(struct ieee80211
105                         memset(&sc->survey[pos], 0, sizeof(struct survey_info));
106                 }
107  
108 -               if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
109 +               hchan = &sc->sc_ah->channels[pos];
110 +               oldflags = hchan->channelFlags;
111 +               switch (sc->chan_bw) {
112 +               case 5:
113 +                       hchan->channelFlags &= ~CHANNEL_HALF;
114 +                       hchan->channelFlags |= CHANNEL_QUARTER;
115 +                       break;
116 +               case 10:
117 +                       hchan->channelFlags &= ~CHANNEL_QUARTER;
118 +                       hchan->channelFlags |= CHANNEL_HALF;
119 +                       break;
120 +               default:
121 +                       hchan->channelFlags &= ~(CHANNEL_HALF | CHANNEL_QUARTER);
122 +                       break;
123 +               }
124 +
125 +               if (ath_set_channel(sc, hw, hchan) < 0) {
126                         ath_err(common, "Unable to set channel\n");
127                         mutex_unlock(&sc->mutex);
128                         ath9k_ps_restore(sc);