2007-09-25 20:54:57 -04:00
|
|
|
/******************************************************************************
|
|
|
|
*
|
2008-03-11 19:17:17 -04:00
|
|
|
* Copyright(c) 2003 - 2008 Intel Corporation. All rights reserved.
|
2007-09-25 20:54:57 -04: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:
|
|
|
|
* James P. Ketrenos <ipw2100-admin@linux.intel.com>
|
|
|
|
* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
|
|
|
|
*
|
|
|
|
*****************************************************************************/
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
#ifndef __iwl3945_io_h__
|
|
|
|
#define __iwl3945_io_h__
|
2007-09-25 20:54:57 -04:00
|
|
|
|
|
|
|
#include <linux/io.h>
|
|
|
|
|
2007-10-25 05:15:50 -04:00
|
|
|
#include "iwl-3945-debug.h"
|
2007-09-25 20:54:57 -04: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
|
2007-10-25 05:15:37 -04:00
|
|
|
* and the current line number is printed in addition to any other debug output.
|
2007-09-25 20:54:57 -04:00
|
|
|
*
|
|
|
|
* The non-prefixed name is the #define that maps the caller into a
|
|
|
|
* #define that provides the caller's __LINE__ to the double prefix version.
|
|
|
|
*
|
|
|
|
* 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-01-27 19:41:47 -05:00
|
|
|
* routines, for example _iwl3945_read_direct32 calls the non-check version of
|
|
|
|
* _iwl3945_read32.)
|
2007-09-25 20:54:57 -04:00
|
|
|
*
|
|
|
|
* These declarations are *extremely* useful in quickly isolating code deltas
|
|
|
|
* which result in misconfiguring of the hardware I/O. In combination with
|
|
|
|
* git-bisect and the IO debug level you can quickly determine the specific
|
|
|
|
* commit which breaks the IO sequence to the hardware.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
2008-02-13 14:32:30 -05:00
|
|
|
#define _iwl3945_write32(priv, ofs, val) writel((val), (priv)->hw_base + (ofs))
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-02-13 14:32:30 -05:00
|
|
|
static inline void __iwl3945_write32(const char *f, u32 l, struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 ofs, u32 val)
|
|
|
|
{
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_DEBUG_IO("write32(0x%08X, 0x%08X) - %s %d\n", ofs, val, f, l);
|
2008-02-13 14:32:30 -05:00
|
|
|
_iwl3945_write32(priv, ofs, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-02-13 14:32:30 -05:00
|
|
|
#define iwl3945_write32(priv, ofs, val) \
|
|
|
|
__iwl3945_write32(__FILE__, __LINE__, priv, ofs, val)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-02-13 14:32:30 -05:00
|
|
|
#define iwl3945_write32(priv, ofs, val) _iwl3945_write32(priv, ofs, val)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-02-13 14:32:30 -05:00
|
|
|
#define _iwl3945_read32(priv, ofs) readl((priv)->hw_base + (ofs))
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-02-13 14:32:30 -05:00
|
|
|
static inline u32 __iwl3945_read32(char *f, u32 l, struct iwl3945_priv *priv, u32 ofs)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
IWL_DEBUG_IO("read_direct32(0x%08X) - %s %d\n", ofs, f, l);
|
2008-02-13 14:32:30 -05:00
|
|
|
return _iwl3945_read32(priv, ofs);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-02-13 14:32:30 -05:00
|
|
|
#define iwl3945_read32(priv, ofs) __iwl3945_read32(__FILE__, __LINE__, priv, ofs)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_read32(p, o) _iwl3945_read32(p, o)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline int _iwl3945_poll_bit(struct iwl3945_priv *priv, u32 addr,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 bits, u32 mask, int timeout)
|
|
|
|
{
|
|
|
|
int i = 0;
|
|
|
|
|
|
|
|
do {
|
2008-01-27 19:41:47 -05:00
|
|
|
if ((_iwl3945_read32(priv, addr) & mask) == (bits & mask))
|
2007-09-25 20:54:57 -04:00
|
|
|
return i;
|
|
|
|
mdelay(10);
|
|
|
|
i += 10;
|
|
|
|
} while (i < timeout);
|
|
|
|
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline int __iwl3945_poll_bit(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv, u32 addr,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 bits, u32 mask, int timeout)
|
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
int ret = _iwl3945_poll_bit(priv, addr, bits, mask, timeout);
|
2008-02-13 14:32:30 -05:00
|
|
|
IWL_DEBUG_IO("poll_bit(0x%08X, 0x%08X, 0x%08X) - %s- %s %d\n",
|
|
|
|
addr, bits, mask,
|
|
|
|
unlikely(ret == -ETIMEDOUT)?"timeout":"", f, l);
|
2007-10-25 05:15:37 -04:00
|
|
|
return ret;
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-02-13 14:32:30 -05:00
|
|
|
#define iwl3945_poll_bit(priv, addr, bits, mask, timeout) \
|
|
|
|
__iwl3945_poll_bit(__FILE__, __LINE__, priv, addr, bits, mask, timeout)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_poll_bit(p, a, b, m, t) _iwl3945_poll_bit(p, a, b, m, t)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void _iwl3945_set_bit(struct iwl3945_priv *priv, u32 reg, u32 mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write32(priv, reg, _iwl3945_read32(priv, reg) | mask);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void __iwl3945_set_bit(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv, u32 reg, u32 mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
u32 val = _iwl3945_read32(priv, reg) | mask;
|
2007-09-25 20:54:57 -04:00
|
|
|
IWL_DEBUG_IO("set_bit(0x%08X, 0x%08X) = 0x%08X\n", reg, mask, val);
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write32(priv, reg, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_set_bit(p, r, m) __iwl3945_set_bit(__FILE__, __LINE__, p, r, m)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_set_bit(p, r, m) _iwl3945_set_bit(p, r, m)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void _iwl3945_clear_bit(struct iwl3945_priv *priv, u32 reg, u32 mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write32(priv, reg, _iwl3945_read32(priv, reg) & ~mask);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void __iwl3945_clear_bit(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv, u32 reg, u32 mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
u32 val = _iwl3945_read32(priv, reg) & ~mask;
|
2007-09-25 20:54:57 -04:00
|
|
|
IWL_DEBUG_IO("clear_bit(0x%08X, 0x%08X) = 0x%08X\n", reg, mask, val);
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write32(priv, reg, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_clear_bit(p, r, m) __iwl3945_clear_bit(__FILE__, __LINE__, p, r, m)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_clear_bit(p, r, m) _iwl3945_clear_bit(p, r, m)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline int _iwl3945_grab_nic_access(struct iwl3945_priv *priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2007-10-25 05:15:37 -04:00
|
|
|
int ret;
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 gp_ctl;
|
|
|
|
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2007-09-25 20:54:57 -04:00
|
|
|
if (atomic_read(&priv->restrict_refcnt))
|
|
|
|
return 0;
|
|
|
|
#endif
|
|
|
|
if (test_bit(STATUS_RF_KILL_HW, &priv->status) ||
|
|
|
|
test_bit(STATUS_RF_KILL_SW, &priv->status)) {
|
|
|
|
IWL_WARNING("WARNING: Requesting MAC access during RFKILL "
|
|
|
|
"wakes up NIC\n");
|
|
|
|
|
|
|
|
/* 10 msec allows time for NIC to complete its data save */
|
2008-01-27 19:41:47 -05:00
|
|
|
gp_ctl = _iwl3945_read32(priv, CSR_GP_CNTRL);
|
2007-09-25 20:54:57 -04:00
|
|
|
if (gp_ctl & CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY) {
|
|
|
|
IWL_DEBUG_RF_KILL("Wait for complete power-down, "
|
|
|
|
"gpctl = 0x%08x\n", gp_ctl);
|
|
|
|
mdelay(10);
|
|
|
|
} else
|
|
|
|
IWL_DEBUG_RF_KILL("power-down complete, "
|
|
|
|
"gpctl = 0x%08x\n", gp_ctl);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* this bit wakes up the NIC */
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_set_bit(priv, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
|
|
|
|
ret = _iwl3945_poll_bit(priv, CSR_GP_CNTRL,
|
2007-09-25 20:54:57 -04:00
|
|
|
CSR_GP_CNTRL_REG_VAL_MAC_ACCESS_EN,
|
|
|
|
(CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY |
|
|
|
|
CSR_GP_CNTRL_REG_FLAG_GOING_TO_SLEEP), 50);
|
2007-10-25 05:15:37 -04:00
|
|
|
if (ret < 0) {
|
2007-09-25 20:54:57 -04:00
|
|
|
IWL_ERROR("MAC is in deep sleep!\n");
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2007-09-25 20:54:57 -04:00
|
|
|
atomic_inc(&priv->restrict_refcnt);
|
|
|
|
#endif
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline int __iwl3945_grab_nic_access(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
if (atomic_read(&priv->restrict_refcnt))
|
|
|
|
IWL_DEBUG_INFO("Grabbing access while already held at "
|
|
|
|
"line %d.\n", l);
|
|
|
|
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_DEBUG_IO("grabbing nic access - %s %d\n", f, l);
|
2008-01-27 19:41:47 -05:00
|
|
|
return _iwl3945_grab_nic_access(priv);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_grab_nic_access(priv) \
|
|
|
|
__iwl3945_grab_nic_access(__FILE__, __LINE__, priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_grab_nic_access(priv) \
|
|
|
|
_iwl3945_grab_nic_access(priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void _iwl3945_release_nic_access(struct iwl3945_priv *priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2007-09-25 20:54:57 -04:00
|
|
|
if (atomic_dec_and_test(&priv->restrict_refcnt))
|
|
|
|
#endif
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_clear_bit(priv, CSR_GP_CNTRL,
|
2007-09-25 20:54:57 -04:00
|
|
|
CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
|
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void __iwl3945_release_nic_access(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
if (atomic_read(&priv->restrict_refcnt) <= 0)
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Release unheld nic access at line %d.\n", l);
|
2007-09-25 20:54:57 -04:00
|
|
|
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_DEBUG_IO("releasing nic access - %s %d\n", f, l);
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_release_nic_access(priv);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_release_nic_access(priv) \
|
|
|
|
__iwl3945_release_nic_access(__FILE__, __LINE__, priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_release_nic_access(priv) \
|
|
|
|
_iwl3945_release_nic_access(priv)
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline u32 _iwl3945_read_direct32(struct iwl3945_priv *priv, u32 reg)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
return _iwl3945_read32(priv, reg);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline u32 __iwl3945_read_direct32(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv, u32 reg)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
u32 value = _iwl3945_read_direct32(priv, reg);
|
2007-09-25 20:54:57 -04:00
|
|
|
if (!atomic_read(&priv->restrict_refcnt))
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Nic access not held from %s %d\n", f, l);
|
|
|
|
IWL_DEBUG_IO("read_direct32(0x%4X) = 0x%08x - %s %d \n", reg, value,
|
2007-09-25 20:54:57 -04:00
|
|
|
f, l);
|
|
|
|
return value;
|
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_read_direct32(priv, reg) \
|
|
|
|
__iwl3945_read_direct32(__FILE__, __LINE__, priv, reg)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_read_direct32 _iwl3945_read_direct32
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void _iwl3945_write_direct32(struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 reg, u32 value)
|
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write32(priv, reg, value);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static void __iwl3945_write_direct32(u32 line,
|
|
|
|
struct iwl3945_priv *priv, u32 reg, u32 value)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
if (!atomic_read(&priv->restrict_refcnt))
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Nic access not held from line %d\n", line);
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write_direct32(priv, reg, value);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_write_direct32(priv, reg, value) \
|
|
|
|
__iwl3945_write_direct32(__LINE__, priv, reg, value)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_write_direct32 _iwl3945_write_direct32
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void iwl3945_write_reg_buf(struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 reg, u32 len, u32 *values)
|
|
|
|
{
|
|
|
|
u32 count = sizeof(u32);
|
|
|
|
|
|
|
|
if ((priv != NULL) && (values != NULL)) {
|
|
|
|
for (; 0 < len; len -= count, reg += count, values++)
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write_direct32(priv, reg, *values);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline int _iwl3945_poll_direct_bit(struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 addr, u32 mask, int timeout)
|
|
|
|
{
|
|
|
|
int i = 0;
|
|
|
|
|
|
|
|
do {
|
2008-01-27 19:41:47 -05:00
|
|
|
if ((_iwl3945_read_direct32(priv, addr) & mask) == mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
return i;
|
|
|
|
mdelay(10);
|
|
|
|
i += 10;
|
|
|
|
} while (i < timeout);
|
|
|
|
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
}
|
|
|
|
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline int __iwl3945_poll_direct_bit(const char *f, u32 l,
|
|
|
|
struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 addr, u32 mask, int timeout)
|
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
int ret = _iwl3945_poll_direct_bit(priv, addr, mask, timeout);
|
2007-09-25 20:54:57 -04:00
|
|
|
|
2007-10-25 05:15:37 -04:00
|
|
|
if (unlikely(ret == -ETIMEDOUT))
|
|
|
|
IWL_DEBUG_IO("poll_direct_bit(0x%08X, 0x%08X) - "
|
2007-09-25 20:54:57 -04:00
|
|
|
"timedout - %s %d\n", addr, mask, f, l);
|
|
|
|
else
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_DEBUG_IO("poll_direct_bit(0x%08X, 0x%08X) = 0x%08X "
|
|
|
|
"- %s %d\n", addr, mask, ret, f, l);
|
|
|
|
return ret;
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-02-13 14:32:30 -05:00
|
|
|
#define iwl3945_poll_direct_bit(priv, addr, mask, timeout) \
|
|
|
|
__iwl3945_poll_direct_bit(__FILE__, __LINE__, priv, addr, mask, timeout)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_poll_direct_bit _iwl3945_poll_direct_bit
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline u32 _iwl3945_read_prph(struct iwl3945_priv *priv, u32 reg)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write_direct32(priv, HBUS_TARG_PRPH_RADDR, reg | (3 << 24));
|
|
|
|
return _iwl3945_read_direct32(priv, HBUS_TARG_PRPH_RDAT);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline u32 __iwl3945_read_prph(u32 line, struct iwl3945_priv *priv, u32 reg)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
if (!atomic_read(&priv->restrict_refcnt))
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Nic access not held from line %d\n", line);
|
2008-01-27 19:41:47 -05:00
|
|
|
return _iwl3945_read_prph(priv, reg);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_read_prph(priv, reg) \
|
|
|
|
__iwl3945_read_prph(__LINE__, priv, reg)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_read_prph _iwl3945_read_prph
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void _iwl3945_write_prph(struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 addr, u32 val)
|
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write_direct32(priv, HBUS_TARG_PRPH_WADDR,
|
2007-09-25 20:54:57 -04:00
|
|
|
((addr & 0x0000FFFF) | (3 << 24)));
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write_direct32(priv, HBUS_TARG_PRPH_WDAT, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void __iwl3945_write_prph(u32 line, struct iwl3945_priv *priv,
|
2007-09-25 20:54:57 -04:00
|
|
|
u32 addr, u32 val)
|
|
|
|
{
|
|
|
|
if (!atomic_read(&priv->restrict_refcnt))
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Nic access from line %d\n", line);
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_write_prph(priv, addr, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_write_prph(priv, addr, val) \
|
|
|
|
__iwl3945_write_prph(__LINE__, priv, addr, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_write_prph _iwl3945_write_prph
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
#define _iwl3945_set_bits_prph(priv, reg, mask) \
|
|
|
|
_iwl3945_write_prph(priv, reg, (_iwl3945_read_prph(priv, reg) | mask))
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void __iwl3945_set_bits_prph(u32 line, struct iwl3945_priv *priv,
|
2007-10-25 05:15:35 -04:00
|
|
|
u32 reg, u32 mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
if (!atomic_read(&priv->restrict_refcnt))
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Nic access not held from line %d\n", line);
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_set_bits_prph(priv, reg, mask);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_set_bits_prph(priv, reg, mask) \
|
|
|
|
__iwl3945_set_bits_prph(__LINE__, priv, reg, mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_set_bits_prph _iwl3945_set_bits_prph
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
#define _iwl3945_set_bits_mask_prph(priv, reg, bits, mask) \
|
|
|
|
_iwl3945_write_prph(priv, reg, ((_iwl3945_read_prph(priv, reg) & mask) | bits))
|
2007-10-25 05:15:35 -04:00
|
|
|
|
2007-10-25 05:15:51 -04:00
|
|
|
#ifdef CONFIG_IWL3945_DEBUG
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void __iwl3945_set_bits_mask_prph(u32 line,
|
|
|
|
struct iwl3945_priv *priv, u32 reg, u32 bits, u32 mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
|
|
|
if (!atomic_read(&priv->restrict_refcnt))
|
2007-10-25 05:15:37 -04:00
|
|
|
IWL_ERROR("Nic access not held from line %d\n", line);
|
2008-01-27 19:41:47 -05:00
|
|
|
_iwl3945_set_bits_mask_prph(priv, reg, bits, mask);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_set_bits_mask_prph(priv, reg, bits, mask) \
|
|
|
|
__iwl3945_set_bits_mask_prph(__LINE__, priv, reg, bits, mask)
|
2007-09-25 20:54:57 -04:00
|
|
|
#else
|
2008-01-27 19:41:47 -05:00
|
|
|
#define iwl3945_set_bits_mask_prph _iwl3945_set_bits_mask_prph
|
2007-09-25 20:54:57 -04:00
|
|
|
#endif
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void iwl3945_clear_bits_prph(struct iwl3945_priv
|
2007-09-25 20:54:57 -04:00
|
|
|
*priv, u32 reg, u32 mask)
|
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
u32 val = _iwl3945_read_prph(priv, reg);
|
|
|
|
_iwl3945_write_prph(priv, reg, (val & ~mask));
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline u32 iwl3945_read_targ_mem(struct iwl3945_priv *priv, u32 addr)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
iwl3945_write_direct32(priv, HBUS_TARG_MEM_RADDR, addr);
|
|
|
|
return iwl3945_read_direct32(priv, HBUS_TARG_MEM_RDAT);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void iwl3945_write_targ_mem(struct iwl3945_priv *priv, u32 addr, u32 val)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
iwl3945_write_direct32(priv, HBUS_TARG_MEM_WADDR, addr);
|
|
|
|
iwl3945_write_direct32(priv, HBUS_TARG_MEM_WDAT, val);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
|
2008-01-27 19:41:47 -05:00
|
|
|
static inline void iwl3945_write_targ_mem_buf(struct iwl3945_priv *priv, u32 addr,
|
2007-10-25 05:15:36 -04:00
|
|
|
u32 len, u32 *values)
|
2007-09-25 20:54:57 -04:00
|
|
|
{
|
2008-01-27 19:41:47 -05:00
|
|
|
iwl3945_write_direct32(priv, HBUS_TARG_MEM_WADDR, addr);
|
2007-09-25 20:54:57 -04:00
|
|
|
for (; 0 < len; len -= sizeof(u32), values++)
|
2008-01-27 19:41:47 -05:00
|
|
|
iwl3945_write_direct32(priv, HBUS_TARG_MEM_WDAT, *values);
|
2007-09-25 20:54:57 -04:00
|
|
|
}
|
|
|
|
#endif
|