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