1 /******************************************************************************
2 *
3 * Copyright(c) 2003 - 2013 Intel Corporation. All rights reserved.
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 *****************************************************************************/
28 #include <linux/delay.h>
29 #include <linux/device.h>
30 #include <linux/export.h>
31
32 #include "iwl-drv.h"
33 #include "iwl-io.h"
34 #include "iwl-csr.h"
35 #include "iwl-debug.h"
36
37 #define IWL_POLL_INTERVAL 10 /* microseconds */
38
iwl_poll_bit(struct iwl_trans * trans,u32 addr,u32 bits,u32 mask,int timeout)39 int iwl_poll_bit(struct iwl_trans *trans, u32 addr,
40 u32 bits, u32 mask, int timeout)
41 {
42 int t = 0;
43
44 do {
45 if ((iwl_read32(trans, addr) & mask) == (bits & mask))
46 return t;
47 udelay(IWL_POLL_INTERVAL);
48 t += IWL_POLL_INTERVAL;
49 } while (t < timeout);
50
51 return -ETIMEDOUT;
52 }
53 IWL_EXPORT_SYMBOL(iwl_poll_bit);
54
iwl_read_direct32(struct iwl_trans * trans,u32 reg)55 u32 iwl_read_direct32(struct iwl_trans *trans, u32 reg)
56 {
57 u32 value = 0x5a5a5a5a;
58 unsigned long flags;
59 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
60 value = iwl_read32(trans, reg);
61 iwl_trans_release_nic_access(trans, &flags);
62 }
63
64 return value;
65 }
66 IWL_EXPORT_SYMBOL(iwl_read_direct32);
67
iwl_write_direct32(struct iwl_trans * trans,u32 reg,u32 value)68 void iwl_write_direct32(struct iwl_trans *trans, u32 reg, u32 value)
69 {
70 unsigned long flags;
71
72 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
73 iwl_write32(trans, reg, value);
74 iwl_trans_release_nic_access(trans, &flags);
75 }
76 }
77 IWL_EXPORT_SYMBOL(iwl_write_direct32);
78
iwl_poll_direct_bit(struct iwl_trans * trans,u32 addr,u32 mask,int timeout)79 int iwl_poll_direct_bit(struct iwl_trans *trans, u32 addr, u32 mask,
80 int timeout)
81 {
82 int t = 0;
83
84 do {
85 if ((iwl_read_direct32(trans, addr) & mask) == mask)
86 return t;
87 udelay(IWL_POLL_INTERVAL);
88 t += IWL_POLL_INTERVAL;
89 } while (t < timeout);
90
91 return -ETIMEDOUT;
92 }
93 IWL_EXPORT_SYMBOL(iwl_poll_direct_bit);
94
__iwl_read_prph(struct iwl_trans * trans,u32 ofs)95 static inline u32 __iwl_read_prph(struct iwl_trans *trans, u32 ofs)
96 {
97 u32 val = iwl_trans_read_prph(trans, ofs);
98 trace_iwlwifi_dev_ioread_prph32(trans->dev, ofs, val);
99 return val;
100 }
101
__iwl_write_prph(struct iwl_trans * trans,u32 ofs,u32 val)102 static inline void __iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
103 {
104 trace_iwlwifi_dev_iowrite_prph32(trans->dev, ofs, val);
105 iwl_trans_write_prph(trans, ofs, val);
106 }
107
iwl_read_prph(struct iwl_trans * trans,u32 ofs)108 u32 iwl_read_prph(struct iwl_trans *trans, u32 ofs)
109 {
110 unsigned long flags;
111 u32 val = 0x5a5a5a5a;
112
113 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
114 val = __iwl_read_prph(trans, ofs);
115 iwl_trans_release_nic_access(trans, &flags);
116 }
117 return val;
118 }
119 IWL_EXPORT_SYMBOL(iwl_read_prph);
120
iwl_write_prph(struct iwl_trans * trans,u32 ofs,u32 val)121 void iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
122 {
123 unsigned long flags;
124
125 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
126 __iwl_write_prph(trans, ofs, val);
127 iwl_trans_release_nic_access(trans, &flags);
128 }
129 }
130 IWL_EXPORT_SYMBOL(iwl_write_prph);
131
iwl_set_bits_prph(struct iwl_trans * trans,u32 ofs,u32 mask)132 void iwl_set_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
133 {
134 unsigned long flags;
135
136 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
137 __iwl_write_prph(trans, ofs,
138 __iwl_read_prph(trans, ofs) | mask);
139 iwl_trans_release_nic_access(trans, &flags);
140 }
141 }
142 IWL_EXPORT_SYMBOL(iwl_set_bits_prph);
143
iwl_set_bits_mask_prph(struct iwl_trans * trans,u32 ofs,u32 bits,u32 mask)144 void iwl_set_bits_mask_prph(struct iwl_trans *trans, u32 ofs,
145 u32 bits, u32 mask)
146 {
147 unsigned long flags;
148
149 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
150 __iwl_write_prph(trans, ofs,
151 (__iwl_read_prph(trans, ofs) & mask) | bits);
152 iwl_trans_release_nic_access(trans, &flags);
153 }
154 }
155 IWL_EXPORT_SYMBOL(iwl_set_bits_mask_prph);
156
iwl_clear_bits_prph(struct iwl_trans * trans,u32 ofs,u32 mask)157 void iwl_clear_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
158 {
159 unsigned long flags;
160 u32 val;
161
162 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
163 val = __iwl_read_prph(trans, ofs);
164 __iwl_write_prph(trans, ofs, (val & ~mask));
165 iwl_trans_release_nic_access(trans, &flags);
166 }
167 }
168 IWL_EXPORT_SYMBOL(iwl_clear_bits_prph);
169