Esempi in C++ (Cpp) per SATA_DWC_DBTSR_MRD

Esempio n. 1

File: sata_dwc_460ex.c Progetto: MiniBlu/cm11_kernel_htc_msm8974a3ul

static int sata_dwc_port_start(struct ata_port *ap)
{
    int err = 0;
    struct sata_dwc_device *hsdev;
    struct sata_dwc_device_port *hsdevp = NULL;
    struct device *pdev;
    int i;

    hsdev = HSDEV_FROM_AP(ap);

    dev_dbg(ap->dev, "%s: port_no=%d\n", __func__, ap->port_no);

    hsdev->host = ap->host;
    pdev = ap->host->dev;
    if (!pdev) {
        dev_err(ap->dev, "%s: no ap->host->dev\n", __func__);
        err = -ENODEV;
        goto CLEANUP;
    }


    hsdevp = kzalloc(sizeof(*hsdevp), GFP_KERNEL);
    if (!hsdevp) {
        dev_err(ap->dev, "%s: kmalloc failed for hsdevp\n", __func__);
        err = -ENOMEM;
        goto CLEANUP;
    }
    hsdevp->hsdev = hsdev;

    for (i = 0; i < SATA_DWC_QCMD_MAX; i++)
        hsdevp->cmd_issued[i] = SATA_DWC_CMD_ISSUED_NOT;

    ap->bmdma_prd = 0;
    ap->bmdma_prd_dma = 0;

    for (i = 0; i < SATA_DWC_QCMD_MAX; i++) {
        hsdevp->llit[i] = dma_alloc_coherent(pdev,
                                             SATA_DWC_DMAC_LLI_TBL_SZ,
                                             &(hsdevp->llit_dma[i]),
                                             GFP_ATOMIC);
        if (!hsdevp->llit[i]) {
            dev_err(ap->dev, "%s: dma_alloc_coherent failed\n",
                    __func__);
            err = -ENOMEM;
            goto CLEANUP_ALLOC;
        }
    }

    if (ap->port_no == 0)  {
        dev_dbg(ap->dev, "%s: clearing TXCHEN, RXCHEN in DMAC\n",
                __func__);
        out_le32(&hsdev->sata_dwc_regs->dmacr,
                 SATA_DWC_DMACR_TXRXCH_CLEAR);

        dev_dbg(ap->dev, "%s: setting burst size in DBTSR\n",
                __func__);
        out_le32(&hsdev->sata_dwc_regs->dbtsr,
                 (SATA_DWC_DBTSR_MWR(AHB_DMA_BRST_DFLT) |
                  SATA_DWC_DBTSR_MRD(AHB_DMA_BRST_DFLT)));
    }


    clear_serror();
    ap->private_data = hsdevp;
    dev_dbg(ap->dev, "%s: done\n", __func__);
    return 0;

CLEANUP_ALLOC:
    kfree(hsdevp);
CLEANUP:
    dev_dbg(ap->dev, "%s: fail. ap->id = %d\n", __func__, ap->print_id);
    return err;
}

Esempio n. 2

/*
 * Function : sata_dwc_port_start
 * arguments : struct ata_ioports *port
 * Return value : returns 0 if success, error code otherwise
 * This function allocates the scatter gather LLI table for AHB DMA
 */
static int sata_dwc_port_start(struct ata_port *ap)
{
	int err = 0;
	struct sata_dwc_device *hsdev;
	struct sata_dwc_device_port *hsdevp = NULL;
	struct device *pdev;
	int i;

	hsdev = HSDEV_FROM_AP(ap);

	dev_dbg(ap->dev, "%s: port_no=%d\n", __func__, ap->port_no);

	hsdev->host = ap->host;
	pdev = ap->host->dev;
	if (!pdev) {
		dev_err(ap->dev, "%s: no ap->host->dev\n", __func__);
		err = -ENODEV;
		goto CLEANUP;
	}

	/* Allocate Port Struct */
	hsdevp = kzalloc(sizeof(*hsdevp), GFP_KERNEL);
	if (!hsdevp) {
		dev_err(ap->dev, "%s: kmalloc failed for hsdevp\n", __func__);
		err = -ENOMEM;
		goto CLEANUP;
	}
	hsdevp->hsdev = hsdev;

	for (i = 0; i < SATA_DWC_QCMD_MAX; i++)
		hsdevp->cmd_issued[i] = SATA_DWC_CMD_ISSUED_NOT;

	ap->bmdma_prd = 0;	/* set these so libata doesn't use them */
	ap->bmdma_prd_dma = 0;

	/*
	 * DMA - Assign scatter gather LLI table. We can't use the libata
	 * version since it's PRD is IDE PCI specific.
	 */
	for (i = 0; i < SATA_DWC_QCMD_MAX; i++) {
		hsdevp->llit[i] = dma_alloc_coherent(pdev,
						     SATA_DWC_DMAC_LLI_TBL_SZ,
						     &(hsdevp->llit_dma[i]),
						     GFP_ATOMIC);
		if (!hsdevp->llit[i]) {
			dev_err(ap->dev, "%s: dma_alloc_coherent failed\n",
				 __func__);
			err = -ENOMEM;
			goto CLEANUP_ALLOC;
		}
	}

	if (ap->port_no == 0)  {
		dev_dbg(ap->dev, "%s: clearing TXCHEN, RXCHEN in DMAC\n",
			__func__);
		out_le32(&hsdev->sata_dwc_regs->dmacr,
			 SATA_DWC_DMACR_TXRXCH_CLEAR);

		dev_dbg(ap->dev, "%s: setting burst size in DBTSR\n",
			 __func__);
		out_le32(&hsdev->sata_dwc_regs->dbtsr,
			 (SATA_DWC_DBTSR_MWR(AHB_DMA_BRST_DFLT) |
			  SATA_DWC_DBTSR_MRD(AHB_DMA_BRST_DFLT)));
	}

	/* Clear any error bits before libata starts issuing commands */
	clear_serror();
	ap->private_data = hsdevp;
	dev_dbg(ap->dev, "%s: done\n", __func__);
	return 0;

CLEANUP_ALLOC:
	kfree(hsdevp);
CLEANUP:
	dev_dbg(ap->dev, "%s: fail. ap->id = %d\n", __func__, ap->print_id);
	return err;
}