|
@@ -92,17 +92,26 @@ struct spi_sh_data {
|
|
|
unsigned long cr1;
|
|
|
wait_queue_head_t wait;
|
|
|
spinlock_t lock;
|
|
|
+ int width;
|
|
|
};
|
|
|
|
|
|
static void spi_sh_write(struct spi_sh_data *ss, unsigned long data,
|
|
|
unsigned long offset)
|
|
|
{
|
|
|
- writel(data, ss->addr + offset);
|
|
|
+ if (ss->width == 8)
|
|
|
+ iowrite8(data, ss->addr + (offset >> 2));
|
|
|
+ else if (ss->width == 32)
|
|
|
+ iowrite32(data, ss->addr + offset);
|
|
|
}
|
|
|
|
|
|
static unsigned long spi_sh_read(struct spi_sh_data *ss, unsigned long offset)
|
|
|
{
|
|
|
- return readl(ss->addr + offset);
|
|
|
+ if (ss->width == 8)
|
|
|
+ return ioread8(ss->addr + (offset >> 2));
|
|
|
+ else if (ss->width == 32)
|
|
|
+ return ioread32(ss->addr + offset);
|
|
|
+ else
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static void spi_sh_set_bit(struct spi_sh_data *ss, unsigned long val,
|
|
@@ -464,6 +473,18 @@ static int __devinit spi_sh_probe(struct platform_device *pdev)
|
|
|
ss = spi_master_get_devdata(master);
|
|
|
dev_set_drvdata(&pdev->dev, ss);
|
|
|
|
|
|
+ switch (res->flags & IORESOURCE_MEM_TYPE_MASK) {
|
|
|
+ case IORESOURCE_MEM_8BIT:
|
|
|
+ ss->width = 8;
|
|
|
+ break;
|
|
|
+ case IORESOURCE_MEM_32BIT:
|
|
|
+ ss->width = 32;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ dev_err(&pdev->dev, "No support width\n");
|
|
|
+ ret = -ENODEV;
|
|
|
+ goto error1;
|
|
|
+ }
|
|
|
ss->irq = irq;
|
|
|
ss->master = master;
|
|
|
ss->addr = ioremap(res->start, resource_size(res));
|