Commit 60d78c44 authored by Michael Buesch's avatar Michael Buesch Committed by David S. Miller

ssb: Fix PCMCIA-host lowlevel bus access

This fixes the lowlevel bus access routines for
PCMCIA based devices.

There are still a few issues with register access sideeffects after
this patch. This will be addressed in a later patch.
Signed-off-by: default avatarMichael Buesch <mb@bu3sch.de>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent d52a60ad
...@@ -440,6 +440,7 @@ static int ssb_devices_register(struct ssb_bus *bus) ...@@ -440,6 +440,7 @@ static int ssb_devices_register(struct ssb_bus *bus)
break; break;
case SSB_BUSTYPE_PCMCIA: case SSB_BUSTYPE_PCMCIA:
#ifdef CONFIG_SSB_PCMCIAHOST #ifdef CONFIG_SSB_PCMCIAHOST
sdev->irq = bus->host_pcmcia->irq.AssignedIRQ;
dev->parent = &bus->host_pcmcia->dev; dev->parent = &bus->host_pcmcia->dev;
#endif #endif
break; break;
......
...@@ -63,17 +63,17 @@ int ssb_pcmcia_switch_coreidx(struct ssb_bus *bus, ...@@ -63,17 +63,17 @@ int ssb_pcmcia_switch_coreidx(struct ssb_bus *bus,
err = pcmcia_access_configuration_register(pdev, &reg); err = pcmcia_access_configuration_register(pdev, &reg);
if (err != CS_SUCCESS) if (err != CS_SUCCESS)
goto error; goto error;
read_addr |= (reg.Value & 0xF) << 12; read_addr |= ((u32)(reg.Value & 0x0F)) << 12;
reg.Offset = 0x30; reg.Offset = 0x30;
err = pcmcia_access_configuration_register(pdev, &reg); err = pcmcia_access_configuration_register(pdev, &reg);
if (err != CS_SUCCESS) if (err != CS_SUCCESS)
goto error; goto error;
read_addr |= reg.Value << 16; read_addr |= ((u32)reg.Value) << 16;
reg.Offset = 0x32; reg.Offset = 0x32;
err = pcmcia_access_configuration_register(pdev, &reg); err = pcmcia_access_configuration_register(pdev, &reg);
if (err != CS_SUCCESS) if (err != CS_SUCCESS)
goto error; goto error;
read_addr |= reg.Value << 24; read_addr |= ((u32)reg.Value) << 24;
cur_core = (read_addr - SSB_ENUM_BASE) / SSB_CORE_SIZE; cur_core = (read_addr - SSB_ENUM_BASE) / SSB_CORE_SIZE;
if (cur_core == coreidx) if (cur_core == coreidx)
...@@ -152,28 +152,29 @@ int ssb_pcmcia_switch_segment(struct ssb_bus *bus, u8 seg) ...@@ -152,28 +152,29 @@ int ssb_pcmcia_switch_segment(struct ssb_bus *bus, u8 seg)
goto out_unlock; goto out_unlock;
} }
/* These are the main device register access functions. static int select_core_and_segment(struct ssb_device *dev,
* do_select_core is inline to have the likely hotpath inline. u16 *offset)
* All unlikely codepaths are out-of-line. */
static inline int do_select_core(struct ssb_bus *bus,
struct ssb_device *dev,
u16 *offset)
{ {
struct ssb_bus *bus = dev->bus;
int err; int err;
u8 need_seg = (*offset >= 0x800) ? 1 : 0; u8 need_segment;
if (*offset >= 0x800) {
*offset -= 0x800;
need_segment = 1;
} else
need_segment = 0;
if (unlikely(dev != bus->mapped_device)) { if (unlikely(dev != bus->mapped_device)) {
err = ssb_pcmcia_switch_core(bus, dev); err = ssb_pcmcia_switch_core(bus, dev);
if (unlikely(err)) if (unlikely(err))
return err; return err;
} }
if (unlikely(need_seg != bus->mapped_pcmcia_seg)) { if (unlikely(need_segment != bus->mapped_pcmcia_seg)) {
err = ssb_pcmcia_switch_segment(bus, need_seg); err = ssb_pcmcia_switch_segment(bus, need_segment);
if (unlikely(err)) if (unlikely(err))
return err; return err;
} }
if (need_seg == 1)
*offset -= 0x800;
return 0; return 0;
} }
...@@ -181,32 +182,31 @@ static inline int do_select_core(struct ssb_bus *bus, ...@@ -181,32 +182,31 @@ static inline int do_select_core(struct ssb_bus *bus,
static u16 ssb_pcmcia_read16(struct ssb_device *dev, u16 offset) static u16 ssb_pcmcia_read16(struct ssb_device *dev, u16 offset)
{ {
struct ssb_bus *bus = dev->bus; struct ssb_bus *bus = dev->bus;
u16 x;
if (unlikely(do_select_core(bus, dev, &offset))) if (unlikely(select_core_and_segment(dev, &offset)))
return 0xFFFF; return 0xFFFF;
x = readw(bus->mmio + offset);
return x; return readw(bus->mmio + offset);
} }
static u32 ssb_pcmcia_read32(struct ssb_device *dev, u16 offset) static u32 ssb_pcmcia_read32(struct ssb_device *dev, u16 offset)
{ {
struct ssb_bus *bus = dev->bus; struct ssb_bus *bus = dev->bus;
u32 x; u32 lo, hi;
if (unlikely(do_select_core(bus, dev, &offset))) if (unlikely(select_core_and_segment(dev, &offset)))
return 0xFFFFFFFF; return 0xFFFFFFFF;
x = readl(bus->mmio + offset); lo = readw(bus->mmio + offset);
hi = readw(bus->mmio + offset + 2);
return x; return (lo | (hi << 16));
} }
static void ssb_pcmcia_write16(struct ssb_device *dev, u16 offset, u16 value) static void ssb_pcmcia_write16(struct ssb_device *dev, u16 offset, u16 value)
{ {
struct ssb_bus *bus = dev->bus; struct ssb_bus *bus = dev->bus;
if (unlikely(do_select_core(bus, dev, &offset))) if (unlikely(select_core_and_segment(dev, &offset)))
return; return;
writew(value, bus->mmio + offset); writew(value, bus->mmio + offset);
} }
...@@ -215,12 +215,12 @@ static void ssb_pcmcia_write32(struct ssb_device *dev, u16 offset, u32 value) ...@@ -215,12 +215,12 @@ static void ssb_pcmcia_write32(struct ssb_device *dev, u16 offset, u32 value)
{ {
struct ssb_bus *bus = dev->bus; struct ssb_bus *bus = dev->bus;
if (unlikely(do_select_core(bus, dev, &offset))) if (unlikely(select_core_and_segment(dev, &offset)))
return; return;
readw(bus->mmio + offset); writeb((value & 0xFF000000) >> 24, bus->mmio + offset + 3);
writew(value >> 16, bus->mmio + offset + 2); writeb((value & 0x00FF0000) >> 16, bus->mmio + offset + 2);
readw(bus->mmio + offset); writeb((value & 0x0000FF00) >> 8, bus->mmio + offset + 1);
writew(value, bus->mmio + offset); writeb((value & 0x000000FF) >> 0, bus->mmio + offset + 0);
} }
/* Not "static", as it's used in main.c */ /* Not "static", as it's used in main.c */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment