1 #include <linux/err.h> 2 #include <linux/kernel.h> 3 #include <linux/init.h> 4 #include <linux/io.h> 5 #include <linux/platform_device.h> 6 #include <linux/ata_platform.h> 7 8 #include <asm/sibyte/board.h> 9 #include <asm/sibyte/sb1250_genbus.h> 10 #include <asm/sibyte/sb1250_regs.h> 11 12 #if defined(CONFIG_SIBYTE_SWARM) || defined(CONFIG_SIBYTE_LITTLESUR) 13 14 #define DRV_NAME "pata-swarm" 15 16 #define SWARM_IDE_SHIFT 5 17 #define SWARM_IDE_BASE 0x1f0 18 #define SWARM_IDE_CTRL 0x3f6 19 20 static struct resource swarm_pata_resource[] = { 21 { 22 .name = "Swarm GenBus IDE", 23 .flags = IORESOURCE_MEM, 24 }, { 25 .name = "Swarm GenBus IDE", 26 .flags = IORESOURCE_MEM, 27 }, { 28 .name = "Swarm GenBus IDE", 29 .flags = IORESOURCE_IRQ, 30 .start = K_INT_GB_IDE, 31 .end = K_INT_GB_IDE, 32 }, 33 }; 34 35 static struct pata_platform_info pata_platform_data = { 36 .ioport_shift = SWARM_IDE_SHIFT, 37 }; 38 39 static struct platform_device swarm_pata_device = { 40 .name = "pata_platform", 41 .id = -1, 42 .resource = swarm_pata_resource, 43 .num_resources = ARRAY_SIZE(swarm_pata_resource), 44 .dev = { 45 .platform_data = &pata_platform_data, 46 .coherent_dma_mask = ~0, /* grumble */ 47 }, 48 }; 49 50 static int __init swarm_pata_init(void) 51 { 52 u8 __iomem *base; 53 phys_t offset, size; 54 struct resource *r; 55 56 if (!SIBYTE_HAVE_IDE) 57 return -ENODEV; 58 59 base = ioremap(A_IO_EXT_BASE, 0x800); 60 offset = __raw_readq(base + R_IO_EXT_REG(R_IO_EXT_START_ADDR, IDE_CS)); 61 size = __raw_readq(base + R_IO_EXT_REG(R_IO_EXT_MULT_SIZE, IDE_CS)); 62 iounmap(base); 63 64 offset = G_IO_START_ADDR(offset) << S_IO_ADDRBASE; 65 size = (G_IO_MULT_SIZE(size) + 1) << S_IO_REGSIZE; 66 if (offset < A_PHYS_GENBUS || offset >= A_PHYS_GENBUS_END) { 67 pr_info(DRV_NAME ": PATA interface at GenBus disabled\n"); 68 69 return -EBUSY; 70 } 71 72 pr_info(DRV_NAME ": PATA interface at GenBus slot %i\n", IDE_CS); 73 74 r = swarm_pata_resource; 75 r[0].start = offset + (SWARM_IDE_BASE << SWARM_IDE_SHIFT); 76 r[0].end = offset + ((SWARM_IDE_BASE + 8) << SWARM_IDE_SHIFT) - 1; 77 r[1].start = offset + (SWARM_IDE_CTRL << SWARM_IDE_SHIFT); 78 r[1].end = offset + ((SWARM_IDE_CTRL + 1) << SWARM_IDE_SHIFT) - 1; 79 80 return platform_device_register(&swarm_pata_device); 81 } 82 83 device_initcall(swarm_pata_init); 84 85 #endif /* defined(CONFIG_SIBYTE_SWARM) || defined(CONFIG_SIBYTE_LITTLESUR) */ 86