From 75880ac0ad974e9b2a2f2c77d00463bf7f354bc2 Mon Sep 17 00:00:00 2001 From: Jean-Christophe PLAGNIOL-VILLARD Date: Sat, 1 Sep 2012 10:52:40 +0200 Subject: smc911x: add 16bit bus width support Signed-off-by: Jean-Christophe PLAGNIOL-VILLARD Signed-off-by: Sascha Hauer --- drivers/net/smc911x.c | 34 +++++++++++++++++++++++++++++----- 1 file changed, 29 insertions(+), 5 deletions(-) diff --git a/drivers/net/smc911x.c b/drivers/net/smc911x.c index 2583235372..917f99453e 100644 --- a/drivers/net/smc911x.c +++ b/drivers/net/smc911x.c @@ -76,7 +76,13 @@ static inline u32 smc911x_reg_read(struct smc911x_priv *priv, u32 reg) return priv->reg_read(priv, reg); } -static inline u32 __smc911x_reg_read(struct smc911x_priv *priv, u32 reg) +static inline u32 __smc911x_reg_readw(struct smc911x_priv *priv, u32 reg) +{ + return ((readw(priv->base + reg) & 0xFFFF) | + ((readw(priv->base + reg + 2) & 0xFFFF) << 16)); +} + +static inline u32 __smc911x_reg_readl(struct smc911x_priv *priv, u32 reg) { return readl(priv->base + reg); } @@ -87,7 +93,14 @@ static inline void smc911x_reg_write(struct smc911x_priv *priv, u32 reg, priv->reg_write(priv, reg, val); } -static inline void __smc911x_reg_write(struct smc911x_priv *priv, u32 reg, +static inline void __smc911x_reg_writew(struct smc911x_priv *priv, u32 reg, + u32 val) +{ + writew(val & 0xFFFF, priv->base + reg); + writew((val >> 16) & 0xFFFF, priv->base + reg + 2); +} + +static inline void __smc911x_reg_writel(struct smc911x_priv *priv, u32 reg, u32 val) { writel(val, priv->base + reg); @@ -390,12 +403,23 @@ static int smc911x_probe(struct device_d *dev) struct eth_device *edev; struct smc911x_priv *priv; uint32_t val; - int i; + int i, is_32bit; priv = xzalloc(sizeof(*priv)); + is_32bit = dev->resource[0].flags & IORESOURCE_MEM_TYPE_MASK; + if (!is_32bit) + is_32bit = 1; + else + is_32bit = is_32bit == IORESOURCE_MEM_32BIT; priv->base = dev_request_mem_region(dev, 0); - priv->reg_read = __smc911x_reg_read; - priv->reg_write = __smc911x_reg_write; + + if (is_32bit) { + priv->reg_read = __smc911x_reg_readl; + priv->reg_write = __smc911x_reg_writel; + } else { + priv->reg_read = __smc911x_reg_readw; + priv->reg_write = __smc911x_reg_writew; + } val = smc911x_reg_read(priv, BYTE_TEST); if(val != 0x87654321) { -- cgit v1.2.3