C++ (Cpp) tegra_i2s_debug_add Examples

Example #1

static __devinit int tegra_i2s_platform_probe(struct platform_device *pdev)
{
    struct tegra_i2s * i2s;
    char clk_name[12]; /* tegra-i2s.0 */
    struct resource *mem, *memregion, *dmareq;
    int ret;

    if ((pdev->id < 0) ||
            (pdev->id >= ARRAY_SIZE(tegra_i2s_dai))) {
        dev_err(&pdev->dev, "ID %d out of range\n", pdev->id);
        return -EINVAL;
    }

    /*
     * FIXME: Until a codec driver exists for the tegra DAS, hard-code a
     * 1:1 mapping between audio controllers and audio ports.
     */
    ret = tegra_das_connect_dap_to_dac(TEGRA_DAS_DAP_ID_1 + pdev->id,
                                       TEGRA_DAS_DAP_SEL_DAC1 + pdev->id);
    if (ret) {
        dev_err(&pdev->dev, "Can't set up DAP connection\n");
        return ret;
    }
    ret = tegra_das_connect_dac_to_dap(TEGRA_DAS_DAC_ID_1 + pdev->id,
                                       TEGRA_DAS_DAC_SEL_DAP1 + pdev->id);
    if (ret) {
        dev_err(&pdev->dev, "Can't set up DAC connection\n");
        return ret;
    }

    i2s = kzalloc(sizeof(struct tegra_i2s), GFP_KERNEL);
    if (!i2s) {
        dev_err(&pdev->dev, "Can't allocate tegra_i2s\n");
        ret = -ENOMEM;
        goto exit;
    }
    dev_set_drvdata(&pdev->dev, i2s);

    snprintf(clk_name, sizeof(clk_name), DRV_NAME ".%d", pdev->id);
    i2s->clk_i2s = clk_get_sys(clk_name, NULL);
    if (IS_ERR(i2s->clk_i2s)) {
        dev_err(&pdev->dev, "Can't retrieve i2s clock\n");
        ret = PTR_ERR(i2s->clk_i2s);
        goto err_free;
    }

    mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
    if (!mem) {
        dev_err(&pdev->dev, "No memory resource\n");
        ret = -ENODEV;
        goto err_clk_put;
    }

    dmareq = platform_get_resource(pdev, IORESOURCE_DMA, 0);
    if (!dmareq) {
        dev_err(&pdev->dev, "No DMA resource\n");
        ret = -ENODEV;
        goto err_clk_put;
    }

    memregion = request_mem_region(mem->start, resource_size(mem),
                                   DRV_NAME);
    if (!memregion) {
        dev_err(&pdev->dev, "Memory region already claimed\n");
        ret = -EBUSY;
        goto err_clk_put;
    }

    i2s->regs = ioremap(mem->start, resource_size(mem));
    if (!i2s->regs) {
        dev_err(&pdev->dev, "ioremap failed\n");
        ret = -ENOMEM;
        goto err_release;
    }

    i2s->capture_dma_data.addr = mem->start + TEGRA_I2S_FIFO2;
    i2s->capture_dma_data.wrap = 4;
    i2s->capture_dma_data.width = 32;
    i2s->capture_dma_data.req_sel = dmareq->start;

    i2s->playback_dma_data.addr = mem->start + TEGRA_I2S_FIFO1;
    i2s->playback_dma_data.wrap = 4;
    i2s->playback_dma_data.width = 32;
    i2s->playback_dma_data.req_sel = dmareq->start;

    i2s->reg_ctrl = TEGRA_I2S_CTRL_FIFO_FORMAT_PACKED;

    ret = snd_soc_register_dai(&pdev->dev, &tegra_i2s_dai[pdev->id]);
    if (ret) {
        dev_err(&pdev->dev, "Could not register DAI: %d\n", ret);
        ret = -ENOMEM;
        goto err_unmap;
    }

    tegra_i2s_debug_add(i2s, pdev->id);

    return 0;

err_unmap:
    iounmap(i2s->regs);
err_release:
    release_mem_region(mem->start, resource_size(mem));
err_clk_put:
    clk_put(i2s->clk_i2s);
err_free:
    kfree(i2s);
exit:
    return ret;
}

Example #2

File: tegra_i2s.c Project: 404992361/mi1_kernel

static __devinit int tegra_i2s_platform_probe(struct platform_device *pdev)
{
	struct tegra_i2s * i2s;
	struct resource *mem, *memregion, *dmareq;
	u32 of_dma[2];
	u32 dma_ch;
	int ret;

	i2s = devm_kzalloc(&pdev->dev, sizeof(struct tegra_i2s), GFP_KERNEL);
	if (!i2s) {
		dev_err(&pdev->dev, "Can't allocate tegra_i2s\n");
		ret = -ENOMEM;
		goto err;
	}
	dev_set_drvdata(&pdev->dev, i2s);

	i2s->dai = tegra_i2s_dai_template;
	i2s->dai.name = dev_name(&pdev->dev);

	i2s->clk_i2s = clk_get(&pdev->dev, NULL);
	if (IS_ERR(i2s->clk_i2s)) {
		dev_err(&pdev->dev, "Can't retrieve i2s clock\n");
		ret = PTR_ERR(i2s->clk_i2s);
		goto err;
	}

	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!mem) {
		dev_err(&pdev->dev, "No memory resource\n");
		ret = -ENODEV;
		goto err_clk_put;
	}

	dmareq = platform_get_resource(pdev, IORESOURCE_DMA, 0);
	if (!dmareq) {
		if (of_property_read_u32_array(pdev->dev.of_node,
					"nvidia,dma-request-selector",
					of_dma, 2) < 0) {
			dev_err(&pdev->dev, "No DMA resource\n");
			ret = -ENODEV;
			goto err_clk_put;
		}
		dma_ch = of_dma[1];
	} else {
		dma_ch = dmareq->start;
	}

	memregion = devm_request_mem_region(&pdev->dev, mem->start,
					    resource_size(mem), DRV_NAME);
	if (!memregion) {
		dev_err(&pdev->dev, "Memory region already claimed\n");
		ret = -EBUSY;
		goto err_clk_put;
	}

	i2s->regs = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
	if (!i2s->regs) {
		dev_err(&pdev->dev, "ioremap failed\n");
		ret = -ENOMEM;
		goto err_clk_put;
	}

	i2s->capture_dma_data.addr = mem->start + TEGRA_I2S_FIFO2;
	i2s->capture_dma_data.wrap = 4;
	i2s->capture_dma_data.width = 32;
	i2s->capture_dma_data.req_sel = dma_ch;

	i2s->playback_dma_data.addr = mem->start + TEGRA_I2S_FIFO1;
	i2s->playback_dma_data.wrap = 4;
	i2s->playback_dma_data.width = 32;
	i2s->playback_dma_data.req_sel = dma_ch;

	i2s->reg_ctrl = TEGRA_I2S_CTRL_FIFO_FORMAT_PACKED;

	ret = snd_soc_register_dai(&pdev->dev, &i2s->dai);
	if (ret) {
		dev_err(&pdev->dev, "Could not register DAI: %d\n", ret);
		ret = -ENOMEM;
		goto err_clk_put;
	}

	tegra_i2s_debug_add(i2s);

	return 0;

err_clk_put:
	clk_put(i2s->clk_i2s);
err:
	return ret;
}