/* * Intel XScale PXA255/270 PC Card and CompactFlash Interface. * * Copyright (c) 2006 Openedhand Ltd. * Written by Andrzej Zaborowski * * This code is licensed under the GPLv2. */ #include "hw.h" #include "pcmcia.h" struct pxa2xx_pcmcia_s { struct pcmcia_socket_s slot; struct pcmcia_card_s *card; target_phys_addr_t common_base; target_phys_addr_t attr_base; target_phys_addr_t io_base; qemu_irq irq; qemu_irq cd_irq; }; static uint32_t pxa2xx_pcmcia_common_read(void *opaque, target_phys_addr_t offset) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) { offset -= s->common_base; return s->card->common_read(s->card->state, offset); } return 0; } static void pxa2xx_pcmcia_common_write(void *opaque, target_phys_addr_t offset, uint32_t value) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) { offset -= s->common_base; s->card->common_write(s->card->state, offset, value); } } static uint32_t pxa2xx_pcmcia_attr_read(void *opaque, target_phys_addr_t offset) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) { offset -= s->attr_base; return s->card->attr_read(s->card->state, offset); } return 0; } static void pxa2xx_pcmcia_attr_write(void *opaque, target_phys_addr_t offset, uint32_t value) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) { offset -= s->attr_base; s->card->attr_write(s->card->state, offset, value); } } static uint32_t pxa2xx_pcmcia_io_read(void *opaque, target_phys_addr_t offset) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) { offset -= s->io_base; return s->card->io_read(s->card->state, offset); } return 0; } static void pxa2xx_pcmcia_io_write(void *opaque, target_phys_addr_t offset, uint32_t value) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) { offset -= s->io_base; s->card->io_write(s->card->state, offset, value); } } static CPUReadMemoryFunc *pxa2xx_pcmcia_common_readfn[] = { pxa2xx_pcmcia_common_read, pxa2xx_pcmcia_common_read, pxa2xx_pcmcia_common_read, }; static CPUWriteMemoryFunc *pxa2xx_pcmcia_common_writefn[] = { pxa2xx_pcmcia_common_write, pxa2xx_pcmcia_common_write, pxa2xx_pcmcia_common_write, }; static CPUReadMemoryFunc *pxa2xx_pcmcia_attr_readfn[] = { pxa2xx_pcmcia_attr_read, pxa2xx_pcmcia_attr_read, pxa2xx_pcmcia_attr_read, }; static CPUWriteMemoryFunc *pxa2xx_pcmcia_attr_writefn[] = { pxa2xx_pcmcia_attr_write, pxa2xx_pcmcia_attr_write, pxa2xx_pcmcia_attr_write, }; static CPUReadMemoryFunc *pxa2xx_pcmcia_io_readfn[] = { pxa2xx_pcmcia_io_read, pxa2xx_pcmcia_io_read, pxa2xx_pcmcia_io_read, }; static CPUWriteMemoryFunc *pxa2xx_pcmcia_io_writefn[] = { pxa2xx_pcmcia_io_write, pxa2xx_pcmcia_io_write, pxa2xx_pcmcia_io_write, }; static void pxa2xx_pcmcia_set_irq(void *opaque, int line, int level) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (!s->irq) return; qemu_set_irq(s->irq, level); } struct pxa2xx_pcmcia_s *pxa2xx_pcmcia_init(target_phys_addr_t base) { int iomemtype; struct pxa2xx_pcmcia_s *s; s = (struct pxa2xx_pcmcia_s *) qemu_mallocz(sizeof(struct pxa2xx_pcmcia_s)); /* Socket I/O Memory Space */ s->io_base = base | 0x00000000; iomemtype = cpu_register_io_memory(0, pxa2xx_pcmcia_io_readfn, pxa2xx_pcmcia_io_writefn, s); cpu_register_physical_memory(s->io_base, 0x04000000, iomemtype); /* Then next 64 MB is reserved */ /* Socket Attribute Memory Space */ s->attr_base = base | 0x08000000; iomemtype = cpu_register_io_memory(0, pxa2xx_pcmcia_attr_readfn, pxa2xx_pcmcia_attr_writefn, s); cpu_register_physical_memory(s->attr_base, 0x04000000, iomemtype); /* Socket Common Memory Space */ s->common_base = base | 0x0c000000; iomemtype = cpu_register_io_memory(0, pxa2xx_pcmcia_common_readfn, pxa2xx_pcmcia_common_writefn, s); cpu_register_physical_memory(s->common_base, 0x04000000, iomemtype); if (base == 0x30000000) s->slot.slot_string = "PXA PC Card Socket 1"; else s->slot.slot_string = "PXA PC Card Socket 0"; s->slot.irq = qemu_allocate_irqs(pxa2xx_pcmcia_set_irq, s, 1)[0]; pcmcia_socket_register(&s->slot); return s; } /* Insert a new card into a slot */ int pxa2xx_pcmcia_attach(void *opaque, struct pcmcia_card_s *card) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (s->slot.attached) return -EEXIST; if (s->cd_irq) { qemu_irq_raise(s->cd_irq); } s->card = card; s->slot.attached = 1; s->card->slot = &s->slot; s->card->attach(s->card->state); return 0; } /* Eject card from the slot */ int pxa2xx_pcmcia_dettach(void *opaque) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; if (!s->slot.attached) return -ENOENT; s->card->detach(s->card->state); s->card->slot = 0; s->card = 0; s->slot.attached = 0; if (s->irq) qemu_irq_lower(s->irq); if (s->cd_irq) qemu_irq_lower(s->cd_irq); return 0; } /* Who to notify on card events */ void pxa2xx_pcmcia_set_irq_cb(void *opaque, qemu_irq irq, qemu_irq cd_irq) { struct pxa2xx_pcmcia_s *s = (struct pxa2xx_pcmcia_s *) opaque; s->irq = irq; s->cd_irq = cd_irq; }