Blame view
drivers/ata/pata_icside.c
16 KB
73b6a2be8 [ARM] Add support... |
1 2 3 4 |
#include <linux/kernel.h> #include <linux/module.h> #include <linux/init.h> #include <linux/blkdev.h> |
5a0e3ad6a include cleanup: ... |
5 |
#include <linux/gfp.h> |
73b6a2be8 [ARM] Add support... |
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 |
#include <scsi/scsi_host.h> #include <linux/ata.h> #include <linux/libata.h> #include <asm/dma.h> #include <asm/ecard.h> #define DRV_NAME "pata_icside" #define ICS_IDENT_OFFSET 0x2280 #define ICS_ARCIN_V5_INTRSTAT 0x0000 #define ICS_ARCIN_V5_INTROFFSET 0x0004 #define ICS_ARCIN_V6_INTROFFSET_1 0x2200 #define ICS_ARCIN_V6_INTRSTAT_1 0x2290 #define ICS_ARCIN_V6_INTROFFSET_2 0x3200 #define ICS_ARCIN_V6_INTRSTAT_2 0x3290 struct portinfo { unsigned int dataoffset; unsigned int ctrloffset; unsigned int stepping; }; static const struct portinfo pata_icside_portinfo_v5 = { .dataoffset = 0x2800, .ctrloffset = 0x2b80, .stepping = 6, }; static const struct portinfo pata_icside_portinfo_v6_1 = { .dataoffset = 0x2000, .ctrloffset = 0x2380, .stepping = 6, }; static const struct portinfo pata_icside_portinfo_v6_2 = { .dataoffset = 0x3000, .ctrloffset = 0x3380, .stepping = 6, }; |
73b6a2be8 [ARM] Add support... |
48 49 50 51 52 53 54 55 56 57 |
struct pata_icside_state { void __iomem *irq_port; void __iomem *ioc_base; unsigned int type; unsigned int dma; struct { u8 port_sel; u8 disabled; unsigned int speed[ATA_MAX_DEVICES]; } port[2]; |
73b6a2be8 [ARM] Add support... |
58 |
}; |
f95637d2c [ARM] pata_icside... |
59 60 61 62 63 64 65 66 67 68 |
struct pata_icside_info { struct pata_icside_state *state; struct expansion_card *ec; void __iomem *base; void __iomem *irqaddr; unsigned int irqmask; const expansioncard_ops_t *irqops; unsigned int mwdma_mask; unsigned int nr_ports; const struct portinfo *port[2]; |
cbcdd8759 libata: implement... |
69 70 |
unsigned long raw_base; unsigned long raw_ioc_base; |
f95637d2c [ARM] pata_icside... |
71 |
}; |
73b6a2be8 [ARM] Add support... |
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 |
#define ICS_TYPE_A3IN 0 #define ICS_TYPE_A3USER 1 #define ICS_TYPE_V6 3 #define ICS_TYPE_V5 15 #define ICS_TYPE_NOTYPE ((unsigned int)-1) /* ---------------- Version 5 PCB Support Functions --------------------- */ /* Prototype: pata_icside_irqenable_arcin_v5 (struct expansion_card *ec, int irqnr) * Purpose : enable interrupts from card */ static void pata_icside_irqenable_arcin_v5 (struct expansion_card *ec, int irqnr) { struct pata_icside_state *state = ec->irq_data; writeb(0, state->irq_port + ICS_ARCIN_V5_INTROFFSET); } /* Prototype: pata_icside_irqdisable_arcin_v5 (struct expansion_card *ec, int irqnr) * Purpose : disable interrupts from card */ static void pata_icside_irqdisable_arcin_v5 (struct expansion_card *ec, int irqnr) { struct pata_icside_state *state = ec->irq_data; readb(state->irq_port + ICS_ARCIN_V5_INTROFFSET); } static const expansioncard_ops_t pata_icside_ops_arcin_v5 = { .irqenable = pata_icside_irqenable_arcin_v5, .irqdisable = pata_icside_irqdisable_arcin_v5, }; /* ---------------- Version 6 PCB Support Functions --------------------- */ /* Prototype: pata_icside_irqenable_arcin_v6 (struct expansion_card *ec, int irqnr) * Purpose : enable interrupts from card */ static void pata_icside_irqenable_arcin_v6 (struct expansion_card *ec, int irqnr) { struct pata_icside_state *state = ec->irq_data; void __iomem *base = state->irq_port; if (!state->port[0].disabled) writeb(0, base + ICS_ARCIN_V6_INTROFFSET_1); if (!state->port[1].disabled) writeb(0, base + ICS_ARCIN_V6_INTROFFSET_2); } /* Prototype: pata_icside_irqdisable_arcin_v6 (struct expansion_card *ec, int irqnr) * Purpose : disable interrupts from card */ static void pata_icside_irqdisable_arcin_v6 (struct expansion_card *ec, int irqnr) { struct pata_icside_state *state = ec->irq_data; readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_1); readb(state->irq_port + ICS_ARCIN_V6_INTROFFSET_2); } /* Prototype: pata_icside_irqprobe(struct expansion_card *ec) * Purpose : detect an active interrupt from card */ static int pata_icside_irqpending_arcin_v6(struct expansion_card *ec) { struct pata_icside_state *state = ec->irq_data; return readb(state->irq_port + ICS_ARCIN_V6_INTRSTAT_1) & 1 || readb(state->irq_port + ICS_ARCIN_V6_INTRSTAT_2) & 1; } static const expansioncard_ops_t pata_icside_ops_arcin_v6 = { .irqenable = pata_icside_irqenable_arcin_v6, .irqdisable = pata_icside_irqdisable_arcin_v6, .irqpending = pata_icside_irqpending_arcin_v6, }; /* * SG-DMA support. * * Similar to the BM-DMA, but we use the RiscPCs IOMD DMA controllers. * There is only one DMA controller per card, which means that only * one drive can be accessed at one time. NOTE! We do not enforce that * here, but we rely on the main IDE driver spotting that both * interfaces use the same IRQ, which should guarantee this. */ /* * Configure the IOMD to give the appropriate timings for the transfer * mode being requested. We take the advice of the ATA standards, and * calculate the cycle time based on the transfer mode, and the EIDE * MW DMA specs that the drive provides in the IDENTIFY command. * * We have the following IOMD DMA modes to choose from: * * Type Active Recovery Cycle * A 250 (250) 312 (550) 562 (800) * B 187 (200) 250 (550) 437 (750) * C 125 (125) 125 (375) 250 (500) * D 62 (50) 125 (375) 187 (425) * * (figures in brackets are actual measured timings on DIOR/DIOW) * * However, we also need to take care of the read/write active and * recovery timings: * * Read Write * Mode Active -- Recovery -- Cycle IOMD type * MW0 215 50 215 480 A * MW1 80 50 50 150 C * MW2 70 25 25 120 C */ static void pata_icside_set_dmamode(struct ata_port *ap, struct ata_device *adev) { struct pata_icside_state *state = ap->host->private_data; struct ata_timing t; unsigned int cycle; char iomd_type; /* * DMA is based on a 16MHz clock */ if (ata_timing_compute(adev, adev->dma_mode, &t, 1000, 1)) return; /* * Choose the IOMD cycle timing which ensure that the interface * satisfies the measured active, recovery and cycle times. */ if (t.active <= 50 && t.recover <= 375 && t.cycle <= 425) iomd_type = 'D', cycle = 187; else if (t.active <= 125 && t.recover <= 375 && t.cycle <= 500) iomd_type = 'C', cycle = 250; else if (t.active <= 200 && t.recover <= 550 && t.cycle <= 750) iomd_type = 'B', cycle = 437; else iomd_type = 'A', cycle = 562; |
a9a79dfec ata: Convert ata_... |
209 210 211 |
ata_dev_info(adev, "timings: act %dns rec %dns cyc %dns (%c) ", t.active, t.recover, t.cycle, iomd_type); |
73b6a2be8 [ARM] Add support... |
212 213 214 215 216 217 218 219 |
state->port[ap->port_no].speed[adev->devno] = cycle; } static void pata_icside_bmdma_setup(struct ata_queued_cmd *qc) { struct ata_port *ap = qc->ap; struct pata_icside_state *state = ap->host->private_data; |
73b6a2be8 [ARM] Add support... |
220 221 222 223 224 225 226 227 228 |
unsigned int write = qc->tf.flags & ATA_TFLAG_WRITE; /* * We are simplex; BUG if we try to fiddle with DMA * while it's active. */ BUG_ON(dma_channel_active(state->dma)); /* |
73b6a2be8 [ARM] Add support... |
229 230 231 232 233 |
* Route the DMA signals to the correct interface */ writeb(state->port[ap->port_no].port_sel, state->ioc_base); set_dma_speed(state->dma, state->port[ap->port_no].speed[qc->dev->devno]); |
f67186533 [ARM] dma: pata_i... |
234 |
set_dma_sg(state->dma, qc->sg, qc->n_elem); |
73b6a2be8 [ARM] Add support... |
235 236 237 |
set_dma_mode(state->dma, write ? DMA_MODE_WRITE : DMA_MODE_READ); /* issue r/w command */ |
5682ed33a libata: rename SF... |
238 |
ap->ops->sff_exec_command(ap, &qc->tf); |
73b6a2be8 [ARM] Add support... |
239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 |
} static void pata_icside_bmdma_start(struct ata_queued_cmd *qc) { struct ata_port *ap = qc->ap; struct pata_icside_state *state = ap->host->private_data; BUG_ON(dma_channel_active(state->dma)); enable_dma(state->dma); } static void pata_icside_bmdma_stop(struct ata_queued_cmd *qc) { struct ata_port *ap = qc->ap; struct pata_icside_state *state = ap->host->private_data; disable_dma(state->dma); /* see ata_bmdma_stop */ |
a57c1bade libata-sff: Fix o... |
258 |
ata_sff_dma_pause(ap); |
73b6a2be8 [ARM] Add support... |
259 260 261 262 263 264 265 266 267 268 269 270 |
} static u8 pata_icside_bmdma_status(struct ata_port *ap) { struct pata_icside_state *state = ap->host->private_data; void __iomem *irq_port; irq_port = state->irq_port + (ap->port_no ? ICS_ARCIN_V6_INTRSTAT_2 : ICS_ARCIN_V6_INTRSTAT_1); return readb(irq_port) & 1 ? ATA_DMA_INTR : 0; } |
f95637d2c [ARM] pata_icside... |
271 |
static int icside_dma_init(struct pata_icside_info *info) |
73b6a2be8 [ARM] Add support... |
272 |
{ |
f95637d2c [ARM] pata_icside... |
273 274 |
struct pata_icside_state *state = info->state; struct expansion_card *ec = info->ec; |
73b6a2be8 [ARM] Add support... |
275 276 277 278 279 280 281 282 283 |
int i; for (i = 0; i < ATA_MAX_DEVICES; i++) { state->port[0].speed[i] = 480; state->port[1].speed[i] = 480; } if (ec->dma != NO_DMA && !request_dma(ec->dma, DRV_NAME)) { state->dma = ec->dma; |
14bdef982 [libata] convert ... |
284 |
info->mwdma_mask = ATA_MWDMA2; |
73b6a2be8 [ARM] Add support... |
285 286 287 288 |
} return 0; } |
73b6a2be8 [ARM] Add support... |
289 |
static struct scsi_host_template pata_icside_sht = { |
68d1d07b5 libata: implement... |
290 |
ATA_BASE_SHT(DRV_NAME), |
65e8617fb scsi: rename SCSI... |
291 |
.sg_tablesize = SG_MAX_SEGMENTS, |
5369bea7d [ARM] dma: Use se... |
292 |
.dma_boundary = IOMD_DMA_BOUNDARY, |
73b6a2be8 [ARM] Add support... |
293 |
}; |
c15fcafe1 Fix pata_icside b... |
294 |
static void pata_icside_postreset(struct ata_link *link, unsigned int *classes) |
73b6a2be8 [ARM] Add support... |
295 |
{ |
c15fcafe1 Fix pata_icside b... |
296 |
struct ata_port *ap = link->ap; |
73b6a2be8 [ARM] Add support... |
297 |
struct pata_icside_state *state = ap->host->private_data; |
eba84481c [ARM] pata_icside... |
298 |
if (classes[0] != ATA_DEV_NONE || classes[1] != ATA_DEV_NONE) |
9363c3825 libata: rename SF... |
299 |
return ata_sff_postreset(link, classes); |
73b6a2be8 [ARM] Add support... |
300 301 302 303 304 305 306 307 308 309 310 311 312 313 |
state->port[ap->port_no].disabled = 1; if (state->type == ICS_TYPE_V6) { /* * Disable interrupts from this port, otherwise we * receive spurious interrupts from the floating * interrupt line. */ void __iomem *irq_port = state->irq_port + (ap->port_no ? ICS_ARCIN_V6_INTROFFSET_2 : ICS_ARCIN_V6_INTROFFSET_1); readb(irq_port); } } |
73b6a2be8 [ARM] Add support... |
314 |
static struct ata_port_operations pata_icside_port_ops = { |
8930ff254 libata-sff: clean... |
315 |
.inherits = &ata_bmdma_port_ops, |
73b6a2be8 [ARM] Add support... |
316 317 |
/* no need to build any PRD tables for DMA */ .qc_prep = ata_noop_qc_prep, |
5682ed33a libata: rename SF... |
318 |
.sff_data_xfer = ata_sff_data_xfer_noirq, |
029cfd6b7 libata: implement... |
319 320 321 322 |
.bmdma_setup = pata_icside_bmdma_setup, .bmdma_start = pata_icside_bmdma_start, .bmdma_stop = pata_icside_bmdma_stop, .bmdma_status = pata_icside_bmdma_status, |
73b6a2be8 [ARM] Add support... |
323 |
|
029cfd6b7 libata: implement... |
324 325 |
.cable_detect = ata_cable_40wire, .set_dmamode = pata_icside_set_dmamode, |
a1efdaba2 libata: make rese... |
326 |
.postreset = pata_icside_postreset, |
8930ff254 libata-sff: clean... |
327 |
|
c7087652e libata-sff: clean... |
328 |
.port_start = ATA_OP_NULL, /* don't need PRD table */ |
73b6a2be8 [ARM] Add support... |
329 |
}; |
0ec249146 Drivers: ata: rem... |
330 331 332 |
static void pata_icside_setup_ioaddr(struct ata_port *ap, void __iomem *base, struct pata_icside_info *info, const struct portinfo *port) |
73b6a2be8 [ARM] Add support... |
333 |
{ |
cbcdd8759 libata: implement... |
334 |
struct ata_ioports *ioaddr = &ap->ioaddr; |
c15fcafe1 Fix pata_icside b... |
335 |
void __iomem *cmd = base + port->dataoffset; |
73b6a2be8 [ARM] Add support... |
336 337 |
ioaddr->cmd_addr = cmd; |
c15fcafe1 Fix pata_icside b... |
338 339 340 341 342 343 344 345 346 347 348 349 |
ioaddr->data_addr = cmd + (ATA_REG_DATA << port->stepping); ioaddr->error_addr = cmd + (ATA_REG_ERR << port->stepping); ioaddr->feature_addr = cmd + (ATA_REG_FEATURE << port->stepping); ioaddr->nsect_addr = cmd + (ATA_REG_NSECT << port->stepping); ioaddr->lbal_addr = cmd + (ATA_REG_LBAL << port->stepping); ioaddr->lbam_addr = cmd + (ATA_REG_LBAM << port->stepping); ioaddr->lbah_addr = cmd + (ATA_REG_LBAH << port->stepping); ioaddr->device_addr = cmd + (ATA_REG_DEVICE << port->stepping); ioaddr->status_addr = cmd + (ATA_REG_STATUS << port->stepping); ioaddr->command_addr = cmd + (ATA_REG_CMD << port->stepping); ioaddr->ctl_addr = base + port->ctrloffset; |
73b6a2be8 [ARM] Add support... |
350 |
ioaddr->altstatus_addr = ioaddr->ctl_addr; |
cbcdd8759 libata: implement... |
351 352 |
ata_port_desc(ap, "cmd 0x%lx ctl 0x%lx", |
c15fcafe1 Fix pata_icside b... |
353 354 |
info->raw_base + port->dataoffset, info->raw_base + port->ctrloffset); |
cbcdd8759 libata: implement... |
355 356 357 |
if (info->raw_ioc_base) ata_port_desc(ap, "iocbase 0x%lx", info->raw_ioc_base); |
73b6a2be8 [ARM] Add support... |
358 |
} |
0ec249146 Drivers: ata: rem... |
359 |
static int pata_icside_register_v5(struct pata_icside_info *info) |
73b6a2be8 [ARM] Add support... |
360 |
{ |
f95637d2c [ARM] pata_icside... |
361 |
struct pata_icside_state *state = info->state; |
73b6a2be8 [ARM] Add support... |
362 |
void __iomem *base; |
10bdaaa0f [ARM] ecard: add ... |
363 |
base = ecardm_iomap(info->ec, ECARD_RES_MEMC, 0, 0); |
73b6a2be8 [ARM] Add support... |
364 365 366 367 |
if (!base) return -ENOMEM; state->irq_port = base; |
f95637d2c [ARM] pata_icside... |
368 369 370 371 372 373 |
info->base = base; info->irqaddr = base + ICS_ARCIN_V5_INTRSTAT; info->irqmask = 1; info->irqops = &pata_icside_ops_arcin_v5; info->nr_ports = 1; info->port[0] = &pata_icside_portinfo_v5; |
73b6a2be8 [ARM] Add support... |
374 |
|
c15fcafe1 Fix pata_icside b... |
375 |
info->raw_base = ecard_resource_start(info->ec, ECARD_RES_MEMC); |
cbcdd8759 libata: implement... |
376 |
|
73b6a2be8 [ARM] Add support... |
377 378 |
return 0; } |
0ec249146 Drivers: ata: rem... |
379 |
static int pata_icside_register_v6(struct pata_icside_info *info) |
73b6a2be8 [ARM] Add support... |
380 |
{ |
f95637d2c [ARM] pata_icside... |
381 382 |
struct pata_icside_state *state = info->state; struct expansion_card *ec = info->ec; |
73b6a2be8 [ARM] Add support... |
383 384 |
void __iomem *ioc_base, *easi_base; unsigned int sel = 0; |
73b6a2be8 [ARM] Add support... |
385 |
|
10bdaaa0f [ARM] ecard: add ... |
386 387 388 |
ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0); if (!ioc_base) return -ENOMEM; |
73b6a2be8 [ARM] Add support... |
389 390 391 392 |
easi_base = ioc_base; if (ecard_resource_flags(ec, ECARD_RES_EASI)) { |
10bdaaa0f [ARM] ecard: add ... |
393 394 395 |
easi_base = ecardm_iomap(ec, ECARD_RES_EASI, 0, 0); if (!easi_base) return -ENOMEM; |
73b6a2be8 [ARM] Add support... |
396 397 398 399 400 401 402 403 |
/* * Enable access to the EASI region. */ sel = 1 << 5; } writeb(sel, ioc_base); |
73b6a2be8 [ARM] Add support... |
404 405 406 407 |
state->irq_port = easi_base; state->ioc_base = ioc_base; state->port[0].port_sel = sel; state->port[1].port_sel = sel | 1; |
f95637d2c [ARM] pata_icside... |
408 409 410 411 412 |
info->base = easi_base; info->irqops = &pata_icside_ops_arcin_v6; info->nr_ports = 2; info->port[0] = &pata_icside_portinfo_v6_1; info->port[1] = &pata_icside_portinfo_v6_2; |
cbcdd8759 libata: implement... |
413 414 |
info->raw_base = ecard_resource_start(ec, ECARD_RES_EASI); info->raw_ioc_base = ecard_resource_start(ec, ECARD_RES_IOCFAST); |
f95637d2c [ARM] pata_icside... |
415 416 |
return icside_dma_init(info); } |
0ec249146 Drivers: ata: rem... |
417 |
static int pata_icside_add_ports(struct pata_icside_info *info) |
f95637d2c [ARM] pata_icside... |
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 |
{ struct expansion_card *ec = info->ec; struct ata_host *host; int i; if (info->irqaddr) { ec->irqaddr = info->irqaddr; ec->irqmask = info->irqmask; } if (info->irqops) ecard_setirq(ec, info->irqops, info->state); /* * Be on the safe side - disable interrupts */ ec->ops->irqdisable(ec, ec->irq); host = ata_host_alloc(&ec->dev, info->nr_ports); if (!host) return -ENOMEM; host->private_data = info->state; host->flags = ATA_HOST_SIMPLEX; for (i = 0; i < info->nr_ports; i++) { struct ata_port *ap = host->ports[i]; |
14bdef982 [libata] convert ... |
444 |
ap->pio_mask = ATA_PIO4; |
f95637d2c [ARM] pata_icside... |
445 |
ap->mwdma_mask = info->mwdma_mask; |
1d2808fd3 [libata] PATA dri... |
446 |
ap->flags |= ATA_FLAG_SLAVE_POSS; |
f95637d2c [ARM] pata_icside... |
447 |
ap->ops = &pata_icside_port_ops; |
c15fcafe1 Fix pata_icside b... |
448 |
pata_icside_setup_ioaddr(ap, info->base, info, info->port[i]); |
f95637d2c [ARM] pata_icside... |
449 |
} |
73b6a2be8 [ARM] Add support... |
450 |
|
c3b288942 libata-sff: separ... |
451 |
return ata_host_activate(host, ec->irq, ata_bmdma_interrupt, 0, |
f95637d2c [ARM] pata_icside... |
452 |
&pata_icside_sht); |
73b6a2be8 [ARM] Add support... |
453 |
} |
0ec249146 Drivers: ata: rem... |
454 455 |
static int pata_icside_probe(struct expansion_card *ec, const struct ecard_id *id) |
73b6a2be8 [ARM] Add support... |
456 457 |
{ struct pata_icside_state *state; |
f95637d2c [ARM] pata_icside... |
458 |
struct pata_icside_info info; |
73b6a2be8 [ARM] Add support... |
459 460 461 462 463 464 |
void __iomem *idmem; int ret; ret = ecard_request_resources(ec); if (ret) goto out; |
f95637d2c [ARM] pata_icside... |
465 |
state = devm_kzalloc(&ec->dev, sizeof(*state), GFP_KERNEL); |
73b6a2be8 [ARM] Add support... |
466 467 468 469 470 471 472 |
if (!state) { ret = -ENOMEM; goto release; } state->type = ICS_TYPE_NOTYPE; state->dma = NO_DMA; |
10bdaaa0f [ARM] ecard: add ... |
473 |
idmem = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0); |
73b6a2be8 [ARM] Add support... |
474 475 476 477 478 479 480 |
if (idmem) { unsigned int type; type = readb(idmem + ICS_IDENT_OFFSET) & 1; type |= (readb(idmem + ICS_IDENT_OFFSET + 4) & 1) << 1; type |= (readb(idmem + ICS_IDENT_OFFSET + 8) & 1) << 2; type |= (readb(idmem + ICS_IDENT_OFFSET + 12) & 1) << 3; |
10bdaaa0f [ARM] ecard: add ... |
481 |
ecardm_iounmap(ec, idmem); |
73b6a2be8 [ARM] Add support... |
482 483 484 |
state->type = type; } |
f95637d2c [ARM] pata_icside... |
485 486 487 |
memset(&info, 0, sizeof(info)); info.state = state; info.ec = ec; |
73b6a2be8 [ARM] Add support... |
488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 |
switch (state->type) { case ICS_TYPE_A3IN: dev_warn(&ec->dev, "A3IN unsupported "); ret = -ENODEV; break; case ICS_TYPE_A3USER: dev_warn(&ec->dev, "A3USER unsupported "); ret = -ENODEV; break; case ICS_TYPE_V5: |
f95637d2c [ARM] pata_icside... |
503 |
ret = pata_icside_register_v5(&info); |
73b6a2be8 [ARM] Add support... |
504 505 506 |
break; case ICS_TYPE_V6: |
f95637d2c [ARM] pata_icside... |
507 |
ret = pata_icside_register_v6(&info); |
73b6a2be8 [ARM] Add support... |
508 509 510 511 512 513 514 515 516 517 |
break; default: dev_warn(&ec->dev, "unknown interface type "); ret = -ENODEV; break; } if (ret == 0) |
f95637d2c [ARM] pata_icside... |
518 |
ret = pata_icside_add_ports(&info); |
73b6a2be8 [ARM] Add support... |
519 520 521 |
if (ret == 0) goto out; |
73b6a2be8 [ARM] Add support... |
522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 |
release: ecard_release_resources(ec); out: return ret; } static void pata_icside_shutdown(struct expansion_card *ec) { struct ata_host *host = ecard_get_drvdata(ec); unsigned long flags; /* * Disable interrupts from this card. We need to do * this before disabling EASI since we may be accessing * this register via that region. */ local_irq_save(flags); |
c7b87f3d5 [ARM] ecard: add ... |
539 |
ec->ops->irqdisable(ec, ec->irq); |
73b6a2be8 [ARM] Add support... |
540 541 542 543 544 545 546 547 548 549 550 551 552 |
local_irq_restore(flags); /* * Reset the ROM pointer so that we can read the ROM * after a soft reboot. This also disables access to * the IDE taskfile via the EASI region. */ if (host) { struct pata_icside_state *state = host->private_data; if (state->ioc_base) writeb(0, state->ioc_base); } } |
0ec249146 Drivers: ata: rem... |
553 |
static void pata_icside_remove(struct expansion_card *ec) |
73b6a2be8 [ARM] Add support... |
554 555 556 557 558 559 560 561 562 563 564 565 |
{ struct ata_host *host = ecard_get_drvdata(ec); struct pata_icside_state *state = host->private_data; ata_host_detach(host); pata_icside_shutdown(ec); /* * don't NULL out the drvdata - devres/libata wants it * to free the ata_host structure. */ |
73b6a2be8 [ARM] Add support... |
566 567 |
if (state->dma != NO_DMA) free_dma(state->dma); |
73b6a2be8 [ARM] Add support... |
568 |
|
73b6a2be8 [ARM] Add support... |
569 570 571 572 573 574 575 576 577 578 579 |
ecard_release_resources(ec); } static const struct ecard_id pata_icside_ids[] = { { MANU_ICS, PROD_ICS_IDE }, { MANU_ICS2, PROD_ICS2_IDE }, { 0xffff, 0xffff } }; static struct ecard_driver pata_icside_driver = { .probe = pata_icside_probe, |
0ec249146 Drivers: ata: rem... |
580 |
.remove = pata_icside_remove, |
73b6a2be8 [ARM] Add support... |
581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 |
.shutdown = pata_icside_shutdown, .id_table = pata_icside_ids, .drv = { .name = DRV_NAME, }, }; static int __init pata_icside_init(void) { return ecard_register_driver(&pata_icside_driver); } static void __exit pata_icside_exit(void) { ecard_remove_driver(&pata_icside_driver); } MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>"); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("ICS PATA driver"); module_init(pata_icside_init); module_exit(pata_icside_exit); |