Commit | Line | Data |
---|---|---|
02a7fa00 JB |
1 | /****************************************************************************** |
2 | * | |
4e318262 | 3 | * Copyright(c) 2003 - 2012 Intel Corporation. All rights reserved. |
02a7fa00 JB |
4 | * |
5 | * Portions of this file are derived from the ipw3945 project. | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify it | |
8 | * under the terms of version 2 of the GNU General Public License as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
12 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
13 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
14 | * more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License along with | |
17 | * this program; if not, write to the Free Software Foundation, Inc., | |
18 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA | |
19 | * | |
20 | * The full GNU General Public License is included in this distribution in the | |
21 | * file called LICENSE. | |
22 | * | |
23 | * Contact Information: | |
24 | * Intel Linux Wireless <ilw@linux.intel.com> | |
25 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
26 | * | |
27 | *****************************************************************************/ | |
83ed9015 EG |
28 | #include <linux/delay.h> |
29 | #include <linux/device.h> | |
cc5f7e39 | 30 | #include <linux/export.h> |
02a7fa00 JB |
31 | |
32 | #include "iwl-io.h" | |
6ac7d115 | 33 | #include "iwl-csr.h" |
83ed9015 | 34 | #include "iwl-debug.h" |
02a7fa00 JB |
35 | |
36 | #define IWL_POLL_INTERVAL 10 /* microseconds */ | |
37 | ||
7a65d170 | 38 | void __iwl_set_bit(struct iwl_trans *trans, u32 reg, u32 mask) |
02a7fa00 | 39 | { |
1042db2a | 40 | iwl_write32(trans, reg, iwl_read32(trans, reg) | mask); |
02a7fa00 JB |
41 | } |
42 | ||
7a65d170 | 43 | void __iwl_clear_bit(struct iwl_trans *trans, u32 reg, u32 mask) |
02a7fa00 | 44 | { |
1042db2a | 45 | iwl_write32(trans, reg, iwl_read32(trans, reg) & ~mask); |
02a7fa00 JB |
46 | } |
47 | ||
1042db2a | 48 | void iwl_set_bit(struct iwl_trans *trans, u32 reg, u32 mask) |
02a7fa00 JB |
49 | { |
50 | unsigned long flags; | |
51 | ||
1042db2a EG |
52 | spin_lock_irqsave(&trans->reg_lock, flags); |
53 | __iwl_set_bit(trans, reg, mask); | |
54 | spin_unlock_irqrestore(&trans->reg_lock, flags); | |
02a7fa00 | 55 | } |
cc5f7e39 | 56 | EXPORT_SYMBOL_GPL(iwl_set_bit); |
02a7fa00 | 57 | |
1042db2a | 58 | void iwl_clear_bit(struct iwl_trans *trans, u32 reg, u32 mask) |
02a7fa00 JB |
59 | { |
60 | unsigned long flags; | |
61 | ||
1042db2a EG |
62 | spin_lock_irqsave(&trans->reg_lock, flags); |
63 | __iwl_clear_bit(trans, reg, mask); | |
64 | spin_unlock_irqrestore(&trans->reg_lock, flags); | |
02a7fa00 | 65 | } |
cc5f7e39 | 66 | EXPORT_SYMBOL_GPL(iwl_clear_bit); |
02a7fa00 | 67 | |
2baa2e57 JB |
68 | void iwl_set_bits_mask(struct iwl_trans *trans, u32 reg, u32 mask, u32 value) |
69 | { | |
70 | unsigned long flags; | |
71 | u32 v; | |
72 | ||
73 | #ifdef CONFIG_IWLWIFI_DEBUG | |
74 | WARN_ON_ONCE(value & ~mask); | |
75 | #endif | |
76 | ||
77 | spin_lock_irqsave(&trans->reg_lock, flags); | |
78 | v = iwl_read32(trans, reg); | |
79 | v &= ~mask; | |
80 | v |= value; | |
81 | iwl_write32(trans, reg, v); | |
82 | spin_unlock_irqrestore(&trans->reg_lock, flags); | |
83 | } | |
84 | EXPORT_SYMBOL_GPL(iwl_set_bits_mask); | |
85 | ||
1042db2a | 86 | int iwl_poll_bit(struct iwl_trans *trans, u32 addr, |
02a7fa00 JB |
87 | u32 bits, u32 mask, int timeout) |
88 | { | |
89 | int t = 0; | |
90 | ||
91 | do { | |
1042db2a | 92 | if ((iwl_read32(trans, addr) & mask) == (bits & mask)) |
02a7fa00 JB |
93 | return t; |
94 | udelay(IWL_POLL_INTERVAL); | |
95 | t += IWL_POLL_INTERVAL; | |
96 | } while (t < timeout); | |
97 | ||
98 | return -ETIMEDOUT; | |
99 | } | |
cc5f7e39 | 100 | EXPORT_SYMBOL_GPL(iwl_poll_bit); |
02a7fa00 | 101 | |
1042db2a | 102 | u32 iwl_read_direct32(struct iwl_trans *trans, u32 reg) |
02a7fa00 JB |
103 | { |
104 | u32 value; | |
105 | unsigned long flags; | |
106 | ||
1042db2a | 107 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 108 | iwl_trans_grab_nic_access(trans, false); |
1042db2a | 109 | value = iwl_read32(trans, reg); |
7a65d170 | 110 | iwl_trans_release_nic_access(trans); |
1042db2a | 111 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 JB |
112 | |
113 | return value; | |
114 | } | |
cc5f7e39 | 115 | EXPORT_SYMBOL_GPL(iwl_read_direct32); |
02a7fa00 | 116 | |
1042db2a | 117 | void iwl_write_direct32(struct iwl_trans *trans, u32 reg, u32 value) |
02a7fa00 JB |
118 | { |
119 | unsigned long flags; | |
120 | ||
1042db2a | 121 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 122 | if (likely(iwl_trans_grab_nic_access(trans, false))) { |
1042db2a | 123 | iwl_write32(trans, reg, value); |
7a65d170 | 124 | iwl_trans_release_nic_access(trans); |
02a7fa00 | 125 | } |
1042db2a | 126 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 | 127 | } |
cc5f7e39 | 128 | EXPORT_SYMBOL_GPL(iwl_write_direct32); |
02a7fa00 | 129 | |
1042db2a | 130 | int iwl_poll_direct_bit(struct iwl_trans *trans, u32 addr, u32 mask, |
02a7fa00 JB |
131 | int timeout) |
132 | { | |
133 | int t = 0; | |
134 | ||
135 | do { | |
1042db2a | 136 | if ((iwl_read_direct32(trans, addr) & mask) == mask) |
02a7fa00 JB |
137 | return t; |
138 | udelay(IWL_POLL_INTERVAL); | |
139 | t += IWL_POLL_INTERVAL; | |
140 | } while (t < timeout); | |
141 | ||
142 | return -ETIMEDOUT; | |
143 | } | |
cc5f7e39 | 144 | EXPORT_SYMBOL_GPL(iwl_poll_direct_bit); |
02a7fa00 | 145 | |
6a06b6c1 | 146 | static inline u32 __iwl_read_prph(struct iwl_trans *trans, u32 ofs) |
02a7fa00 | 147 | { |
6a06b6c1 EG |
148 | u32 val = iwl_trans_read_prph(trans, ofs); |
149 | trace_iwlwifi_dev_ioread_prph32(trans->dev, ofs, val); | |
150 | return val; | |
02a7fa00 JB |
151 | } |
152 | ||
6a06b6c1 | 153 | static inline void __iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val) |
02a7fa00 | 154 | { |
6a06b6c1 EG |
155 | trace_iwlwifi_dev_iowrite_prph32(trans->dev, ofs, val); |
156 | iwl_trans_write_prph(trans, ofs, val); | |
02a7fa00 JB |
157 | } |
158 | ||
6a06b6c1 | 159 | u32 iwl_read_prph(struct iwl_trans *trans, u32 ofs) |
02a7fa00 JB |
160 | { |
161 | unsigned long flags; | |
162 | u32 val; | |
163 | ||
1042db2a | 164 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 165 | iwl_trans_grab_nic_access(trans, false); |
6a06b6c1 | 166 | val = __iwl_read_prph(trans, ofs); |
7a65d170 | 167 | iwl_trans_release_nic_access(trans); |
1042db2a | 168 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 JB |
169 | return val; |
170 | } | |
cc5f7e39 | 171 | EXPORT_SYMBOL_GPL(iwl_read_prph); |
02a7fa00 | 172 | |
6a06b6c1 | 173 | void iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val) |
02a7fa00 JB |
174 | { |
175 | unsigned long flags; | |
176 | ||
1042db2a | 177 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 178 | if (likely(iwl_trans_grab_nic_access(trans, false))) { |
6a06b6c1 | 179 | __iwl_write_prph(trans, ofs, val); |
7a65d170 | 180 | iwl_trans_release_nic_access(trans); |
02a7fa00 | 181 | } |
1042db2a | 182 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 | 183 | } |
cc5f7e39 | 184 | EXPORT_SYMBOL_GPL(iwl_write_prph); |
02a7fa00 | 185 | |
6a06b6c1 | 186 | void iwl_set_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask) |
02a7fa00 JB |
187 | { |
188 | unsigned long flags; | |
189 | ||
1042db2a | 190 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 191 | if (likely(iwl_trans_grab_nic_access(trans, false))) { |
6a06b6c1 EG |
192 | __iwl_write_prph(trans, ofs, |
193 | __iwl_read_prph(trans, ofs) | mask); | |
7a65d170 | 194 | iwl_trans_release_nic_access(trans); |
bfe4b80e | 195 | } |
1042db2a | 196 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 | 197 | } |
cc5f7e39 | 198 | EXPORT_SYMBOL_GPL(iwl_set_bits_prph); |
02a7fa00 | 199 | |
6a06b6c1 | 200 | void iwl_set_bits_mask_prph(struct iwl_trans *trans, u32 ofs, |
02a7fa00 JB |
201 | u32 bits, u32 mask) |
202 | { | |
203 | unsigned long flags; | |
204 | ||
1042db2a | 205 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 206 | if (likely(iwl_trans_grab_nic_access(trans, false))) { |
6a06b6c1 EG |
207 | __iwl_write_prph(trans, ofs, |
208 | (__iwl_read_prph(trans, ofs) & mask) | bits); | |
7a65d170 | 209 | iwl_trans_release_nic_access(trans); |
bfe4b80e | 210 | } |
1042db2a | 211 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 | 212 | } |
cc5f7e39 | 213 | EXPORT_SYMBOL_GPL(iwl_set_bits_mask_prph); |
02a7fa00 | 214 | |
6a06b6c1 | 215 | void iwl_clear_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask) |
02a7fa00 JB |
216 | { |
217 | unsigned long flags; | |
218 | u32 val; | |
219 | ||
1042db2a | 220 | spin_lock_irqsave(&trans->reg_lock, flags); |
7a65d170 | 221 | if (likely(iwl_trans_grab_nic_access(trans, false))) { |
6a06b6c1 EG |
222 | val = __iwl_read_prph(trans, ofs); |
223 | __iwl_write_prph(trans, ofs, (val & ~mask)); | |
7a65d170 | 224 | iwl_trans_release_nic_access(trans); |
bfe4b80e | 225 | } |
1042db2a | 226 | spin_unlock_irqrestore(&trans->reg_lock, flags); |
02a7fa00 | 227 | } |
cc5f7e39 | 228 | EXPORT_SYMBOL_GPL(iwl_clear_bits_prph); |