pcmcia: use pcmica_{read,write}_config_byte
Use pcmcia_read_config_byte and pcmcia_write_config_byte instead of pcmcia_access_configuration_register. CC: netdev@vger.kernel.org CC: linux-wireless@vger.kernel.org CC: linux-serial@vger.kernel.org CC: Michael Buesch <mb@bu3sch.de> Signed-off-by: Dominik Brodowski <linux@dominikbrodowski.net>
This commit is contained in:
parent
ac8b422838
commit
1d5cc192d4
12 changed files with 104 additions and 178 deletions
|
@ -378,8 +378,7 @@ static int axnet_config(struct pcmcia_device *link)
|
||||||
/* Maybe PHY is in power down mode. (PPD_SET = 1)
|
/* Maybe PHY is in power down mode. (PPD_SET = 1)
|
||||||
Bit 2 of CCSR is active low. */
|
Bit 2 of CCSR is active low. */
|
||||||
if (i == 32) {
|
if (i == 32) {
|
||||||
conf_reg_t reg = { 0, CS_WRITE, CISREG_CCSR, 0x04 };
|
pcmcia_write_config_byte(link, CISREG_CCSR, 0x04);
|
||||||
pcmcia_access_configuration_register(link, ®);
|
|
||||||
for (i = 0; i < 32; i++) {
|
for (i = 0; i < 32; i++) {
|
||||||
j = mdio_read(dev->base_addr + AXNET_MII_EEP, i, 1);
|
j = mdio_read(dev->base_addr + AXNET_MII_EEP, i, 1);
|
||||||
j2 = mdio_read(dev->base_addr + AXNET_MII_EEP, i, 2);
|
j2 = mdio_read(dev->base_addr + AXNET_MII_EEP, i, 2);
|
||||||
|
|
|
@ -757,29 +757,20 @@ static void nmclan_reset(struct net_device *dev)
|
||||||
|
|
||||||
#if RESET_XILINX
|
#if RESET_XILINX
|
||||||
struct pcmcia_device *link = &lp->link;
|
struct pcmcia_device *link = &lp->link;
|
||||||
conf_reg_t reg;
|
u8 OrigCorValue;
|
||||||
u_long OrigCorValue;
|
|
||||||
|
|
||||||
/* Save original COR value */
|
/* Save original COR value */
|
||||||
reg.Function = 0;
|
pcmcia_read_config_byte(link, CISREG_COR, &OrigCorValue);
|
||||||
reg.Action = CS_READ;
|
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
reg.Value = 0;
|
|
||||||
pcmcia_access_configuration_register(link, ®);
|
|
||||||
OrigCorValue = reg.Value;
|
|
||||||
|
|
||||||
/* Reset Xilinx */
|
/* Reset Xilinx */
|
||||||
reg.Action = CS_WRITE;
|
dev_dbg(&link->dev, "nmclan_reset: OrigCorValue=0x%x, resetting...\n",
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
dev_dbg(&link->dev, "nmclan_reset: OrigCorValue=0x%lX, resetting...\n",
|
|
||||||
OrigCorValue);
|
OrigCorValue);
|
||||||
reg.Value = COR_SOFT_RESET;
|
pcmcia_write_config_byte(link, CISREG_COR, COR_SOFT_RESET);
|
||||||
pcmcia_access_configuration_register(link, ®);
|
|
||||||
/* Need to wait for 20 ms for PCMCIA to finish reset. */
|
/* Need to wait for 20 ms for PCMCIA to finish reset. */
|
||||||
|
|
||||||
/* Restore original COR configuration index */
|
/* Restore original COR configuration index */
|
||||||
reg.Value = COR_LEVEL_REQ | (OrigCorValue & COR_CONFIG_MASK);
|
pcmcia_write_config_byte(link, CISREG_COR,
|
||||||
pcmcia_access_configuration_register(link, ®);
|
(COR_LEVEL_REQ | (OrigCorValue & COR_CONFIG_MASK)));
|
||||||
/* Xilinx is now completely reset along with the MACE chip. */
|
/* Xilinx is now completely reset along with the MACE chip. */
|
||||||
lp->tx_free_frames=AM2150_MAX_TX_FRAMES;
|
lp->tx_free_frames=AM2150_MAX_TX_FRAMES;
|
||||||
|
|
||||||
|
|
|
@ -869,7 +869,6 @@ xirc2ps_config(struct pcmcia_device * link)
|
||||||
goto config_error;
|
goto config_error;
|
||||||
|
|
||||||
if (local->dingo) {
|
if (local->dingo) {
|
||||||
conf_reg_t reg;
|
|
||||||
win_req_t req;
|
win_req_t req;
|
||||||
memreq_t mem;
|
memreq_t mem;
|
||||||
|
|
||||||
|
@ -878,15 +877,14 @@ xirc2ps_config(struct pcmcia_device * link)
|
||||||
* the base address of the ethernet port (BasePort1) is written
|
* the base address of the ethernet port (BasePort1) is written
|
||||||
* to the BAR registers of the modem.
|
* to the BAR registers of the modem.
|
||||||
*/
|
*/
|
||||||
reg.Action = CS_WRITE;
|
err = pcmcia_write_config_byte(link, CISREG_IOBASE_0,
|
||||||
reg.Offset = CISREG_IOBASE_0;
|
link->io.BasePort2 & 0xff);
|
||||||
reg.Value = link->io.BasePort2 & 0xff;
|
if (err)
|
||||||
if ((err = pcmcia_access_configuration_register(link, ®)))
|
|
||||||
goto config_error;
|
goto config_error;
|
||||||
reg.Action = CS_WRITE;
|
|
||||||
reg.Offset = CISREG_IOBASE_1;
|
err = pcmcia_write_config_byte(link, CISREG_IOBASE_1,
|
||||||
reg.Value = (link->io.BasePort2 >> 8) & 0xff;
|
(link->io.BasePort2 >> 8) & 0xff);
|
||||||
if ((err = pcmcia_access_configuration_register(link, ®)))
|
if (err)
|
||||||
goto config_error;
|
goto config_error;
|
||||||
|
|
||||||
/* There is no config entry for the Ethernet part which
|
/* There is no config entry for the Ethernet part which
|
||||||
|
|
|
@ -224,27 +224,18 @@ static int prism2_pccard_card_present(local_info_t *local)
|
||||||
static void sandisk_set_iobase(local_info_t *local)
|
static void sandisk_set_iobase(local_info_t *local)
|
||||||
{
|
{
|
||||||
int res;
|
int res;
|
||||||
conf_reg_t reg;
|
|
||||||
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
||||||
|
|
||||||
reg.Function = 0;
|
res = pcmcia_write_config_byte(hw_priv->link, 0x10,
|
||||||
reg.Action = CS_WRITE;
|
hw_priv->link->io.BasePort1 & 0x00ff);
|
||||||
reg.Offset = 0x10; /* 0x3f0 IO base 1 */
|
|
||||||
reg.Value = hw_priv->link->io.BasePort1 & 0x00ff;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "Prism3 SanDisk - failed to set I/O base 0 -"
|
printk(KERN_DEBUG "Prism3 SanDisk - failed to set I/O base 0 -"
|
||||||
" res=%d\n", res);
|
" res=%d\n", res);
|
||||||
}
|
}
|
||||||
udelay(10);
|
udelay(10);
|
||||||
|
|
||||||
reg.Function = 0;
|
res = pcmcia_write_config_byte(hw_priv->link, 0x12,
|
||||||
reg.Action = CS_WRITE;
|
(hw_priv->link->io.BasePort1 >> 8) & 0x00ff);
|
||||||
reg.Offset = 0x12; /* 0x3f2 IO base 2 */
|
|
||||||
reg.Value = (hw_priv->link->io.BasePort1 & 0xff00) >> 8;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "Prism3 SanDisk - failed to set I/O base 1 -"
|
printk(KERN_DEBUG "Prism3 SanDisk - failed to set I/O base 1 -"
|
||||||
" res=%d\n", res);
|
" res=%d\n", res);
|
||||||
|
@ -270,7 +261,6 @@ static void sandisk_write_hcr(local_info_t *local, int hcr)
|
||||||
static int sandisk_enable_wireless(struct net_device *dev)
|
static int sandisk_enable_wireless(struct net_device *dev)
|
||||||
{
|
{
|
||||||
int res, ret = 0;
|
int res, ret = 0;
|
||||||
conf_reg_t reg;
|
|
||||||
struct hostap_interface *iface = netdev_priv(dev);
|
struct hostap_interface *iface = netdev_priv(dev);
|
||||||
local_info_t *local = iface->local;
|
local_info_t *local = iface->local;
|
||||||
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
||||||
|
@ -297,12 +287,8 @@ static int sandisk_enable_wireless(struct net_device *dev)
|
||||||
" - using vendor-specific initialization\n", dev->name);
|
" - using vendor-specific initialization\n", dev->name);
|
||||||
hw_priv->sandisk_connectplus = 1;
|
hw_priv->sandisk_connectplus = 1;
|
||||||
|
|
||||||
reg.Function = 0;
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_COR,
|
||||||
reg.Action = CS_WRITE;
|
COR_SOFT_RESET);
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
reg.Value = COR_SOFT_RESET;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "%s: SanDisk - COR sreset failed (%d)\n",
|
printk(KERN_DEBUG "%s: SanDisk - COR sreset failed (%d)\n",
|
||||||
dev->name, res);
|
dev->name, res);
|
||||||
|
@ -310,16 +296,13 @@ static int sandisk_enable_wireless(struct net_device *dev)
|
||||||
}
|
}
|
||||||
mdelay(5);
|
mdelay(5);
|
||||||
|
|
||||||
reg.Function = 0;
|
|
||||||
reg.Action = CS_WRITE;
|
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
/*
|
/*
|
||||||
* Do not enable interrupts here to avoid some bogus events. Interrupts
|
* Do not enable interrupts here to avoid some bogus events. Interrupts
|
||||||
* will be enabled during the first cor_sreset call.
|
* will be enabled during the first cor_sreset call.
|
||||||
*/
|
*/
|
||||||
reg.Value = COR_LEVEL_REQ | 0x8 | COR_ADDR_DECODE | COR_FUNC_ENA;
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_COR,
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
(COR_LEVEL_REQ | 0x8 | COR_ADDR_DECODE |
|
||||||
®);
|
COR_FUNC_ENA));
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "%s: SanDisk - COR sreset failed (%d)\n",
|
printk(KERN_DEBUG "%s: SanDisk - COR sreset failed (%d)\n",
|
||||||
dev->name, res);
|
dev->name, res);
|
||||||
|
@ -342,30 +325,23 @@ static int sandisk_enable_wireless(struct net_device *dev)
|
||||||
static void prism2_pccard_cor_sreset(local_info_t *local)
|
static void prism2_pccard_cor_sreset(local_info_t *local)
|
||||||
{
|
{
|
||||||
int res;
|
int res;
|
||||||
conf_reg_t reg;
|
u8 val;
|
||||||
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
||||||
|
|
||||||
if (!prism2_pccard_card_present(local))
|
if (!prism2_pccard_card_present(local))
|
||||||
return;
|
return;
|
||||||
|
|
||||||
reg.Function = 0;
|
res = pcmcia_read_config_byte(hw_priv->link, CISREG_COR, &val);
|
||||||
reg.Action = CS_READ;
|
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
reg.Value = 0;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 1 (%d)\n",
|
printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 1 (%d)\n",
|
||||||
res);
|
res);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
printk(KERN_DEBUG "prism2_pccard_cor_sreset: original COR %02x\n",
|
printk(KERN_DEBUG "prism2_pccard_cor_sreset: original COR %02x\n",
|
||||||
reg.Value);
|
val);
|
||||||
|
|
||||||
reg.Action = CS_WRITE;
|
val |= COR_SOFT_RESET;
|
||||||
reg.Value |= COR_SOFT_RESET;
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_COR, val);
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 2 (%d)\n",
|
printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 2 (%d)\n",
|
||||||
res);
|
res);
|
||||||
|
@ -374,11 +350,10 @@ static void prism2_pccard_cor_sreset(local_info_t *local)
|
||||||
|
|
||||||
mdelay(hw_priv->sandisk_connectplus ? 5 : 2);
|
mdelay(hw_priv->sandisk_connectplus ? 5 : 2);
|
||||||
|
|
||||||
reg.Value &= ~COR_SOFT_RESET;
|
val &= ~COR_SOFT_RESET;
|
||||||
if (hw_priv->sandisk_connectplus)
|
if (hw_priv->sandisk_connectplus)
|
||||||
reg.Value |= COR_IREQ_ENA;
|
val |= COR_IREQ_ENA;
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_COR, val);
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 3 (%d)\n",
|
printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 3 (%d)\n",
|
||||||
res);
|
res);
|
||||||
|
@ -395,8 +370,7 @@ static void prism2_pccard_cor_sreset(local_info_t *local)
|
||||||
static void prism2_pccard_genesis_reset(local_info_t *local, int hcr)
|
static void prism2_pccard_genesis_reset(local_info_t *local, int hcr)
|
||||||
{
|
{
|
||||||
int res;
|
int res;
|
||||||
conf_reg_t reg;
|
u8 old_cor;
|
||||||
int old_cor;
|
|
||||||
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
struct hostap_cs_priv *hw_priv = local->hw_priv;
|
||||||
|
|
||||||
if (!prism2_pccard_card_present(local))
|
if (!prism2_pccard_card_present(local))
|
||||||
|
@ -407,25 +381,17 @@ static void prism2_pccard_genesis_reset(local_info_t *local, int hcr)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
reg.Function = 0;
|
res = pcmcia_read_config_byte(hw_priv->link, CISREG_COR, &old_cor);
|
||||||
reg.Action = CS_READ;
|
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
reg.Value = 0;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 1 "
|
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 1 "
|
||||||
"(%d)\n", res);
|
"(%d)\n", res);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
printk(KERN_DEBUG "prism2_pccard_genesis_sreset: original COR %02x\n",
|
printk(KERN_DEBUG "prism2_pccard_genesis_sreset: original COR %02x\n",
|
||||||
reg.Value);
|
old_cor);
|
||||||
old_cor = reg.Value;
|
|
||||||
|
|
||||||
reg.Action = CS_WRITE;
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_COR,
|
||||||
reg.Value |= COR_SOFT_RESET;
|
old_cor | COR_SOFT_RESET);
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 2 "
|
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 2 "
|
||||||
"(%d)\n", res);
|
"(%d)\n", res);
|
||||||
|
@ -435,11 +401,7 @@ static void prism2_pccard_genesis_reset(local_info_t *local, int hcr)
|
||||||
mdelay(10);
|
mdelay(10);
|
||||||
|
|
||||||
/* Setup Genesis mode */
|
/* Setup Genesis mode */
|
||||||
reg.Action = CS_WRITE;
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_CCSR, hcr);
|
||||||
reg.Value = hcr;
|
|
||||||
reg.Offset = CISREG_CCSR;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 3 "
|
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 3 "
|
||||||
"(%d)\n", res);
|
"(%d)\n", res);
|
||||||
|
@ -447,11 +409,8 @@ static void prism2_pccard_genesis_reset(local_info_t *local, int hcr)
|
||||||
}
|
}
|
||||||
mdelay(10);
|
mdelay(10);
|
||||||
|
|
||||||
reg.Action = CS_WRITE;
|
res = pcmcia_write_config_byte(hw_priv->link, CISREG_COR,
|
||||||
reg.Offset = CISREG_COR;
|
old_cor & ~COR_SOFT_RESET);
|
||||||
reg.Value = old_cor & ~COR_SOFT_RESET;
|
|
||||||
res = pcmcia_access_configuration_register(hw_priv->link,
|
|
||||||
®);
|
|
||||||
if (res != 0) {
|
if (res != 0) {
|
||||||
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 4 "
|
printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 4 "
|
||||||
"(%d)\n", res);
|
"(%d)\n", res);
|
||||||
|
|
|
@ -79,35 +79,27 @@ static int
|
||||||
spectrum_reset(struct pcmcia_device *link, int idle)
|
spectrum_reset(struct pcmcia_device *link, int idle)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
conf_reg_t reg;
|
u8 save_cor;
|
||||||
u_int save_cor;
|
u8 ccsr;
|
||||||
|
|
||||||
/* Doing it if hardware is gone is guaranteed crash */
|
/* Doing it if hardware is gone is guaranteed crash */
|
||||||
if (!pcmcia_dev_present(link))
|
if (!pcmcia_dev_present(link))
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
|
|
||||||
/* Save original COR value */
|
/* Save original COR value */
|
||||||
reg.Function = 0;
|
ret = pcmcia_read_config_byte(link, CISREG_COR, &save_cor);
|
||||||
reg.Action = CS_READ;
|
|
||||||
reg.Offset = CISREG_COR;
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
save_cor = reg.Value;
|
|
||||||
|
|
||||||
/* Soft-Reset card */
|
/* Soft-Reset card */
|
||||||
reg.Action = CS_WRITE;
|
ret = pcmcia_write_config_byte(link, CISREG_COR,
|
||||||
reg.Offset = CISREG_COR;
|
(save_cor | COR_SOFT_RESET));
|
||||||
reg.Value = (save_cor | COR_SOFT_RESET);
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
udelay(1000);
|
udelay(1000);
|
||||||
|
|
||||||
/* Read CCSR */
|
/* Read CCSR */
|
||||||
reg.Action = CS_READ;
|
ret = pcmcia_read_config_byte(link, CISREG_CCSR, &ccsr);
|
||||||
reg.Offset = CISREG_CCSR;
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
|
|
||||||
|
@ -115,19 +107,15 @@ spectrum_reset(struct pcmcia_device *link, int idle)
|
||||||
* Start or stop the firmware. Memory width bit should be
|
* Start or stop the firmware. Memory width bit should be
|
||||||
* preserved from the value we've just read.
|
* preserved from the value we've just read.
|
||||||
*/
|
*/
|
||||||
reg.Action = CS_WRITE;
|
ccsr = (idle ? HCR_IDLE : HCR_RUN) | (ccsr & HCR_MEM16);
|
||||||
reg.Offset = CISREG_CCSR;
|
ret = pcmcia_write_config_byte(link, CISREG_CCSR, ccsr);
|
||||||
reg.Value = (idle ? HCR_IDLE : HCR_RUN) | (reg.Value & HCR_MEM16);
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
udelay(1000);
|
udelay(1000);
|
||||||
|
|
||||||
/* Restore original COR configuration index */
|
/* Restore original COR configuration index */
|
||||||
reg.Action = CS_WRITE;
|
ret = pcmcia_write_config_byte(link, CISREG_COR,
|
||||||
reg.Offset = CISREG_COR;
|
(save_cor & ~COR_SOFT_RESET));
|
||||||
reg.Value = (save_cor & ~COR_SOFT_RESET);
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
udelay(1000);
|
udelay(1000);
|
||||||
|
|
|
@ -209,7 +209,7 @@ int pcmcia_read_cis_mem(struct pcmcia_socket *s, int attr, u_int addr,
|
||||||
* Probably only useful for writing one-byte registers. Must be called
|
* Probably only useful for writing one-byte registers. Must be called
|
||||||
* with ops_mutex held.
|
* with ops_mutex held.
|
||||||
*/
|
*/
|
||||||
void pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr, u_int addr,
|
int pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr, u_int addr,
|
||||||
u_int len, void *ptr)
|
u_int len, void *ptr)
|
||||||
{
|
{
|
||||||
void __iomem *sys, *end;
|
void __iomem *sys, *end;
|
||||||
|
@ -231,7 +231,7 @@ void pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr, u_int addr,
|
||||||
((cis_width) ? MAP_16BIT : 0));
|
((cis_width) ? MAP_16BIT : 0));
|
||||||
if (!sys) {
|
if (!sys) {
|
||||||
dev_dbg(&s->dev, "could not map memory\n");
|
dev_dbg(&s->dev, "could not map memory\n");
|
||||||
return; /* FIXME: Error */
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
writeb(flags, sys+CISREG_ICTRL0);
|
writeb(flags, sys+CISREG_ICTRL0);
|
||||||
|
@ -256,7 +256,7 @@ void pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr, u_int addr,
|
||||||
sys = set_cis_map(s, card_offset, flags);
|
sys = set_cis_map(s, card_offset, flags);
|
||||||
if (!sys) {
|
if (!sys) {
|
||||||
dev_dbg(&s->dev, "could not map memory\n");
|
dev_dbg(&s->dev, "could not map memory\n");
|
||||||
return; /* FIXME: error */
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
end = sys + s->map_size;
|
end = sys + s->map_size;
|
||||||
|
@ -270,6 +270,7 @@ void pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr, u_int addr,
|
||||||
addr = 0;
|
addr = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
|
@ -158,8 +158,8 @@ extern struct bin_attribute pccard_cis_attr;
|
||||||
|
|
||||||
int pcmcia_read_cis_mem(struct pcmcia_socket *s, int attr,
|
int pcmcia_read_cis_mem(struct pcmcia_socket *s, int attr,
|
||||||
u_int addr, u_int len, void *ptr);
|
u_int addr, u_int len, void *ptr);
|
||||||
void pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr,
|
int pcmcia_write_cis_mem(struct pcmcia_socket *s, int attr,
|
||||||
u_int addr, u_int len, void *ptr);
|
u_int addr, u_int len, void *ptr);
|
||||||
void release_cis_mem(struct pcmcia_socket *s);
|
void release_cis_mem(struct pcmcia_socket *s);
|
||||||
void destroy_cis_cache(struct pcmcia_socket *s);
|
void destroy_cis_cache(struct pcmcia_socket *s);
|
||||||
int pccard_read_tuple(struct pcmcia_socket *s, unsigned int function,
|
int pccard_read_tuple(struct pcmcia_socket *s, unsigned int function,
|
||||||
|
|
|
@ -108,25 +108,25 @@ static void release_io_space(struct pcmcia_socket *s, unsigned int base,
|
||||||
} /* release_io_space */
|
} /* release_io_space */
|
||||||
|
|
||||||
|
|
||||||
/** pccard_access_configuration_register
|
/**
|
||||||
|
* pcmcia_access_config() - read or write card configuration registers
|
||||||
*
|
*
|
||||||
* Access_configuration_register() reads and writes configuration
|
* pcmcia_access_config() reads and writes configuration registers in
|
||||||
* registers in attribute memory. Memory window 0 is reserved for
|
* attribute memory. Memory window 0 is reserved for this and the tuple
|
||||||
* this and the tuple reading services.
|
* reading services. Drivers must use pcmcia_read_config_byte() or
|
||||||
|
* pcmcia_write_config_byte().
|
||||||
*/
|
*/
|
||||||
|
static int pcmcia_access_config(struct pcmcia_device *p_dev,
|
||||||
int pcmcia_access_configuration_register(struct pcmcia_device *p_dev,
|
off_t where, u8 *val,
|
||||||
conf_reg_t *reg)
|
int (*accessf) (struct pcmcia_socket *s,
|
||||||
|
int attr, unsigned int addr,
|
||||||
|
unsigned int len, void *ptr))
|
||||||
{
|
{
|
||||||
struct pcmcia_socket *s;
|
struct pcmcia_socket *s;
|
||||||
config_t *c;
|
config_t *c;
|
||||||
int addr;
|
int addr;
|
||||||
u_char val;
|
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
|
|
||||||
if (!p_dev || !p_dev->function_config)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
s = p_dev->socket;
|
s = p_dev->socket;
|
||||||
|
|
||||||
mutex_lock(&s->ops_mutex);
|
mutex_lock(&s->ops_mutex);
|
||||||
|
@ -138,26 +138,40 @@ int pcmcia_access_configuration_register(struct pcmcia_device *p_dev,
|
||||||
return -EACCES;
|
return -EACCES;
|
||||||
}
|
}
|
||||||
|
|
||||||
addr = (c->ConfigBase + reg->Offset) >> 1;
|
addr = (c->ConfigBase + where) >> 1;
|
||||||
|
|
||||||
|
ret = accessf(s, 1, addr, 1, val);
|
||||||
|
|
||||||
switch (reg->Action) {
|
|
||||||
case CS_READ:
|
|
||||||
ret = pcmcia_read_cis_mem(s, 1, addr, 1, &val);
|
|
||||||
reg->Value = val;
|
|
||||||
break;
|
|
||||||
case CS_WRITE:
|
|
||||||
val = reg->Value;
|
|
||||||
pcmcia_write_cis_mem(s, 1, addr, 1, &val);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
dev_dbg(&s->dev, "Invalid conf register request\n");
|
|
||||||
ret = -EINVAL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
mutex_unlock(&s->ops_mutex);
|
mutex_unlock(&s->ops_mutex);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
} /* pcmcia_access_configuration_register */
|
} /* pcmcia_access_config */
|
||||||
EXPORT_SYMBOL(pcmcia_access_configuration_register);
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* pcmcia_read_config_byte() - read a byte from a card configuration register
|
||||||
|
*
|
||||||
|
* pcmcia_read_config_byte() reads a byte from a configuration register in
|
||||||
|
* attribute memory.
|
||||||
|
*/
|
||||||
|
int pcmcia_read_config_byte(struct pcmcia_device *p_dev, off_t where, u8 *val)
|
||||||
|
{
|
||||||
|
return pcmcia_access_config(p_dev, where, val, pcmcia_read_cis_mem);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(pcmcia_read_config_byte);
|
||||||
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* pcmcia_write_config_byte() - write a byte to a card configuration register
|
||||||
|
*
|
||||||
|
* pcmcia_write_config_byte() writes a byte to a configuration register in
|
||||||
|
* attribute memory.
|
||||||
|
*/
|
||||||
|
int pcmcia_write_config_byte(struct pcmcia_device *p_dev, off_t where, u8 val)
|
||||||
|
{
|
||||||
|
return pcmcia_access_config(p_dev, where, &val, pcmcia_write_cis_mem);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(pcmcia_write_config_byte);
|
||||||
|
|
||||||
|
|
||||||
int pcmcia_map_mem_page(struct pcmcia_device *p_dev, window_handle_t wh,
|
int pcmcia_map_mem_page(struct pcmcia_device *p_dev, window_handle_t wh,
|
||||||
|
|
|
@ -114,16 +114,14 @@ static void quirk_setup_brainboxes_0104(struct pcmcia_device *link, struct uart_
|
||||||
|
|
||||||
static int quirk_post_ibm(struct pcmcia_device *link)
|
static int quirk_post_ibm(struct pcmcia_device *link)
|
||||||
{
|
{
|
||||||
conf_reg_t reg = { 0, CS_READ, 0x800, 0 };
|
u8 val;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
ret = pcmcia_read_config_byte(link, 0x800, &val);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
|
|
||||||
reg.Action = CS_WRITE;
|
ret = pcmcia_write_config_byte(link, 0x800, val | 1);
|
||||||
reg.Value = reg.Value | 1;
|
|
||||||
ret = pcmcia_access_configuration_register(link, ®);
|
|
||||||
if (ret)
|
if (ret)
|
||||||
goto failed;
|
goto failed;
|
||||||
return 0;
|
return 0;
|
||||||
|
|
|
@ -71,14 +71,9 @@
|
||||||
/* Write to a PCMCIA configuration register. */
|
/* Write to a PCMCIA configuration register. */
|
||||||
static int ssb_pcmcia_cfg_write(struct ssb_bus *bus, u8 offset, u8 value)
|
static int ssb_pcmcia_cfg_write(struct ssb_bus *bus, u8 offset, u8 value)
|
||||||
{
|
{
|
||||||
conf_reg_t reg;
|
|
||||||
int res;
|
int res;
|
||||||
|
|
||||||
memset(®, 0, sizeof(reg));
|
res = pcmcia_write_config_byte(bus->host_pcmcia, offset, value);
|
||||||
reg.Offset = offset;
|
|
||||||
reg.Action = CS_WRITE;
|
|
||||||
reg.Value = value;
|
|
||||||
res = pcmcia_access_configuration_register(bus->host_pcmcia, ®);
|
|
||||||
if (unlikely(res != 0))
|
if (unlikely(res != 0))
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
|
|
||||||
|
@ -88,16 +83,11 @@ static int ssb_pcmcia_cfg_write(struct ssb_bus *bus, u8 offset, u8 value)
|
||||||
/* Read from a PCMCIA configuration register. */
|
/* Read from a PCMCIA configuration register. */
|
||||||
static int ssb_pcmcia_cfg_read(struct ssb_bus *bus, u8 offset, u8 *value)
|
static int ssb_pcmcia_cfg_read(struct ssb_bus *bus, u8 offset, u8 *value)
|
||||||
{
|
{
|
||||||
conf_reg_t reg;
|
|
||||||
int res;
|
int res;
|
||||||
|
|
||||||
memset(®, 0, sizeof(reg));
|
res = pcmcia_read_config_byte(bus->host_pcmcia, offset, value);
|
||||||
reg.Offset = offset;
|
|
||||||
reg.Action = CS_READ;
|
|
||||||
res = pcmcia_access_configuration_register(bus->host_pcmcia, ®);
|
|
||||||
if (unlikely(res != 0))
|
if (unlikely(res != 0))
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
*value = reg.Value;
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
@ -19,18 +19,6 @@
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* For AccessConfigurationRegister */
|
|
||||||
typedef struct conf_reg_t {
|
|
||||||
u_char Function;
|
|
||||||
u_int Action;
|
|
||||||
off_t Offset;
|
|
||||||
u_int Value;
|
|
||||||
} conf_reg_t;
|
|
||||||
|
|
||||||
/* Actions */
|
|
||||||
#define CS_READ 1
|
|
||||||
#define CS_WRITE 2
|
|
||||||
|
|
||||||
/* for AdjustResourceInfo */
|
/* for AdjustResourceInfo */
|
||||||
/* Action field */
|
/* Action field */
|
||||||
#define REMOVE_MANAGED_RESOURCE 1
|
#define REMOVE_MANAGED_RESOURCE 1
|
||||||
|
|
|
@ -174,8 +174,8 @@ struct pcmcia_device *pcmcia_dev_present(struct pcmcia_device *p_dev);
|
||||||
int pcmcia_reset_card(struct pcmcia_socket *skt);
|
int pcmcia_reset_card(struct pcmcia_socket *skt);
|
||||||
|
|
||||||
/* CIS config */
|
/* CIS config */
|
||||||
int pcmcia_access_configuration_register(struct pcmcia_device *p_dev,
|
int pcmcia_read_config_byte(struct pcmcia_device *p_dev, off_t where, u8 *val);
|
||||||
conf_reg_t *reg);
|
int pcmcia_write_config_byte(struct pcmcia_device *p_dev, off_t where, u8 val);
|
||||||
|
|
||||||
/* device configuration */
|
/* device configuration */
|
||||||
int pcmcia_request_io(struct pcmcia_device *p_dev, io_req_t *req);
|
int pcmcia_request_io(struct pcmcia_device *p_dev, io_req_t *req);
|
||||||
|
|
Loading…
Reference in a new issue