arch/arm/mach-omap2/devices.c

   1 /*
   2  * linux/arch/arm/mach-omap2/devices.c
   3  *
   4  * OMAP2 platform device setup/initialization
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  */
  11 #include <linux/gpio.h>
  12 #include <linux/kernel.h>
  13 #include <linux/init.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/io.h>
  16 #include <linux/clk.h>
  17 #include <linux/err.h>
  18 #include <linux/slab.h>
  19 #include <linux/of.h>
  20 #include <linux/pinctrl/machine.h>
  21 #include <linux/platform_data/omap4-keypad.h>
  22 #include <linux/platform_data/omap_ocp2scp.h>
  23
  24 #include <asm/mach-types.h>
  25 #include <asm/mach/map.h>
  26
  27 #include <linux/omap-dma.h>
  28
  29 #include "iomap.h"
  30 #include "omap_hwmod.h"
  31 #include "omap_device.h"
  32 #include "omap4-keypad.h"
  33
  34 #include "soc.h"
  35 #include "common.h"
  36 #include "mux.h"
  37 #include "control.h"
  38 #include "devices.h"
  39 #include "dma.h"
  40
  41 #define L3_MODULES_MAX_LEN 12
  42 #define L3_MODULES 3
  43
  44 static int __init omap3_l3_init(void)
  45 {
  46         struct omap_hwmod *oh;
  47         struct platform_device *pdev;
  48         char oh_name[L3_MODULES_MAX_LEN];
  49
  50         /*
  51          * To avoid code running on other OMAPs in
  52          * multi-omap builds
  53          */
  54         if (!(cpu_is_omap34xx()))
  55                 return -ENODEV;
  56
  57         snprintf(oh_name, L3_MODULES_MAX_LEN, "l3_main");
  58
  59         oh = omap_hwmod_lookup(oh_name);
  60
  61         if (!oh)
  62                 pr_err("could not look up %s\n", oh_name);
  63
  64         pdev = omap_device_build("omap_l3_smx", 0, oh, NULL, 0,
  65                                                            NULL, 0, 0);
  66
  67         WARN(IS_ERR(pdev), "could not build omap_device for %s\n", oh_name);
  68
  69         return IS_ERR(pdev) ? PTR_ERR(pdev) : 0;
  70 }
  71 postcore_initcall(omap3_l3_init);
  72
  73 static int __init omap4_l3_init(void)
  74 {
  75         int i;
  76         struct omap_hwmod *oh[3];
  77         struct platform_device *pdev;
  78         char oh_name[L3_MODULES_MAX_LEN];
  79
  80         /* If dtb is there, the devices will be created dynamically */
  81         if (of_have_populated_dt())
  82                 return -ENODEV;
  83
  84         /*
  85          * To avoid code running on other OMAPs in
  86          * multi-omap builds
  87          */
  88         if (!cpu_is_omap44xx() && !soc_is_omap54xx())
  89                 return -ENODEV;
  90
  91         for (i = 0; i < L3_MODULES; i++) {
  92                 snprintf(oh_name, L3_MODULES_MAX_LEN, "l3_main_%d", i+1);
  93
  94                 oh[i] = omap_hwmod_lookup(oh_name);
  95                 if (!(oh[i]))
  96                         pr_err("could not look up %s\n", oh_name);
  97         }
  98
  99         pdev = omap_device_build_ss("omap_l3_noc", 0, oh, 3, NULL,
 100                                                      0, NULL, 0, 0);
 101
 102         WARN(IS_ERR(pdev), "could not build omap_device for %s\n", oh_name);
 103
 104         return IS_ERR(pdev) ? PTR_ERR(pdev) : 0;
 105 }
 106 postcore_initcall(omap4_l3_init);
 107
 108 #if defined(CONFIG_VIDEO_OMAP2) || defined(CONFIG_VIDEO_OMAP2_MODULE)
 109
 110 static struct resource omap2cam_resources[] = {
 111         {
 112                 .start          = OMAP24XX_CAMERA_BASE,
 113                 .end            = OMAP24XX_CAMERA_BASE + 0xfff,
 114                 .flags          = IORESOURCE_MEM,
 115         },
 116         {
 117                 .start          = 24 + OMAP_INTC_START,
 118                 .flags          = IORESOURCE_IRQ,
 119         }
 120 };
 121
 122 static struct platform_device omap2cam_device = {
 123         .name           = "omap24xxcam",
 124         .id             = -1,
 125         .num_resources  = ARRAY_SIZE(omap2cam_resources),
 126         .resource       = omap2cam_resources,
 127 };
 128 #endif
 129
 130 #if defined(CONFIG_IOMMU_API)
 131
 132 #include <linux/platform_data/iommu-omap.h>
 133
 134 static struct resource omap3isp_resources[] = {
 135         {
 136                 .start          = OMAP3430_ISP_BASE,
 137                 .end            = OMAP3430_ISP_END,
 138                 .flags          = IORESOURCE_MEM,
 139         },
 140         {
 141                 .start          = OMAP3430_ISP_CCP2_BASE,
 142                 .end            = OMAP3430_ISP_CCP2_END,
 143                 .flags          = IORESOURCE_MEM,
 144         },
 145         {
 146                 .start          = OMAP3430_ISP_CCDC_BASE,
 147                 .end            = OMAP3430_ISP_CCDC_END,
 148                 .flags          = IORESOURCE_MEM,
 149         },
 150         {
 151                 .start          = OMAP3430_ISP_HIST_BASE,
 152                 .end            = OMAP3430_ISP_HIST_END,
 153                 .flags          = IORESOURCE_MEM,
 154         },
 155         {
 156                 .start          = OMAP3430_ISP_H3A_BASE,
 157                 .end            = OMAP3430_ISP_H3A_END,
 158                 .flags          = IORESOURCE_MEM,
 159         },
 160         {
 161                 .start          = OMAP3430_ISP_PREV_BASE,
 162                 .end            = OMAP3430_ISP_PREV_END,
 163                 .flags          = IORESOURCE_MEM,
 164         },
 165         {
 166                 .start          = OMAP3430_ISP_RESZ_BASE,
 167                 .end            = OMAP3430_ISP_RESZ_END,
 168                 .flags          = IORESOURCE_MEM,
 169         },
 170         {
 171                 .start          = OMAP3430_ISP_SBL_BASE,
 172                 .end            = OMAP3430_ISP_SBL_END,
 173                 .flags          = IORESOURCE_MEM,
 174         },
 175         {
 176                 .start          = OMAP3430_ISP_CSI2A_REGS1_BASE,
 177                 .end            = OMAP3430_ISP_CSI2A_REGS1_END,
 178                 .flags          = IORESOURCE_MEM,
 179         },
 180         {
 181                 .start          = OMAP3430_ISP_CSIPHY2_BASE,
 182                 .end            = OMAP3430_ISP_CSIPHY2_END,
 183                 .flags          = IORESOURCE_MEM,
 184         },
 185         {
 186                 .start          = OMAP3630_ISP_CSI2A_REGS2_BASE,
 187                 .end            = OMAP3630_ISP_CSI2A_REGS2_END,
 188                 .flags          = IORESOURCE_MEM,
 189         },
 190         {
 191                 .start          = OMAP3630_ISP_CSI2C_REGS1_BASE,
 192                 .end            = OMAP3630_ISP_CSI2C_REGS1_END,
 193                 .flags          = IORESOURCE_MEM,
 194         },
 195         {
 196                 .start          = OMAP3630_ISP_CSIPHY1_BASE,
 197                 .end            = OMAP3630_ISP_CSIPHY1_END,
 198                 .flags          = IORESOURCE_MEM,
 199         },
 200         {
 201                 .start          = OMAP3630_ISP_CSI2C_REGS2_BASE,
 202                 .end            = OMAP3630_ISP_CSI2C_REGS2_END,
 203                 .flags          = IORESOURCE_MEM,
 204         },
 205         {
 206                 .start          = OMAP343X_CTRL_BASE + OMAP343X_CONTROL_CSIRXFE,
 207                 .end            = OMAP343X_CTRL_BASE + OMAP343X_CONTROL_CSIRXFE + 3,
 208                 .flags          = IORESOURCE_MEM,
 209         },
 210         {
 211                 .start          = OMAP343X_CTRL_BASE + OMAP3630_CONTROL_CAMERA_PHY_CTRL,
 212                 .end            = OMAP343X_CTRL_BASE + OMAP3630_CONTROL_CAMERA_PHY_CTRL + 3,
 213                 .flags          = IORESOURCE_MEM,
 214         },
 215         {
 216                 .start          = 24 + OMAP_INTC_START,
 217                 .flags          = IORESOURCE_IRQ,
 218         }
 219 };
 220
 221 static struct platform_device omap3isp_device = {
 222         .name           = "omap3isp",
 223         .id             = -1,
 224         .num_resources  = ARRAY_SIZE(omap3isp_resources),
 225         .resource       = omap3isp_resources,
 226 };
 227
 228 static struct omap_iommu_arch_data omap3_isp_iommu = {
 229         .name = "mmu_isp",
 230 };
 231
 232 int omap3_init_camera(struct isp_platform_data *pdata)
 233 {
 234         omap3isp_device.dev.platform_data = pdata;
 235         omap3isp_device.dev.archdata.iommu = &omap3_isp_iommu;
 236
 237         return platform_device_register(&omap3isp_device);
 238 }
 239
 240 #else /* !CONFIG_IOMMU_API */
 241
 242 int omap3_init_camera(struct isp_platform_data *pdata)
 243 {
 244         return 0;
 245 }
 246
 247 #endif
 248
 249 static inline void omap_init_camera(void)
 250 {
 251 #if defined(CONFIG_VIDEO_OMAP2) || defined(CONFIG_VIDEO_OMAP2_MODULE)
 252         if (cpu_is_omap24xx())
 253                 platform_device_register(&omap2cam_device);
 254 #endif
 255 }
 256
 257 int __init omap4_keyboard_init(struct omap4_keypad_platform_data
 258                         *sdp4430_keypad_data, struct omap_board_data *bdata)
 259 {
 260         struct platform_device *pdev;
 261         struct omap_hwmod *oh;
 262         struct omap4_keypad_platform_data *keypad_data;
 263         unsigned int id = -1;
 264         char *oh_name = "kbd";
 265         char *name = "omap4-keypad";
 266
 267         oh = omap_hwmod_lookup(oh_name);
 268         if (!oh) {
 269                 pr_err("Could not look up %s\n", oh_name);
 270                 return -ENODEV;
 271         }
 272
 273         keypad_data = sdp4430_keypad_data;
 274
 275         pdev = omap_device_build(name, id, oh, keypad_data,
 276                         sizeof(struct omap4_keypad_platform_data), NULL, 0, 0);
 277
 278         if (IS_ERR(pdev)) {
 279                 WARN(1, "Can't build omap_device for %s:%s.\n",
 280                                                 name, oh->name);
 281                 return PTR_ERR(pdev);
 282         }
 283         oh->mux = omap_hwmod_mux_init(bdata->pads, bdata->pads_cnt);
 284
 285         return 0;
 286 }
 287
 288 #if defined(CONFIG_OMAP_MBOX_FWK) || defined(CONFIG_OMAP_MBOX_FWK_MODULE)
 289 static inline void __init omap_init_mbox(void)
 290 {
 291         struct omap_hwmod *oh;
 292         struct platform_device *pdev;
 293
 294         oh = omap_hwmod_lookup("mailbox");
 295         if (!oh) {
 296                 pr_err("%s: unable to find hwmod\n", __func__);
 297                 return;
 298         }
 299
 300         pdev = omap_device_build("omap-mailbox", -1, oh, NULL, 0, NULL, 0, 0);
 301         WARN(IS_ERR(pdev), "%s: could not build device, err %ld\n",
 302                                                 __func__, PTR_ERR(pdev));
 303 }
 304 #else
 305 static inline void omap_init_mbox(void) { }
 306 #endif /* CONFIG_OMAP_MBOX_FWK */
 307
 308 static inline void omap_init_sti(void) {}
 309
 310 #if defined(CONFIG_SND_SOC) || defined(CONFIG_SND_SOC_MODULE)
 311
 312 static struct platform_device omap_pcm = {
 313         .name   = "omap-pcm-audio",
 314         .id     = -1,
 315 };
 316
 317 static void omap_init_audio(void)
 318 {
 319         platform_device_register(&omap_pcm);
 320 }
 321
 322 #else
 323 static inline void omap_init_audio(void) {}
 324 #endif
 325
 326 #if defined(CONFIG_SND_OMAP_SOC_MCPDM) || \
 327                 defined(CONFIG_SND_OMAP_SOC_MCPDM_MODULE)
 328
 329 static void __init omap_init_mcpdm(void)
 330 {
 331         struct omap_hwmod *oh;
 332         struct platform_device *pdev;
 333
 334         oh = omap_hwmod_lookup("mcpdm");
 335         if (!oh) {
 336                 printk(KERN_ERR "Could not look up mcpdm hw_mod\n");
 337                 return;
 338         }
 339
 340         pdev = omap_device_build("omap-mcpdm", -1, oh, NULL, 0, NULL, 0, 0);
 341         WARN(IS_ERR(pdev), "Can't build omap_device for omap-mcpdm.\n");
 342 }
 343 #else
 344 static inline void omap_init_mcpdm(void) {}
 345 #endif
 346
 347 #if defined(CONFIG_SND_OMAP_SOC_DMIC) || \
 348                 defined(CONFIG_SND_OMAP_SOC_DMIC_MODULE)
 349
 350 static void __init omap_init_dmic(void)
 351 {
 352         struct omap_hwmod *oh;
 353         struct platform_device *pdev;
 354
 355         oh = omap_hwmod_lookup("dmic");
 356         if (!oh) {
 357                 pr_err("Could not look up dmic hw_mod\n");
 358                 return;
 359         }
 360
 361         pdev = omap_device_build("omap-dmic", -1, oh, NULL, 0, NULL, 0, 0);
 362         WARN(IS_ERR(pdev), "Can't build omap_device for omap-dmic.\n");
 363 }
 364 #else
 365 static inline void omap_init_dmic(void) {}
 366 #endif
 367
 368 #if defined(CONFIG_SND_OMAP_SOC_OMAP_HDMI) || \
 369                 defined(CONFIG_SND_OMAP_SOC_OMAP_HDMI_MODULE)
 370
 371 static struct platform_device omap_hdmi_audio = {
 372         .name   = "omap-hdmi-audio",
 373         .id     = -1,
 374 };
 375
 376 static void __init omap_init_hdmi_audio(void)
 377 {
 378         struct omap_hwmod *oh;
 379         struct platform_device *pdev;
 380
 381         oh = omap_hwmod_lookup("dss_hdmi");
 382         if (!oh) {
 383                 printk(KERN_ERR "Could not look up dss_hdmi hw_mod\n");
 384                 return;
 385         }
 386
 387         pdev = omap_device_build("omap-hdmi-audio-dai",
 388                 -1, oh, NULL, 0, NULL, 0, 0);
 389         WARN(IS_ERR(pdev),
 390              "Can't build omap_device for omap-hdmi-audio-dai.\n");
 391
 392         platform_device_register(&omap_hdmi_audio);
 393 }
 394 #else
 395 static inline void omap_init_hdmi_audio(void) {}
 396 #endif
 397
 398 #if defined(CONFIG_SPI_OMAP24XX) || defined(CONFIG_SPI_OMAP24XX_MODULE)
 399
 400 #include <linux/platform_data/spi-omap2-mcspi.h>
 401
 402 static int __init omap_mcspi_init(struct omap_hwmod *oh, void *unused)
 403 {
 404         struct platform_device *pdev;
 405         char *name = "omap2_mcspi";
 406         struct omap2_mcspi_platform_config *pdata;
 407         static int spi_num;
 408         struct omap2_mcspi_dev_attr *mcspi_attrib = oh->dev_attr;
 409
 410         pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
 411         if (!pdata) {
 412                 pr_err("Memory allocation for McSPI device failed\n");
 413                 return -ENOMEM;
 414         }
 415
 416         pdata->num_cs = mcspi_attrib->num_chipselect;
 417         switch (oh->class->rev) {
 418         case OMAP2_MCSPI_REV:
 419         case OMAP3_MCSPI_REV:
 420                         pdata->regs_offset = 0;
 421                         break;
 422         case OMAP4_MCSPI_REV:
 423                         pdata->regs_offset = OMAP4_MCSPI_REG_OFFSET;
 424                         break;
 425         default:
 426                         pr_err("Invalid McSPI Revision value\n");
 427                         kfree(pdata);
 428                         return -EINVAL;
 429         }
 430
 431         spi_num++;
 432         pdev = omap_device_build(name, spi_num, oh, pdata,
 433                                 sizeof(*pdata), NULL, 0, 0);
 434         WARN(IS_ERR(pdev), "Can't build omap_device for %s:%s\n",
 435                                 name, oh->name);
 436         kfree(pdata);
 437         return 0;
 438 }
 439
 440 static void omap_init_mcspi(void)
 441 {
 442         omap_hwmod_for_each_by_class("mcspi", omap_mcspi_init, NULL);
 443 }
 444
 445 #else
 446 static inline void omap_init_mcspi(void) {}
 447 #endif
 448
 449 /**
 450  * omap_init_rng - bind the RNG hwmod to the RNG omap_device
 451  *
 452  * Bind the RNG hwmod to the RNG omap_device.  No return value.
 453  */
 454 static void omap_init_rng(void)
 455 {
 456         struct omap_hwmod *oh;
 457         struct platform_device *pdev;
 458
 459         oh = omap_hwmod_lookup("rng");
 460         if (!oh)
 461                 return;
 462
 463         pdev = omap_device_build("omap_rng", -1, oh, NULL, 0, NULL, 0, 0);
 464         WARN(IS_ERR(pdev), "Can't build omap_device for omap_rng\n");
 465 }
 466
 467 #if defined(CONFIG_CRYPTO_DEV_OMAP_SHAM) || defined(CONFIG_CRYPTO_DEV_OMAP_SHAM_MODULE)
 468
 469 #ifdef CONFIG_ARCH_OMAP2
 470 static struct resource omap2_sham_resources[] = {
 471         {
 472                 .start  = OMAP24XX_SEC_SHA1MD5_BASE,
 473                 .end    = OMAP24XX_SEC_SHA1MD5_BASE + 0x64,
 474                 .flags  = IORESOURCE_MEM,
 475         },
 476         {
 477                 .start  = 51 + OMAP_INTC_START,
 478                 .flags  = IORESOURCE_IRQ,
 479         }
 480 };
 481 static int omap2_sham_resources_sz = ARRAY_SIZE(omap2_sham_resources);
 482 #else
 483 #define omap2_sham_resources            NULL
 484 #define omap2_sham_resources_sz         0
 485 #endif
 486
 487 #ifdef CONFIG_ARCH_OMAP3
 488 static struct resource omap3_sham_resources[] = {
 489         {
 490                 .start  = OMAP34XX_SEC_SHA1MD5_BASE,
 491                 .end    = OMAP34XX_SEC_SHA1MD5_BASE + 0x64,
 492                 .flags  = IORESOURCE_MEM,
 493         },
 494         {
 495                 .start  = 49 + OMAP_INTC_START,
 496                 .flags  = IORESOURCE_IRQ,
 497         },
 498         {
 499                 .start  = OMAP34XX_DMA_SHA1MD5_RX,
 500                 .flags  = IORESOURCE_DMA,
 501         }
 502 };
 503 static int omap3_sham_resources_sz = ARRAY_SIZE(omap3_sham_resources);
 504 #else
 505 #define omap3_sham_resources            NULL
 506 #define omap3_sham_resources_sz         0
 507 #endif
 508
 509 static struct platform_device sham_device = {
 510         .name           = "omap-sham",
 511         .id             = -1,
 512 };
 513
 514 static void omap_init_sham(void)
 515 {
 516         if (cpu_is_omap24xx()) {
 517                 sham_device.resource = omap2_sham_resources;
 518                 sham_device.num_resources = omap2_sham_resources_sz;
 519         } else if (cpu_is_omap34xx()) {
 520                 sham_device.resource = omap3_sham_resources;
 521                 sham_device.num_resources = omap3_sham_resources_sz;
 522         } else {
 523                 pr_err("%s: platform not supported\n", __func__);
 524                 return;
 525         }
 526         platform_device_register(&sham_device);
 527 }
 528 #else
 529 static inline void omap_init_sham(void) { }
 530 #endif
 531
 532 #if defined(CONFIG_CRYPTO_DEV_OMAP_AES) || defined(CONFIG_CRYPTO_DEV_OMAP_AES_MODULE)
 533
 534 #ifdef CONFIG_ARCH_OMAP2
 535 static struct resource omap2_aes_resources[] = {
 536         {
 537                 .start  = OMAP24XX_SEC_AES_BASE,
 538                 .end    = OMAP24XX_SEC_AES_BASE + 0x4C,
 539                 .flags  = IORESOURCE_MEM,
 540         },
 541         {
 542                 .start  = OMAP24XX_DMA_AES_TX,
 543                 .flags  = IORESOURCE_DMA,
 544         },
 545         {
 546                 .start  = OMAP24XX_DMA_AES_RX,
 547                 .flags  = IORESOURCE_DMA,
 548         }
 549 };
 550 static int omap2_aes_resources_sz = ARRAY_SIZE(omap2_aes_resources);
 551 #else
 552 #define omap2_aes_resources             NULL
 553 #define omap2_aes_resources_sz          0
 554 #endif
 555
 556 #ifdef CONFIG_ARCH_OMAP3
 557 static struct resource omap3_aes_resources[] = {
 558         {
 559                 .start  = OMAP34XX_SEC_AES_BASE,
 560                 .end    = OMAP34XX_SEC_AES_BASE + 0x4C,
 561                 .flags  = IORESOURCE_MEM,
 562         },
 563         {
 564                 .start  = OMAP34XX_DMA_AES2_TX,
 565                 .flags  = IORESOURCE_DMA,
 566         },
 567         {
 568                 .start  = OMAP34XX_DMA_AES2_RX,
 569                 .flags  = IORESOURCE_DMA,
 570         }
 571 };
 572 static int omap3_aes_resources_sz = ARRAY_SIZE(omap3_aes_resources);
 573 #else
 574 #define omap3_aes_resources             NULL
 575 #define omap3_aes_resources_sz          0
 576 #endif
 577
 578 static struct platform_device aes_device = {
 579         .name           = "omap-aes",
 580         .id             = -1,
 581 };
 582
 583 static void omap_init_aes(void)
 584 {
 585         if (cpu_is_omap24xx()) {
 586                 aes_device.resource = omap2_aes_resources;
 587                 aes_device.num_resources = omap2_aes_resources_sz;
 588         } else if (cpu_is_omap34xx()) {
 589                 aes_device.resource = omap3_aes_resources;
 590                 aes_device.num_resources = omap3_aes_resources_sz;
 591         } else {
 592                 pr_err("%s: platform not supported\n", __func__);
 593                 return;
 594         }
 595         platform_device_register(&aes_device);
 596 }
 597
 598 #else
 599 static inline void omap_init_aes(void) { }
 600 #endif
 601
 602 /*-------------------------------------------------------------------------*/
 603
 604 #if defined(CONFIG_VIDEO_OMAP2_VOUT) || \
 605         defined(CONFIG_VIDEO_OMAP2_VOUT_MODULE)
 606 #if defined(CONFIG_FB_OMAP2) || defined(CONFIG_FB_OMAP2_MODULE)
 607 static struct resource omap_vout_resource[3 - CONFIG_FB_OMAP2_NUM_FBS] = {
 608 };
 609 #else
 610 static struct resource omap_vout_resource[2] = {
 611 };
 612 #endif
 613
 614 static struct platform_device omap_vout_device = {
 615         .name           = "omap_vout",
 616         .num_resources  = ARRAY_SIZE(omap_vout_resource),
 617         .resource       = &omap_vout_resource[0],
 618         .id             = -1,
 619 };
 620 static void omap_init_vout(void)
 621 {
 622         if (platform_device_register(&omap_vout_device) < 0)
 623                 printk(KERN_ERR "Unable to register OMAP-VOUT device\n");
 624 }
 625 #else
 626 static inline void omap_init_vout(void) {}
 627 #endif
 628
 629 #if defined(CONFIG_OMAP_OCP2SCP) || defined(CONFIG_OMAP_OCP2SCP_MODULE)
 630 static int count_ocp2scp_devices(struct omap_ocp2scp_dev *ocp2scp_dev)
 631 {
 632         int cnt = 0;
 633
 634         while (ocp2scp_dev->drv_name != NULL) {
 635                 cnt++;
 636                 ocp2scp_dev++;
 637         }
 638
 639         return cnt;
 640 }
 641
 642 static void omap_init_ocp2scp(void)
 643 {
 644         struct omap_hwmod       *oh;
 645         struct platform_device  *pdev;
 646         int                     bus_id = -1, dev_cnt = 0, i;
 647         struct omap_ocp2scp_dev *ocp2scp_dev;
 648         const char              *oh_name, *name;
 649         struct omap_ocp2scp_platform_data *pdata;
 650
 651         if (!cpu_is_omap44xx())
 652                 return;
 653
 654         oh_name = "ocp2scp_usb_phy";
 655         name    = "omap-ocp2scp";
 656
 657         oh = omap_hwmod_lookup(oh_name);
 658         if (!oh) {
 659                 pr_err("%s: could not find omap_hwmod for %s\n", __func__,
 660                                                                 oh_name);
 661                 return;
 662         }
 663
 664         pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
 665         if (!pdata) {
 666                 pr_err("%s: No memory for ocp2scp pdata\n", __func__);
 667                 return;
 668         }
 669
 670         ocp2scp_dev = oh->dev_attr;
 671         dev_cnt = count_ocp2scp_devices(ocp2scp_dev);
 672
 673         if (!dev_cnt) {
 674                 pr_err("%s: No devices connected to ocp2scp\n", __func__);
 675                 kfree(pdata);
 676                 return;
 677         }
 678
 679         pdata->devices = kzalloc(sizeof(struct omap_ocp2scp_dev *)
 680                                         * dev_cnt, GFP_KERNEL);
 681         if (!pdata->devices) {
 682                 pr_err("%s: No memory for ocp2scp pdata devices\n", __func__);
 683                 kfree(pdata);
 684                 return;
 685         }
 686
 687         for (i = 0; i < dev_cnt; i++, ocp2scp_dev++)
 688                 pdata->devices[i] = ocp2scp_dev;
 689
 690         pdata->dev_cnt  = dev_cnt;
 691
 692         pdev = omap_device_build(name, bus_id, oh, pdata, sizeof(*pdata), NULL,
 693                                                                 0, false);
 694         if (IS_ERR(pdev)) {
 695                 pr_err("Could not build omap_device for %s %s\n",
 696                                                 name, oh_name);
 697                 kfree(pdata->devices);
 698                 kfree(pdata);
 699                 return;
 700         }
 701 }
 702 #else
 703 static inline void omap_init_ocp2scp(void) { }
 704 #endif
 705
 706 /*-------------------------------------------------------------------------*/
 707
 708 static int __init omap2_init_devices(void)
 709 {
 710         /* Enable dummy states for those platforms without pinctrl support */
 711         if (!of_have_populated_dt())
 712                 pinctrl_provide_dummies();
 713
 714         /*
 715          * please keep these calls, and their implementations above,
 716          * in alphabetical order so they're easier to sort through.
 717          */
 718         omap_init_audio();
 719         omap_init_camera();
 720         omap_init_hdmi_audio();
 721         omap_init_mbox();
 722         /* If dtb is there, the devices will be created dynamically */
 723         if (!of_have_populated_dt()) {
 724                 omap_init_dmic();
 725                 omap_init_mcpdm();
 726                 omap_init_mcspi();
 727         }
 728         omap_init_sti();
 729         omap_init_rng();
 730         omap_init_sham();
 731         omap_init_aes();
 732         omap_init_vout();
 733         omap_init_ocp2scp();
 734
 735         return 0;
 736 }
 737 arch_initcall(omap2_init_devices);