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