V4L/DVB (13742): [Mantis] Implement PCMCIA I/O Rd/Wr operations

[safe/jmp/linux-2.6] / drivers / media / dvb / mantis / mantis_hif.c

diff --git a/drivers/media/dvb/mantis/mantis_hif.c b/drivers/media/dvb/mantis/mantis_hif.c
index 1472008..42aedf7 100644 (file)
--- a/drivers/media/dvb/mantis/mantis_hif.c
+++ b/drivers/media/dvb/mantis/mantis_hif.c
@@ -111,6 +111,60 @@ int mantis_hif_write_mem(struct mantis_ca *ca, u32 addr, u8 data)
        return 0;
 }
 
+int mantis_hif_read_iom(struct mantis_ca *ca, u32 addr, u32 count, u32 *data)
+{
+       struct mantis_pci *mantis = ca->ca_priv;
+       u32 hif_addr = 0;
+
+       hif_addr &= ~MANTIS_GPIF_PCMCIAREG;
+       hif_addr |=  MANTIS_GPIF_HIFRDWRN;
+       hif_addr |=  MANTIS_GPIF_PCMCIAIOM;
+       hif_addr |=  addr;
+
+       mmwrite(hif_addr, MANTIS_GPIF_HIFADDR);
+       ca->hif_job_queue = MANTIS_HIF_IOMRD;
+
+       if (mantis_hif_sbuf_opdone_wait(ca) != 0) {
+               ca->hif_job_queue &= ~MANTIS_HIF_IOMRD;
+               dprintk(verbose, MANTIS_ERROR, 1, "Adapter(%d) Slot(0): HIF Smart Buffer operation failed", mantis->num);
+               return -EREMOTEIO;
+       }
+       udelay(50);
+       ca->hif_job_queue &= ~MANTIS_HIF_IOMRD;
+       *data = mmread(MANTIS_GPIF_HIFDIN);
+       hif_addr |= MANTIS_GPIF_PCMCIAREG;
+       mmwrite(hif_addr, MANTIS_GPIF_HIFADDR);
+
+       return 0;
+}
+
+int mantis_hif_write_iom(struct mantis_ca *ca, u32 addr, u32 data)
+{
+       struct mantis_pci *mantis = ca->ca_priv;
+       u32 hif_addr = 0;
+
+       hif_addr &= ~MANTIS_GPIF_PCMCIAREG;
+       hif_addr &= ~MANTIS_GPIF_HIFRDWRN;
+       hif_addr |=  MANTIS_GPIF_PCMCIAIOM;
+       hif_addr |=  addr;
+
+       mmwrite(hif_addr, MANTIS_GPIF_HIFADDR);
+       mmwrite(data, MANTIS_GPIF_HIFDOUT);
+
+       ca->hif_job_queue = MANTIS_HIF_IOMWR;
+       if (mantis_hif_sbuf_opdone_wait(ca) != 0) {
+               ca->hif_job_queue &= ~MANTIS_HIF_IOMWR;
+               dprintk(verbose, MANTIS_ERROR, 1, "Adapter(%d) Slot(0): HIF Smart Buffer operation failed", mantis->num);
+               return -EREMOTEIO;
+       }
+       udelay(50);
+       ca->hif_job_queue &= ~MANTIS_HIF_IOMWR;
+       hif_addr |= MANTIS_GPIF_PCMCIAREG;
+       mmwrite(hif_addr, MANTIS_GPIF_HIFADDR);
+
+       return 0;
+}
+
 int mantis_hif_init(struct mantis_ca *ca)
 {
        struct mantis_pci *mantis = ca->ca_priv;