/* Copyright (c) 2010-2011, Code Aurora Forum. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA * 02110-1301, USA. */ #include #include #include #include #include #include static struct resource msm_iommu_jpegd_resources[] = { { .start = 0x07300000, .end = 0x07300000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_JPEGD_CB_SC_NON_SECURE_IRQ, .end = SMMU_JPEGD_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_JPEGD_CB_SC_SECURE_IRQ, .end = SMMU_JPEGD_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_vpe_resources[] = { { .start = 0x07400000, .end = 0x07400000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_VPE_CB_SC_NON_SECURE_IRQ, .end = SMMU_VPE_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_VPE_CB_SC_SECURE_IRQ, .end = SMMU_VPE_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_mdp0_resources[] = { { .start = 0x07500000, .end = 0x07500000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_MDP0_CB_SC_NON_SECURE_IRQ, .end = SMMU_MDP0_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_MDP0_CB_SC_SECURE_IRQ, .end = SMMU_MDP0_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_mdp1_resources[] = { { .start = 0x07600000, .end = 0x07600000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_MDP1_CB_SC_NON_SECURE_IRQ, .end = SMMU_MDP1_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_MDP1_CB_SC_SECURE_IRQ, .end = SMMU_MDP1_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_rot_resources[] = { { .start = 0x07700000, .end = 0x07700000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_ROT_CB_SC_NON_SECURE_IRQ, .end = SMMU_ROT_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_ROT_CB_SC_SECURE_IRQ, .end = SMMU_ROT_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_ijpeg_resources[] = { { .start = 0x07800000, .end = 0x07800000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_IJPEG_CB_SC_NON_SECURE_IRQ, .end = SMMU_IJPEG_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_IJPEG_CB_SC_SECURE_IRQ, .end = SMMU_IJPEG_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_vfe_resources[] = { { .start = 0x07900000, .end = 0x07900000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_VFE_CB_SC_NON_SECURE_IRQ, .end = SMMU_VFE_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_VFE_CB_SC_SECURE_IRQ, .end = SMMU_VFE_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_vcodec_a_resources[] = { { .start = 0x07A00000, .end = 0x07A00000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_VCODEC_A_CB_SC_NON_SECURE_IRQ, .end = SMMU_VCODEC_A_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_VCODEC_A_CB_SC_SECURE_IRQ, .end = SMMU_VCODEC_A_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_vcodec_b_resources[] = { { .start = 0x07B00000, .end = 0x07B00000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_VCODEC_B_CB_SC_NON_SECURE_IRQ, .end = SMMU_VCODEC_B_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_VCODEC_B_CB_SC_SECURE_IRQ, .end = SMMU_VCODEC_B_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_gfx3d_resources[] = { { .start = 0x07C00000, .end = 0x07C00000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_GFX3D_CB_SC_NON_SECURE_IRQ, .end = SMMU_GFX3D_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_GFX3D_CB_SC_SECURE_IRQ, .end = SMMU_GFX3D_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_gfx2d0_resources[] = { { .start = 0x07D00000, .end = 0x07D00000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_GFX2D0_CB_SC_NON_SECURE_IRQ, .end = SMMU_GFX2D0_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_GFX2D0_CB_SC_SECURE_IRQ, .end = SMMU_GFX2D0_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct resource msm_iommu_gfx2d1_resources[] = { { .start = 0x07E00000, .end = 0x07E00000 + SZ_1M - 1, .name = "physbase", .flags = IORESOURCE_MEM, }, { .name = "nonsecure_irq", .start = SMMU_GFX2D1_CB_SC_NON_SECURE_IRQ, .end = SMMU_GFX2D1_CB_SC_NON_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, { .name = "secure_irq", .start = SMMU_GFX2D1_CB_SC_SECURE_IRQ, .end = SMMU_GFX2D1_CB_SC_SECURE_IRQ, .flags = IORESOURCE_IRQ, }, }; static struct platform_device msm_root_iommu_dev = { .name = "msm_iommu", .id = -1, }; static struct msm_iommu_dev jpegd_iommu = { .name = "jpegd", .ncb = 2, }; static struct msm_iommu_dev vpe_iommu = { .name = "vpe", .ncb = 2, }; static struct msm_iommu_dev mdp0_iommu = { .name = "mdp0", .ncb = 2, }; static struct msm_iommu_dev mdp1_iommu = { .name = "mdp1", .ncb = 2, }; static struct msm_iommu_dev rot_iommu = { .name = "rot", .ncb = 2, }; static struct msm_iommu_dev ijpeg_iommu = { .name = "ijpeg", .ncb = 2, }; static struct msm_iommu_dev vfe_iommu = { .name = "vfe", .ncb = 2, }; static struct msm_iommu_dev vcodec_a_iommu = { .name = "vcodec_a", .ncb = 2, }; static struct msm_iommu_dev vcodec_b_iommu = { .name = "vcodec_b", .ncb = 2, }; static struct msm_iommu_dev gfx3d_iommu = { .name = "gfx3d", .ncb = 3, }; static struct msm_iommu_dev gfx2d0_iommu = { .name = "gfx2d0", .ncb = 2, }; static struct msm_iommu_dev gfx2d1_iommu = { .name = "gfx2d1", .ncb = 2, }; static struct platform_device msm_device_iommu_jpegd = { .name = "msm_iommu", .id = 0, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_jpegd_resources), .resource = msm_iommu_jpegd_resources, }; static struct platform_device msm_device_iommu_vpe = { .name = "msm_iommu", .id = 1, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_vpe_resources), .resource = msm_iommu_vpe_resources, }; static struct platform_device msm_device_iommu_mdp0 = { .name = "msm_iommu", .id = 2, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_mdp0_resources), .resource = msm_iommu_mdp0_resources, }; static struct platform_device msm_device_iommu_mdp1 = { .name = "msm_iommu", .id = 3, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_mdp1_resources), .resource = msm_iommu_mdp1_resources, }; static struct platform_device msm_device_iommu_rot = { .name = "msm_iommu", .id = 4, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_rot_resources), .resource = msm_iommu_rot_resources, }; static struct platform_device msm_device_iommu_ijpeg = { .name = "msm_iommu", .id = 5, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_ijpeg_resources), .resource = msm_iommu_ijpeg_resources, }; static struct platform_device msm_device_iommu_vfe = { .name = "msm_iommu", .id = 6, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_vfe_resources), .resource = msm_iommu_vfe_resources, }; static struct platform_device msm_device_iommu_vcodec_a = { .name = "msm_iommu", .id = 7, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_vcodec_a_resources), .resource = msm_iommu_vcodec_a_resources, }; static struct platform_device msm_device_iommu_vcodec_b = { .name = "msm_iommu", .id = 8, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_vcodec_b_resources), .resource = msm_iommu_vcodec_b_resources, }; static struct platform_device msm_device_iommu_gfx3d = { .name = "msm_iommu", .id = 9, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_gfx3d_resources), .resource = msm_iommu_gfx3d_resources, }; static struct platform_device msm_device_iommu_gfx2d0 = { .name = "msm_iommu", .id = 10, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_gfx2d0_resources), .resource = msm_iommu_gfx2d0_resources, }; struct platform_device msm_device_iommu_gfx2d1 = { .name = "msm_iommu", .id = 11, .dev = { .parent = &msm_root_iommu_dev.dev, }, .num_resources = ARRAY_SIZE(msm_iommu_gfx2d1_resources), .resource = msm_iommu_gfx2d1_resources, }; static struct msm_iommu_ctx_dev jpegd_src_ctx = { .name = "jpegd_src", .num = 0, .mids = {0, -1} }; static struct msm_iommu_ctx_dev jpegd_dst_ctx = { .name = "jpegd_dst", .num = 1, .mids = {1, -1} }; static struct msm_iommu_ctx_dev vpe_src_ctx = { .name = "vpe_src", .num = 0, .mids = {0, -1} }; static struct msm_iommu_ctx_dev vpe_dst_ctx = { .name = "vpe_dst", .num = 1, .mids = {1, -1} }; static struct msm_iommu_ctx_dev mdp_vg1_ctx = { .name = "mdp_vg1", .num = 0, .mids = {0, 2, -1} }; static struct msm_iommu_ctx_dev mdp_rgb1_ctx = { .name = "mdp_rgb1", .num = 1, .mids = {1, 3, 4, 5, 6, 7, 8, 9, 10, -1} }; static struct msm_iommu_ctx_dev mdp_vg2_ctx = { .name = "mdp_vg2", .num = 0, .mids = {0, 2, -1} }; static struct msm_iommu_ctx_dev mdp_rgb2_ctx = { .name = "mdp_rgb2", .num = 1, .mids = {1, 3, 4, 5, 6, 7, 8, 9, 10, -1} }; static struct msm_iommu_ctx_dev rot_src_ctx = { .name = "rot_src", .num = 0, .mids = {0, -1} }; static struct msm_iommu_ctx_dev rot_dst_ctx = { .name = "rot_dst", .num = 1, .mids = {1, -1} }; static struct msm_iommu_ctx_dev ijpeg_src_ctx = { .name = "ijpeg_src", .num = 0, .mids = {0, -1} }; static struct msm_iommu_ctx_dev ijpeg_dst_ctx = { .name = "ijpeg_dst", .num = 1, .mids = {1, -1} }; static struct msm_iommu_ctx_dev vfe_imgwr_ctx = { .name = "vfe_imgwr", .num = 0, .mids = {2, 3, 4, 5, 6, 7, 8, -1} }; static struct msm_iommu_ctx_dev vfe_misc_ctx = { .name = "vfe_misc", .num = 1, .mids = {0, 1, 9, -1} }; static struct msm_iommu_ctx_dev vcodec_a_stream_ctx = { .name = "vcodec_a_stream", .num = 0, .mids = {2, 5, -1} }; static struct msm_iommu_ctx_dev vcodec_a_mm1_ctx = { .name = "vcodec_a_mm1", .num = 1, .mids = {0, 1, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, -1} }; static struct msm_iommu_ctx_dev vcodec_b_mm2_ctx = { .name = "vcodec_b_mm2", .num = 0, .mids = {0, 1, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, -1} }; static struct msm_iommu_ctx_dev gfx3d_user_ctx = { .name = "gfx3d_user", .num = 0, .mids = {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, -1} }; static struct msm_iommu_ctx_dev gfx3d_priv_ctx = { .name = "gfx3d_priv", .num = 1, .mids = {16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, -1} }; static struct msm_iommu_ctx_dev gfx2d0_2d0_ctx = { .name = "gfx2d0_2d0", .num = 0, .mids = {0, 1, 2, 3, 4, 5, 6, 7, -1} }; static struct msm_iommu_ctx_dev gfx2d1_2d1_ctx = { .name = "gfx2d1_2d1", .num = 0, .mids = {0, 1, 2, 3, 4, 5, 6, 7, -1} }; static struct platform_device msm_device_jpegd_src_ctx = { .name = "msm_iommu_ctx", .id = 0, .dev = { .parent = &msm_device_iommu_jpegd.dev, }, }; static struct platform_device msm_device_jpegd_dst_ctx = { .name = "msm_iommu_ctx", .id = 1, .dev = { .parent = &msm_device_iommu_jpegd.dev, }, }; static struct platform_device msm_device_vpe_src_ctx = { .name = "msm_iommu_ctx", .id = 2, .dev = { .parent = &msm_device_iommu_vpe.dev, }, }; static struct platform_device msm_device_vpe_dst_ctx = { .name = "msm_iommu_ctx", .id = 3, .dev = { .parent = &msm_device_iommu_vpe.dev, }, }; static struct platform_device msm_device_mdp_vg1_ctx = { .name = "msm_iommu_ctx", .id = 4, .dev = { .parent = &msm_device_iommu_mdp0.dev, }, }; static struct platform_device msm_device_mdp_rgb1_ctx = { .name = "msm_iommu_ctx", .id = 5, .dev = { .parent = &msm_device_iommu_mdp0.dev, }, }; static struct platform_device msm_device_mdp_vg2_ctx = { .name = "msm_iommu_ctx", .id = 6, .dev = { .parent = &msm_device_iommu_mdp1.dev, }, }; static struct platform_device msm_device_mdp_rgb2_ctx = { .name = "msm_iommu_ctx", .id = 7, .dev = { .parent = &msm_device_iommu_mdp1.dev, }, }; static struct platform_device msm_device_rot_src_ctx = { .name = "msm_iommu_ctx", .id = 8, .dev = { .parent = &msm_device_iommu_rot.dev, }, }; static struct platform_device msm_device_rot_dst_ctx = { .name = "msm_iommu_ctx", .id = 9, .dev = { .parent = &msm_device_iommu_rot.dev, }, }; static struct platform_device msm_device_ijpeg_src_ctx = { .name = "msm_iommu_ctx", .id = 10, .dev = { .parent = &msm_device_iommu_ijpeg.dev, }, }; static struct platform_device msm_device_ijpeg_dst_ctx = { .name = "msm_iommu_ctx", .id = 11, .dev = { .parent = &msm_device_iommu_ijpeg.dev, }, }; static struct platform_device msm_device_vfe_imgwr_ctx = { .name = "msm_iommu_ctx", .id = 12, .dev = { .parent = &msm_device_iommu_vfe.dev, }, }; static struct platform_device msm_device_vfe_misc_ctx = { .name = "msm_iommu_ctx", .id = 13, .dev = { .parent = &msm_device_iommu_vfe.dev, }, }; static struct platform_device msm_device_vcodec_a_stream_ctx = { .name = "msm_iommu_ctx", .id = 14, .dev = { .parent = &msm_device_iommu_vcodec_a.dev, }, }; static struct platform_device msm_device_vcodec_a_mm1_ctx = { .name = "msm_iommu_ctx", .id = 15, .dev = { .parent = &msm_device_iommu_vcodec_a.dev, }, }; static struct platform_device msm_device_vcodec_b_mm2_ctx = { .name = "msm_iommu_ctx", .id = 16, .dev = { .parent = &msm_device_iommu_vcodec_b.dev, }, }; static struct platform_device msm_device_gfx3d_user_ctx = { .name = "msm_iommu_ctx", .id = 17, .dev = { .parent = &msm_device_iommu_gfx3d.dev, }, }; static struct platform_device msm_device_gfx3d_priv_ctx = { .name = "msm_iommu_ctx", .id = 18, .dev = { .parent = &msm_device_iommu_gfx3d.dev, }, }; static struct platform_device msm_device_gfx2d0_2d0_ctx = { .name = "msm_iommu_ctx", .id = 19, .dev = { .parent = &msm_device_iommu_gfx2d0.dev, }, }; static struct platform_device msm_device_gfx2d1_2d1_ctx = { .name = "msm_iommu_ctx", .id = 20, .dev = { .parent = &msm_device_iommu_gfx2d1.dev, }, }; static struct platform_device *msm_iommu_devs[] = { &msm_device_iommu_jpegd, &msm_device_iommu_vpe, &msm_device_iommu_mdp0, &msm_device_iommu_mdp1, &msm_device_iommu_rot, &msm_device_iommu_ijpeg, &msm_device_iommu_vfe, &msm_device_iommu_vcodec_a, &msm_device_iommu_vcodec_b, &msm_device_iommu_gfx3d, &msm_device_iommu_gfx2d0, &msm_device_iommu_gfx2d1, }; static struct msm_iommu_dev *msm_iommu_data[] = { &jpegd_iommu, &vpe_iommu, &mdp0_iommu, &mdp1_iommu, &rot_iommu, &ijpeg_iommu, &vfe_iommu, &vcodec_a_iommu, &vcodec_b_iommu, &gfx3d_iommu, &gfx2d0_iommu, &gfx2d1_iommu, }; static struct platform_device *msm_iommu_ctx_devs[] = { &msm_device_jpegd_src_ctx, &msm_device_jpegd_dst_ctx, &msm_device_vpe_src_ctx, &msm_device_vpe_dst_ctx, &msm_device_mdp_vg1_ctx, &msm_device_mdp_rgb1_ctx, &msm_device_mdp_vg2_ctx, &msm_device_mdp_rgb2_ctx, &msm_device_rot_src_ctx, &msm_device_rot_dst_ctx, &msm_device_ijpeg_src_ctx, &msm_device_ijpeg_dst_ctx, &msm_device_vfe_imgwr_ctx, &msm_device_vfe_misc_ctx, &msm_device_vcodec_a_stream_ctx, &msm_device_vcodec_a_mm1_ctx, &msm_device_vcodec_b_mm2_ctx, &msm_device_gfx3d_user_ctx, &msm_device_gfx3d_priv_ctx, &msm_device_gfx2d0_2d0_ctx, &msm_device_gfx2d1_2d1_ctx, }; static struct msm_iommu_ctx_dev *msm_iommu_ctx_data[] = { &jpegd_src_ctx, &jpegd_dst_ctx, &vpe_src_ctx, &vpe_dst_ctx, &mdp_vg1_ctx, &mdp_rgb1_ctx, &mdp_vg2_ctx, &mdp_rgb2_ctx, &rot_src_ctx, &rot_dst_ctx, &ijpeg_src_ctx, &ijpeg_dst_ctx, &vfe_imgwr_ctx, &vfe_misc_ctx, &vcodec_a_stream_ctx, &vcodec_a_mm1_ctx, &vcodec_b_mm2_ctx, &gfx3d_user_ctx, &gfx3d_priv_ctx, &gfx2d0_2d0_ctx, &gfx2d1_2d1_ctx, }; static int __init msm8x60_iommu_init(void) { int ret, i; ret = platform_device_register(&msm_root_iommu_dev); if (ret != 0) { pr_err("Failed to register root IOMMU device!\n"); goto failure; } for (i = 0; i < ARRAY_SIZE(msm_iommu_devs); i++) { ret = platform_device_add_data(msm_iommu_devs[i], msm_iommu_data[i], sizeof(struct msm_iommu_dev)); if (ret != 0) { pr_err("platform_device_add_data failed, " "i = %d\n", i); goto failure_unwind; } ret = platform_device_register(msm_iommu_devs[i]); if (ret != 0) { pr_err("platform_device_register iommu failed, " "i = %d\n", i); goto failure_unwind; } } for (i = 0; i < ARRAY_SIZE(msm_iommu_ctx_devs); i++) { ret = platform_device_add_data(msm_iommu_ctx_devs[i], msm_iommu_ctx_data[i], sizeof(*msm_iommu_ctx_devs[i])); if (ret != 0) { pr_err("platform_device_add_data iommu failed, " "i = %d\n", i); goto failure_unwind2; } ret = platform_device_register(msm_iommu_ctx_devs[i]); if (ret != 0) { pr_err("platform_device_register ctx failed, " "i = %d\n", i); goto failure_unwind2; } } return 0; failure_unwind2: while (--i >= 0) platform_device_unregister(msm_iommu_ctx_devs[i]); failure_unwind: while (--i >= 0) platform_device_unregister(msm_iommu_devs[i]); platform_device_unregister(&msm_root_iommu_dev); failure: return ret; } static void __exit msm8x60_iommu_exit(void) { int i; for (i = 0; i < ARRAY_SIZE(msm_iommu_ctx_devs); i++) platform_device_unregister(msm_iommu_ctx_devs[i]); for (i = 0; i < ARRAY_SIZE(msm_iommu_devs); ++i) platform_device_unregister(msm_iommu_devs[i]); platform_device_unregister(&msm_root_iommu_dev); } subsys_initcall(msm8x60_iommu_init); module_exit(msm8x60_iommu_exit); MODULE_LICENSE("GPL v2"); MODULE_AUTHOR("Stepan Moskovchenko ");