2007-09-25 17:54:57 -07:00
|
|
|
/******************************************************************************
|
|
|
|
*
|
2009-01-08 11:20:02 -07:00
|
|
|
* Copyright(c) 2003 - 2009 Intel Corporation. All rights reserved.
|
2007-09-25 17:54:57 -07:00
|
|
|
*
|
|
|
|
* Portions of this file are derived from the ipw3945 project.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License along with
|
|
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
|
|
*
|
|
|
|
* The full GNU General Public License is included in this distribution in the
|
|
|
|
* file called LICENSE.
|
|
|
|
*
|
|
|
|
* Contact Information:
|
2008-12-09 12:28:58 -07:00
|
|
|
* Intel Linux Wireless <ilw@linux.intel.com>
|
2007-09-25 17:54:57 -07:00
|
|
|
* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
|
|
|
|
*
|
|
|
|
*****************************************************************************/
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
#ifndef __iwl_io_h__
|
|
|
|
#define __iwl_io_h__
|
2007-09-25 17:54:57 -07:00
|
|
|
|
|
|
|
#include <linux/io.h>
|
|
|
|
|
2008-03-12 16:58:49 -07:00
|
|
|
#include "iwl-debug.h"
|
2007-09-25 17:54:57 -07:00
|
|
|
|
|
|
|
/*
|
|
|
|
* IO, register, and NIC memory access functions
|
|
|
|
*
|
|
|
|
* NOTE on naming convention and macro usage for these
|
|
|
|
*
|
|
|
|
* A single _ prefix before a an access function means that no state
|
|
|
|
* check or debug information is printed when that function is called.
|
|
|
|
*
|
|
|
|
* A double __ prefix before an access function means that state is checked
|
2008-03-25 16:33:38 -07:00
|
|
|
* and the current line number and caller function name are printed in addition
|
|
|
|
* to any other debug output.
|
2007-09-25 17:54:57 -07:00
|
|
|
*
|
|
|
|
* The non-prefixed name is the #define that maps the caller into a
|
2008-03-25 16:33:38 -07:00
|
|
|
* #define that provides the caller's name and __LINE__ to the double
|
|
|
|
* prefix version.
|
2007-09-25 17:54:57 -07:00
|
|
|
*
|
|
|
|
* If you wish to call the function without any debug or state checking,
|
|
|
|
* you should use the single _ prefix version (as is used by dependent IO
|
2008-03-25 16:33:37 -07:00
|
|
|
* routines, for example _iwl_read_direct32 calls the non-check version of
|
|
|
|
* _iwl_read32.)
|
2007-09-25 17:54:57 -07:00
|
|
|
*
|
|
|
|
* These declarations are *extremely* useful in quickly isolating code deltas
|
2008-10-23 23:48:56 -07:00
|
|
|
* which result in misconfiguration of the hardware I/O. In combination with
|
2007-09-25 17:54:57 -07:00
|
|
|
* git-bisect and the IO debug level you can quickly determine the specific
|
|
|
|
* commit which breaks the IO sequence to the hardware.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
2008-09-02 20:26:34 -07:00
|
|
|
#define _iwl_write32(priv, ofs, val) iowrite32((val), (priv)->hw_base + (ofs))
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void __iwl_write32(const char *f, u32 l, struct iwl_priv *priv,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 ofs, u32 val)
|
|
|
|
{
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "write32(0x%08X, 0x%08X) - %s %d\n", ofs, val, f, l);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write32(priv, ofs, val);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_write32(priv, ofs, val) \
|
|
|
|
__iwl_write32(__FILE__, __LINE__, priv, ofs, val)
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_write32(priv, ofs, val) _iwl_write32(priv, ofs, val)
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-09-02 20:26:34 -07:00
|
|
|
#define _iwl_read32(priv, ofs) ioread32((priv)->hw_base + (ofs))
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline u32 __iwl_read32(char *f, u32 l, struct iwl_priv *priv, u32 ofs)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "read_direct32(0x%08X) - %s %d\n", ofs, f, l);
|
2008-03-25 16:33:37 -07:00
|
|
|
return _iwl_read32(priv, ofs);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_read32(priv, ofs) __iwl_read32(__FILE__, __LINE__, priv, ofs)
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_read32(p, o) _iwl_read32(p, o)
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-12-17 01:52:32 -07:00
|
|
|
#define IWL_POLL_INTERVAL 10 /* microseconds */
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline int _iwl_poll_bit(struct iwl_priv *priv, u32 addr,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 bits, u32 mask, int timeout)
|
|
|
|
{
|
2008-12-17 01:52:32 -07:00
|
|
|
int t = 0;
|
2007-09-25 17:54:57 -07:00
|
|
|
|
|
|
|
do {
|
2008-03-25 16:33:37 -07:00
|
|
|
if ((_iwl_read32(priv, addr) & mask) == (bits & mask))
|
2008-12-17 01:52:32 -07:00
|
|
|
return t;
|
|
|
|
udelay(IWL_POLL_INTERVAL);
|
|
|
|
t += IWL_POLL_INTERVAL;
|
|
|
|
} while (t < timeout);
|
2007-09-25 17:54:57 -07:00
|
|
|
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
}
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline int __iwl_poll_bit(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv, u32 addr,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 bits, u32 mask, int timeout)
|
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
int ret = _iwl_poll_bit(priv, addr, bits, mask, timeout);
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "poll_bit(0x%08X, 0x%08X, 0x%08X) - %s- %s %d\n",
|
2008-02-13 12:32:30 -07:00
|
|
|
addr, bits, mask,
|
2008-11-12 14:14:08 -07:00
|
|
|
unlikely(ret == -ETIMEDOUT) ? "timeout" : "", f, l);
|
2007-10-25 02:15:37 -07:00
|
|
|
return ret;
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_poll_bit(priv, addr, bits, mask, timeout) \
|
|
|
|
__iwl_poll_bit(__FILE__, __LINE__, priv, addr, bits, mask, timeout)
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_poll_bit(p, a, b, m, t) _iwl_poll_bit(p, a, b, m, t)
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void _iwl_set_bit(struct iwl_priv *priv, u32 reg, u32 mask)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write32(priv, reg, _iwl_read32(priv, reg) | mask);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void __iwl_set_bit(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv, u32 reg, u32 mask)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
u32 val = _iwl_read32(priv, reg) | mask;
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "set_bit(0x%08X, 0x%08X) = 0x%08X\n", reg, mask, val);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write32(priv, reg, val);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline void iwl_set_bit(struct iwl_priv *p, u32 r, u32 m)
|
|
|
|
{
|
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&p->reg_lock, reg_flags);
|
|
|
|
__iwl_set_bit(__FILE__, __LINE__, p, r, m);
|
|
|
|
spin_unlock_irqrestore(&p->reg_lock, reg_flags);
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline void iwl_set_bit(struct iwl_priv *p, u32 r, u32 m)
|
|
|
|
{
|
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&p->reg_lock, reg_flags);
|
|
|
|
_iwl_set_bit(p, r, m);
|
|
|
|
spin_unlock_irqrestore(&p->reg_lock, reg_flags);
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void _iwl_clear_bit(struct iwl_priv *priv, u32 reg, u32 mask)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write32(priv, reg, _iwl_read32(priv, reg) & ~mask);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void __iwl_clear_bit(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv, u32 reg, u32 mask)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
u32 val = _iwl_read32(priv, reg) & ~mask;
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "clear_bit(0x%08X, 0x%08X) = 0x%08X\n", reg, mask, val);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write32(priv, reg, val);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline void iwl_clear_bit(struct iwl_priv *p, u32 r, u32 m)
|
|
|
|
{
|
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&p->reg_lock, reg_flags);
|
|
|
|
__iwl_clear_bit(__FILE__, __LINE__, p, r, m);
|
|
|
|
spin_unlock_irqrestore(&p->reg_lock, reg_flags);
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline void iwl_clear_bit(struct iwl_priv *p, u32 r, u32 m)
|
|
|
|
{
|
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&p->reg_lock, reg_flags);
|
|
|
|
_iwl_clear_bit(p, r, m);
|
|
|
|
spin_unlock_irqrestore(&p->reg_lock, reg_flags);
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline int _iwl_grab_nic_access(struct iwl_priv *priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2007-10-25 02:15:37 -07:00
|
|
|
int ret;
|
2009-03-11 11:18:00 -07:00
|
|
|
u32 val;
|
2009-05-22 11:01:47 -07:00
|
|
|
|
2007-09-25 17:54:57 -07:00
|
|
|
/* this bit wakes up the NIC */
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_set_bit(priv, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
|
|
|
|
ret = _iwl_poll_bit(priv, CSR_GP_CNTRL,
|
2007-09-25 17:54:57 -07:00
|
|
|
CSR_GP_CNTRL_REG_VAL_MAC_ACCESS_EN,
|
|
|
|
(CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY |
|
2009-01-20 22:33:55 -07:00
|
|
|
CSR_GP_CNTRL_REG_FLAG_GOING_TO_SLEEP), 15000);
|
2007-10-25 02:15:37 -07:00
|
|
|
if (ret < 0) {
|
2009-03-11 11:18:00 -07:00
|
|
|
val = _iwl_read32(priv, CSR_GP_CNTRL);
|
|
|
|
IWL_ERR(priv, "MAC is in deep sleep!. CSR_GP_CNTRL = 0x%08X\n", val);
|
2009-05-22 11:01:47 -07:00
|
|
|
_iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_FORCE_NMI);
|
2007-09-25 17:54:57 -07:00
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline int __iwl_grab_nic_access(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "grabbing nic access - %s %d\n", f, l);
|
2008-03-25 16:33:37 -07:00
|
|
|
return _iwl_grab_nic_access(priv);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_grab_nic_access(priv) \
|
|
|
|
__iwl_grab_nic_access(__FILE__, __LINE__, priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_grab_nic_access(priv) \
|
|
|
|
_iwl_grab_nic_access(priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void _iwl_release_nic_access(struct iwl_priv *priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
_iwl_clear_bit(priv, CSR_GP_CNTRL,
|
|
|
|
CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void __iwl_release_nic_access(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
|
|
|
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "releasing nic access - %s %d\n", f, l);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_release_nic_access(priv);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_release_nic_access(priv) \
|
|
|
|
__iwl_release_nic_access(__FILE__, __LINE__, priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_release_nic_access(priv) \
|
|
|
|
_iwl_release_nic_access(priv)
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline u32 _iwl_read_direct32(struct iwl_priv *priv, u32 reg)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
return _iwl_read32(priv, reg);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline u32 __iwl_read_direct32(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv, u32 reg)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
u32 value = _iwl_read_direct32(priv, reg);
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "read_direct32(0x%4X) = 0x%08x - %s %d \n", reg, value,
|
2007-09-25 17:54:57 -07:00
|
|
|
f, l);
|
|
|
|
return value;
|
|
|
|
}
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline u32 iwl_read_direct32(struct iwl_priv *priv, u32 reg)
|
|
|
|
{
|
|
|
|
u32 value;
|
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
|
|
|
value = __iwl_read_direct32(__FILE__, __LINE__, priv, reg);
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
|
|
|
return value;
|
|
|
|
}
|
|
|
|
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline u32 iwl_read_direct32(struct iwl_priv *priv, u32 reg)
|
|
|
|
{
|
|
|
|
u32 value;
|
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
|
|
|
value = _iwl_read_direct32(priv, reg);
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
|
|
|
return value;
|
|
|
|
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void _iwl_write_direct32(struct iwl_priv *priv,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 reg, u32 value)
|
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write32(priv, reg, value);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline void iwl_write_direct32(struct iwl_priv *priv, u32 reg, u32 value)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
if (!iwl_grab_nic_access(priv)) {
|
|
|
|
_iwl_write_direct32(priv, reg, value);
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void iwl_write_reg_buf(struct iwl_priv *priv,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 reg, u32 len, u32 *values)
|
|
|
|
{
|
|
|
|
u32 count = sizeof(u32);
|
|
|
|
|
|
|
|
if ((priv != NULL) && (values != NULL)) {
|
|
|
|
for (; 0 < len; len -= count, reg += count, values++)
|
2009-05-22 11:01:47 -07:00
|
|
|
iwl_write_direct32(priv, reg, *values);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2008-12-05 08:58:40 -07:00
|
|
|
static inline int _iwl_poll_direct_bit(struct iwl_priv *priv, u32 addr,
|
|
|
|
u32 mask, int timeout)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
int t = 0;
|
|
|
|
|
|
|
|
do {
|
|
|
|
if ((iwl_read_direct32(priv, addr) & mask) == mask)
|
|
|
|
return t;
|
|
|
|
udelay(IWL_POLL_INTERVAL);
|
|
|
|
t += IWL_POLL_INTERVAL;
|
|
|
|
} while (t < timeout);
|
|
|
|
|
|
|
|
return -ETIMEDOUT;
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-12 16:58:49 -07:00
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUG
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline int __iwl_poll_direct_bit(const char *f, u32 l,
|
2008-03-12 16:58:50 -07:00
|
|
|
struct iwl_priv *priv,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 addr, u32 mask, int timeout)
|
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
int ret = _iwl_poll_direct_bit(priv, addr, mask, timeout);
|
2007-09-25 17:54:57 -07:00
|
|
|
|
2007-10-25 02:15:37 -07:00
|
|
|
if (unlikely(ret == -ETIMEDOUT))
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "poll_direct_bit(0x%08X, 0x%08X) - "
|
2007-09-25 17:54:57 -07:00
|
|
|
"timedout - %s %d\n", addr, mask, f, l);
|
|
|
|
else
|
2009-01-27 15:27:56 -07:00
|
|
|
IWL_DEBUG_IO(priv, "poll_direct_bit(0x%08X, 0x%08X) = 0x%08X "
|
2007-10-25 02:15:37 -07:00
|
|
|
"- %s %d\n", addr, mask, ret, f, l);
|
|
|
|
return ret;
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_poll_direct_bit(priv, addr, mask, timeout) \
|
|
|
|
__iwl_poll_direct_bit(__FILE__, __LINE__, priv, addr, mask, timeout)
|
2007-09-25 17:54:57 -07:00
|
|
|
#else
|
2008-03-25 16:33:37 -07:00
|
|
|
#define iwl_poll_direct_bit _iwl_poll_direct_bit
|
2007-09-25 17:54:57 -07:00
|
|
|
#endif
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline u32 _iwl_read_prph(struct iwl_priv *priv, u32 reg)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_PRPH_RADDR, reg | (3 << 24));
|
2008-12-05 08:58:41 -07:00
|
|
|
rmb();
|
2008-03-25 16:33:37 -07:00
|
|
|
return _iwl_read_direct32(priv, HBUS_TARG_PRPH_RDAT);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline u32 iwl_read_prph(struct iwl_priv *priv, u32 reg)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
u32 val;
|
2007-09-25 17:54:57 -07:00
|
|
|
|
2009-05-22 11:01:47 -07:00
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
|
|
|
val = _iwl_read_prph(priv, reg);
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
|
|
|
return val;
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void _iwl_write_prph(struct iwl_priv *priv,
|
2007-09-25 17:54:57 -07:00
|
|
|
u32 addr, u32 val)
|
|
|
|
{
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_PRPH_WADDR,
|
2007-09-25 17:54:57 -07:00
|
|
|
((addr & 0x0000FFFF) | (3 << 24)));
|
2008-12-05 08:58:41 -07:00
|
|
|
wmb();
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_PRPH_WDAT, val);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
2009-05-22 11:01:47 -07:00
|
|
|
|
|
|
|
static inline void iwl_write_prph(struct iwl_priv *priv, u32 addr, u32 val)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
2007-09-25 17:54:57 -07:00
|
|
|
|
2009-05-22 11:01:47 -07:00
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
if (!iwl_grab_nic_access(priv)) {
|
|
|
|
_iwl_write_prph(priv, addr, val);
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
|
|
|
}
|
2007-09-25 17:54:57 -07:00
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
#define _iwl_set_bits_prph(priv, reg, mask) \
|
|
|
|
_iwl_write_prph(priv, reg, (_iwl_read_prph(priv, reg) | mask))
|
2009-05-22 11:01:47 -07:00
|
|
|
|
|
|
|
static inline void iwl_set_bits_prph(struct iwl_priv *priv, u32 reg, u32 mask)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
2007-10-25 02:15:37 -07:00
|
|
|
|
2009-05-22 11:01:47 -07:00
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_set_bits_prph(priv, reg, mask);
|
2009-05-22 11:01:47 -07:00
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
#define _iwl_set_bits_mask_prph(priv, reg, bits, mask) \
|
|
|
|
_iwl_write_prph(priv, reg, ((_iwl_read_prph(priv, reg) & mask) | bits))
|
2007-10-25 02:15:35 -07:00
|
|
|
|
2009-05-22 11:01:47 -07:00
|
|
|
static inline void iwl_set_bits_mask_prph(struct iwl_priv *priv, u32 reg,
|
|
|
|
u32 bits, u32 mask)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_set_bits_mask_prph(priv, reg, bits, mask);
|
2009-05-22 11:01:47 -07:00
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void iwl_clear_bits_prph(struct iwl_priv
|
2007-09-25 17:54:57 -07:00
|
|
|
*priv, u32 reg, u32 mask)
|
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
u32 val;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
|
|
|
val = _iwl_read_prph(priv, reg);
|
2008-03-25 16:33:37 -07:00
|
|
|
_iwl_write_prph(priv, reg, (val & ~mask));
|
2009-05-22 11:01:47 -07:00
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline u32 iwl_read_targ_mem(struct iwl_priv *priv, u32 addr)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
u32 value;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
iwl_grab_nic_access(priv);
|
|
|
|
|
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, addr);
|
2008-12-05 08:58:41 -07:00
|
|
|
rmb();
|
2009-05-22 11:01:47 -07:00
|
|
|
value = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
|
|
|
|
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
|
|
|
return value;
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void iwl_write_targ_mem(struct iwl_priv *priv, u32 addr, u32 val)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
if (!iwl_grab_nic_access(priv)) {
|
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_MEM_WADDR, addr);
|
|
|
|
wmb();
|
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_MEM_WDAT, val);
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
|
2008-03-25 16:33:37 -07:00
|
|
|
static inline void iwl_write_targ_mem_buf(struct iwl_priv *priv, u32 addr,
|
2007-10-25 02:15:36 -07:00
|
|
|
u32 len, u32 *values)
|
2007-09-25 17:54:57 -07:00
|
|
|
{
|
2009-05-22 11:01:47 -07:00
|
|
|
unsigned long reg_flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&priv->reg_lock, reg_flags);
|
|
|
|
if (!iwl_grab_nic_access(priv)) {
|
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_MEM_WADDR, addr);
|
|
|
|
wmb();
|
|
|
|
for (; 0 < len; len -= sizeof(u32), values++)
|
|
|
|
_iwl_write_direct32(priv, HBUS_TARG_MEM_WDAT, *values);
|
|
|
|
|
|
|
|
iwl_release_nic_access(priv);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
|
2007-09-25 17:54:57 -07:00
|
|
|
}
|
|
|
|
#endif
|