Esempi in C++ (Cpp) per sata_dwc_setup_port

Esempio n. 1

File: sata_dwc_460ex.c Progetto: MiniBlu/cm11_kernel_htc_msm8974a3ul

static int sata_dwc_probe(struct platform_device *ofdev)
{
    struct sata_dwc_device *hsdev;
    u32 idr, versionr;
    char *ver = (char *)&versionr;
    u8 *base = NULL;
    int err = 0;
    int irq, rc;
    struct ata_host *host;
    struct ata_port_info pi = sata_dwc_port_info[0];
    const struct ata_port_info *ppi[] = { &pi, NULL };


    hsdev = kzalloc(sizeof(*hsdev), GFP_KERNEL);
    if (hsdev == NULL) {
        dev_err(&ofdev->dev, "kmalloc failed for hsdev\n");
        err = -ENOMEM;
        goto error;
    }


    base = of_iomap(ofdev->dev.of_node, 0);
    if (!base) {
        dev_err(&ofdev->dev, "ioremap failed for SATA register"
                " address\n");
        err = -ENODEV;
        goto error_kmalloc;
    }
    hsdev->reg_base = base;
    dev_dbg(&ofdev->dev, "ioremap done for SATA register address\n");


    hsdev->sata_dwc_regs = (void *__iomem)(base + SATA_DWC_REG_OFFSET);


    host = ata_host_alloc_pinfo(&ofdev->dev, ppi, SATA_DWC_MAX_PORTS);
    if (!host) {
        dev_err(&ofdev->dev, "ata_host_alloc_pinfo failed\n");
        err = -ENOMEM;
        goto error_iomap;
    }

    host->private_data = hsdev;


    host->ports[0]->ioaddr.cmd_addr = base;
    host->ports[0]->ioaddr.scr_addr = base + SATA_DWC_SCR_OFFSET;
    host_pvt.scr_addr_sstatus = base + SATA_DWC_SCR_OFFSET;
    sata_dwc_setup_port(&host->ports[0]->ioaddr, (unsigned long)base);


    idr = in_le32(&hsdev->sata_dwc_regs->idr);
    versionr = in_le32(&hsdev->sata_dwc_regs->versionr);
    dev_notice(&ofdev->dev, "id %d, controller version %c.%c%c\n",
               idr, ver[0], ver[1], ver[2]);


    irq = irq_of_parse_and_map(ofdev->dev.of_node, 1);
    if (irq == NO_IRQ) {
        dev_err(&ofdev->dev, "no SATA DMA irq\n");
        err = -ENODEV;
        goto error_out;
    }


    host_pvt.sata_dma_regs = of_iomap(ofdev->dev.of_node, 1);
    if (!(host_pvt.sata_dma_regs)) {
        dev_err(&ofdev->dev, "ioremap failed for AHBDMA register"
                " address\n");
        err = -ENODEV;
        goto error_out;
    }


    host_pvt.dwc_dev = &ofdev->dev;


    dma_dwc_init(hsdev, irq);


    sata_dwc_enable_interrupts(hsdev);


    irq = irq_of_parse_and_map(ofdev->dev.of_node, 0);
    if (irq == NO_IRQ) {
        dev_err(&ofdev->dev, "no SATA DMA irq\n");
        err = -ENODEV;
        goto error_out;
    }

    rc = ata_host_activate(host, irq, sata_dwc_isr, 0, &sata_dwc_sht);

    if (rc != 0)
        dev_err(&ofdev->dev, "failed to activate host");

    dev_set_drvdata(&ofdev->dev, host);
    return 0;

error_out:

    dma_dwc_exit(hsdev);

error_iomap:
    iounmap(base);
error_kmalloc:
    kfree(hsdev);
error:
    return err;
}

Esempio n. 2

static int sata_dwc_probe(struct platform_device *ofdev)
{
	struct sata_dwc_device *hsdev;
	u32 idr, versionr;
	char *ver = (char *)&versionr;
	u8 *base = NULL;
	int err = 0;
	int irq, rc;
	struct ata_host *host;
	struct ata_port_info pi = sata_dwc_port_info[0];
	const struct ata_port_info *ppi[] = { &pi, NULL };

	/* Allocate DWC SATA device */
	hsdev = kzalloc(sizeof(*hsdev), GFP_KERNEL);
	if (hsdev == NULL) {
		dev_err(&ofdev->dev, "kmalloc failed for hsdev\n");
		err = -ENOMEM;
		goto error;
	}

	/* Ioremap SATA registers */
	base = of_iomap(ofdev->dev.of_node, 0);
	if (!base) {
		dev_err(&ofdev->dev, "ioremap failed for SATA register"
			" address\n");
		err = -ENODEV;
		goto error_kmalloc;
	}
	hsdev->reg_base = base;
	dev_dbg(&ofdev->dev, "ioremap done for SATA register address\n");

	/* Synopsys DWC SATA specific Registers */
	hsdev->sata_dwc_regs = (void *__iomem)(base + SATA_DWC_REG_OFFSET);

	/* Allocate and fill host */
	host = ata_host_alloc_pinfo(&ofdev->dev, ppi, SATA_DWC_MAX_PORTS);
	if (!host) {
		dev_err(&ofdev->dev, "ata_host_alloc_pinfo failed\n");
		err = -ENOMEM;
		goto error_iomap;
	}

	host->private_data = hsdev;

	/* Setup port */
	host->ports[0]->ioaddr.cmd_addr = base;
	host->ports[0]->ioaddr.scr_addr = base + SATA_DWC_SCR_OFFSET;
	host_pvt.scr_addr_sstatus = base + SATA_DWC_SCR_OFFSET;
	sata_dwc_setup_port(&host->ports[0]->ioaddr, (unsigned long)base);

	/* Read the ID and Version Registers */
	idr = in_le32(&hsdev->sata_dwc_regs->idr);
	versionr = in_le32(&hsdev->sata_dwc_regs->versionr);
	dev_notice(&ofdev->dev, "id %d, controller version %c.%c%c\n",
		   idr, ver[0], ver[1], ver[2]);

	/* Get SATA DMA interrupt number */
	irq = irq_of_parse_and_map(ofdev->dev.of_node, 1);
	if (irq == NO_IRQ) {
		dev_err(&ofdev->dev, "no SATA DMA irq\n");
		err = -ENODEV;
		goto error_out;
	}

	/* Get physical