linux/arch/sh/boards/mach-migor/setup.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * Renesas System Solutions Asia Pte. Ltd - Migo-R
   4 *
   5 * Copyright (C) 2008 Magnus Damm
   6 */
   7#include <linux/clkdev.h>
   8#include <linux/dma-map-ops.h>
   9#include <linux/init.h>
  10#include <linux/platform_device.h>
  11#include <linux/interrupt.h>
  12#include <linux/input.h>
  13#include <linux/input/sh_keysc.h>
  14#include <linux/memblock.h>
  15#include <linux/mmc/host.h>
  16#include <linux/mtd/physmap.h>
  17#include <linux/mfd/tmio.h>
  18#include <linux/mtd/platnand.h>
  19#include <linux/i2c.h>
  20#include <linux/regulator/fixed.h>
  21#include <linux/regulator/machine.h>
  22#include <linux/smc91x.h>
  23#include <linux/delay.h>
  24#include <linux/clk.h>
  25#include <linux/gpio.h>
  26#include <linux/gpio/machine.h>
  27#include <linux/videodev2.h>
  28#include <linux/sh_intc.h>
  29#include <video/sh_mobile_lcdc.h>
  30#include <media/drv-intf/renesas-ceu.h>
  31#include <media/i2c/ov772x.h>
  32#include <media/i2c/tw9910.h>
  33#include <asm/clock.h>
  34#include <asm/machvec.h>
  35#include <asm/io.h>
  36#include <asm/suspend.h>
  37#include <mach/migor.h>
  38#include <cpu/sh7722.h>
  39
  40/* Address     IRQ  Size  Bus  Description
  41 * 0x00000000       64MB  16   NOR Flash (SP29PL256N)
  42 * 0x0c000000       64MB  64   SDRAM (2xK4M563233G)
  43 * 0x10000000  IRQ0       16   Ethernet (SMC91C111)
  44 * 0x14000000  IRQ4       16   USB 2.0 Host Controller (M66596)
  45 * 0x18000000       8GB    8   NAND Flash (K9K8G08U0A)
  46 */
  47
  48#define CEU_BUFFER_MEMORY_SIZE          (4 << 20)
  49static phys_addr_t ceu_dma_membase;
  50
  51static struct smc91x_platdata smc91x_info = {
  52        .flags = SMC91X_USE_16BIT | SMC91X_NOWAIT,
  53};
  54
  55static struct resource smc91x_eth_resources[] = {
  56        [0] = {
  57                .name   = "SMC91C111" ,
  58                .start  = 0x10000300,
  59                .end    = 0x1000030f,
  60                .flags  = IORESOURCE_MEM,
  61        },
  62        [1] = {
  63                .start  = evt2irq(0x600), /* IRQ0 */
  64                .flags  = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHLEVEL,
  65        },
  66};
  67
  68static struct platform_device smc91x_eth_device = {
  69        .name           = "smc91x",
  70        .num_resources  = ARRAY_SIZE(smc91x_eth_resources),
  71        .resource       = smc91x_eth_resources,
  72        .dev    = {
  73                .platform_data  = &smc91x_info,
  74        },
  75};
  76
  77static struct sh_keysc_info sh_keysc_info = {
  78        .mode = SH_KEYSC_MODE_2, /* KEYOUT0->4, KEYIN1->5 */
  79        .scan_timing = 3,
  80        .delay = 5,
  81        .keycodes = {
  82                0, KEY_UP, KEY_DOWN, KEY_LEFT, KEY_RIGHT, KEY_ENTER,
  83                0, KEY_F, KEY_C, KEY_D, KEY_H, KEY_1,
  84                0, KEY_2, KEY_3, KEY_4, KEY_5, KEY_6,
  85                0, KEY_7, KEY_8, KEY_9, KEY_S, KEY_0,
  86                0, KEY_P, KEY_STOP, KEY_REWIND, KEY_PLAY, KEY_FASTFORWARD,
  87        },
  88};
  89
  90static struct resource sh_keysc_resources[] = {
  91        [0] = {
  92                .start  = 0x044b0000,
  93                .end    = 0x044b000f,
  94                .flags  = IORESOURCE_MEM,
  95        },
  96        [1] = {
  97                .start  = evt2irq(0xbe0),
  98                .flags  = IORESOURCE_IRQ,
  99        },
 100};
 101
 102static struct platform_device sh_keysc_device = {
 103        .name           = "sh_keysc",
 104        .id             = 0, /* "keysc0" clock */
 105        .num_resources  = ARRAY_SIZE(sh_keysc_resources),
 106        .resource       = sh_keysc_resources,
 107        .dev    = {
 108                .platform_data  = &sh_keysc_info,
 109        },
 110};
 111
 112static struct mtd_partition migor_nor_flash_partitions[] =
 113{
 114        {
 115                .name = "uboot",
 116                .offset = 0,
 117                .size = (1 * 1024 * 1024),
 118                .mask_flags = MTD_WRITEABLE,    /* Read-only */
 119        },
 120        {
 121                .name = "rootfs",
 122                .offset = MTDPART_OFS_APPEND,
 123                .size = (15 * 1024 * 1024),
 124        },
 125        {
 126                .name = "other",
 127                .offset = MTDPART_OFS_APPEND,
 128                .size = MTDPART_SIZ_FULL,
 129        },
 130};
 131
 132static struct physmap_flash_data migor_nor_flash_data = {
 133        .width          = 2,
 134        .parts          = migor_nor_flash_partitions,
 135        .nr_parts       = ARRAY_SIZE(migor_nor_flash_partitions),
 136};
 137
 138static struct resource migor_nor_flash_resources[] = {
 139        [0] = {
 140                .name           = "NOR Flash",
 141                .start          = 0x00000000,
 142                .end            = 0x03ffffff,
 143                .flags          = IORESOURCE_MEM,
 144        }
 145};
 146
 147static struct platform_device migor_nor_flash_device = {
 148        .name           = "physmap-flash",
 149        .resource       = migor_nor_flash_resources,
 150        .num_resources  = ARRAY_SIZE(migor_nor_flash_resources),
 151        .dev            = {
 152                .platform_data = &migor_nor_flash_data,
 153        },
 154};
 155
 156static struct mtd_partition migor_nand_flash_partitions[] = {
 157        {
 158                .name           = "nanddata1",
 159                .offset         = 0x0,
 160                .size           = 512 * 1024 * 1024,
 161        },
 162        {
 163                .name           = "nanddata2",
 164                .offset         = MTDPART_OFS_APPEND,
 165                .size           = 512 * 1024 * 1024,
 166        },
 167};
 168
 169static void migor_nand_flash_cmd_ctl(struct nand_chip *chip, int cmd,
 170                                     unsigned int ctrl)
 171{
 172        if (cmd == NAND_CMD_NONE)
 173                return;
 174
 175        if (ctrl & NAND_CLE)
 176                writeb(cmd, chip->legacy.IO_ADDR_W + 0x00400000);
 177        else if (ctrl & NAND_ALE)
 178                writeb(cmd, chip->legacy.IO_ADDR_W + 0x00800000);
 179        else
 180                writeb(cmd, chip->legacy.IO_ADDR_W);
 181}
 182
 183static int migor_nand_flash_ready(struct nand_chip *chip)
 184{
 185        return gpio_get_value(GPIO_PTA1); /* NAND_RBn */
 186}
 187
 188static struct platform_nand_data migor_nand_flash_data = {
 189        .chip = {
 190                .nr_chips = 1,
 191                .partitions = migor_nand_flash_partitions,
 192                .nr_partitions = ARRAY_SIZE(migor_nand_flash_partitions),
 193                .chip_delay = 20,
 194        },
 195        .ctrl = {
 196                .dev_ready = migor_nand_flash_ready,
 197                .cmd_ctrl = migor_nand_flash_cmd_ctl,
 198        },
 199};
 200
 201static struct resource migor_nand_flash_resources[] = {
 202        [0] = {
 203                .name           = "NAND Flash",
 204                .start          = 0x18000000,
 205                .end            = 0x18ffffff,
 206                .flags          = IORESOURCE_MEM,
 207        },
 208};
 209
 210static struct platform_device migor_nand_flash_device = {
 211        .name           = "gen_nand",
 212        .resource       = migor_nand_flash_resources,
 213        .num_resources  = ARRAY_SIZE(migor_nand_flash_resources),
 214        .dev            = {
 215                .platform_data = &migor_nand_flash_data,
 216        }
 217};
 218
 219static const struct fb_videomode migor_lcd_modes[] = {
 220        {
 221#if defined(CONFIG_SH_MIGOR_RTA_WVGA)
 222                .name = "LB070WV1",
 223                .xres = 800,
 224                .yres = 480,
 225                .left_margin = 64,
 226                .right_margin = 16,
 227                .hsync_len = 120,
 228                .sync = 0,
 229#elif defined(CONFIG_SH_MIGOR_QVGA)
 230                .name = "PH240320T",
 231                .xres = 320,
 232                .yres = 240,
 233                .left_margin = 0,
 234                .right_margin = 16,
 235                .hsync_len = 8,
 236                .sync = FB_SYNC_HOR_HIGH_ACT,
 237#endif
 238                .upper_margin = 1,
 239                .lower_margin = 17,
 240                .vsync_len = 2,
 241        },
 242};
 243
 244static struct sh_mobile_lcdc_info sh_mobile_lcdc_info = {
 245#if defined(CONFIG_SH_MIGOR_RTA_WVGA)
 246        .clock_source = LCDC_CLK_BUS,
 247        .ch[0] = {
 248                .chan = LCDC_CHAN_MAINLCD,
 249                .fourcc = V4L2_PIX_FMT_RGB565,
 250                .interface_type = RGB16,
 251                .clock_divider = 2,
 252                .lcd_modes = migor_lcd_modes,
 253                .num_modes = ARRAY_SIZE(migor_lcd_modes),
 254                .panel_cfg = { /* 7.0 inch */
 255                        .width = 152,
 256                        .height = 91,
 257                },
 258        }
 259#elif defined(CONFIG_SH_MIGOR_QVGA)
 260        .clock_source = LCDC_CLK_PERIPHERAL,
 261        .ch[0] = {
 262                .chan = LCDC_CHAN_MAINLCD,
 263                .fourcc = V4L2_PIX_FMT_RGB565,
 264                .interface_type = SYS16A,
 265                .clock_divider = 10,
 266                .lcd_modes = migor_lcd_modes,
 267                .num_modes = ARRAY_SIZE(migor_lcd_modes),
 268                .panel_cfg = {
 269                        .width = 49,    /* 2.4 inch */
 270                        .height = 37,
 271                        .setup_sys = migor_lcd_qvga_setup,
 272                },
 273                .sys_bus_cfg = {
 274                        .ldmt2r = 0x06000a09,
 275                        .ldmt3r = 0x180e3418,
 276                        /* set 1s delay to encourage fsync() */
 277                        .deferred_io_msec = 1000,
 278                },
 279        }
 280#endif
 281};
 282
 283static struct resource migor_lcdc_resources[] = {
 284        [0] = {
 285                .name   = "LCDC",
 286                .start  = 0xfe940000, /* P4-only space */
 287                .end    = 0xfe942fff,
 288                .flags  = IORESOURCE_MEM,
 289        },
 290        [1] = {
 291                .start  = evt2irq(0x580),
 292                .flags  = IORESOURCE_IRQ,
 293        },
 294};
 295
 296static struct platform_device migor_lcdc_device = {
 297        .name           = "sh_mobile_lcdc_fb",
 298        .num_resources  = ARRAY_SIZE(migor_lcdc_resources),
 299        .resource       = migor_lcdc_resources,
 300        .dev    = {
 301                .platform_data  = &sh_mobile_lcdc_info,
 302        },
 303};
 304
 305static struct ceu_platform_data ceu_pdata = {
 306        .num_subdevs                    = 2,
 307        .subdevs = {
 308                { /* [0] = ov772x */
 309                        .flags          = 0,
 310                        .bus_width      = 8,
 311                        .bus_shift      = 0,
 312                        .i2c_adapter_id = 0,
 313                        .i2c_address    = 0x21,
 314                },
 315                { /* [1] = tw9910 */
 316                        .flags          = 0,
 317                        .bus_width      = 8,
 318                        .bus_shift      = 0,
 319                        .i2c_adapter_id = 0,
 320                        .i2c_address    = 0x45,
 321                },
 322        },
 323};
 324
 325static struct resource migor_ceu_resources[] = {
 326        [0] = {
 327                .name   = "CEU",
 328                .start  = 0xfe910000,
 329                .end    = 0xfe91009f,
 330                .flags  = IORESOURCE_MEM,
 331        },
 332        [1] = {
 333                .start  = evt2irq(0x880),
 334                .flags  = IORESOURCE_IRQ,
 335        },
 336};
 337
 338static struct platform_device migor_ceu_device = {
 339        .name           = "renesas-ceu",
 340        .id             = 0, /* ceu.0 */
 341        .num_resources  = ARRAY_SIZE(migor_ceu_resources),
 342        .resource       = migor_ceu_resources,
 343        .dev    = {
 344                .platform_data  = &ceu_pdata,
 345        },
 346};
 347
 348/* Powerdown/reset gpios for CEU image sensors */
 349static struct gpiod_lookup_table ov7725_gpios = {
 350        .dev_id         = "0-0021",
 351        .table          = {
 352                GPIO_LOOKUP("sh7722_pfc", GPIO_PTT0, "powerdown",
 353                            GPIO_ACTIVE_HIGH),
 354                GPIO_LOOKUP("sh7722_pfc", GPIO_PTT3, "reset", GPIO_ACTIVE_LOW),
 355        },
 356};
 357
 358static struct gpiod_lookup_table tw9910_gpios = {
 359        .dev_id         = "0-0045",
 360        .table          = {
 361                GPIO_LOOKUP("sh7722_pfc", GPIO_PTT2, "pdn", GPIO_ACTIVE_LOW),
 362                GPIO_LOOKUP("sh7722_pfc", GPIO_PTT3, "rstb", GPIO_ACTIVE_LOW),
 363        },
 364};
 365
 366/* Fixed 3.3V regulator to be used by SDHI0 */
 367static struct regulator_consumer_supply fixed3v3_power_consumers[] =
 368{
 369        REGULATOR_SUPPLY("vmmc", "sh_mobile_sdhi.0"),
 370        REGULATOR_SUPPLY("vqmmc", "sh_mobile_sdhi.0"),
 371};
 372
 373static struct resource sdhi_cn9_resources[] = {
 374        [0] = {
 375                .name   = "SDHI",
 376                .start  = 0x04ce0000,
 377                .end    = 0x04ce00ff,
 378                .flags  = IORESOURCE_MEM,
 379        },
 380        [1] = {
 381                .start  = evt2irq(0xe80),
 382                .flags  = IORESOURCE_IRQ,
 383        },
 384};
 385
 386static struct tmio_mmc_data sh7724_sdhi_data = {
 387        .chan_priv_tx   = (void *)SHDMA_SLAVE_SDHI0_TX,
 388        .chan_priv_rx   = (void *)SHDMA_SLAVE_SDHI0_RX,
 389        .capabilities   = MMC_CAP_SDIO_IRQ,
 390};
 391
 392static struct platform_device sdhi_cn9_device = {
 393        .name           = "sh_mobile_sdhi",
 394        .num_resources  = ARRAY_SIZE(sdhi_cn9_resources),
 395        .resource       = sdhi_cn9_resources,
 396        .dev = {
 397                .platform_data  = &sh7724_sdhi_data,
 398        },
 399};
 400
 401static struct ov772x_camera_info ov7725_info = {
 402        .flags          = 0,
 403};
 404
 405static struct tw9910_video_info tw9910_info = {
 406        .buswidth       = 8,
 407        .mpout          = TW9910_MPO_FIELD,
 408};
 409
 410static struct i2c_board_info migor_i2c_devices[] = {
 411        {
 412                I2C_BOARD_INFO("rs5c372b", 0x32),
 413        },
 414        {
 415                I2C_BOARD_INFO("migor_ts", 0x51),
 416                .irq = evt2irq(0x6c0), /* IRQ6 */
 417        },
 418        {
 419                I2C_BOARD_INFO("wm8978", 0x1a),
 420        },
 421        {
 422                I2C_BOARD_INFO("ov772x", 0x21),
 423                .platform_data = &ov7725_info,
 424        },
 425        {
 426                I2C_BOARD_INFO("tw9910", 0x45),
 427                .platform_data = &tw9910_info,
 428        },
 429};
 430
 431static struct platform_device *migor_devices[] __initdata = {
 432        &smc91x_eth_device,
 433        &sh_keysc_device,
 434        &migor_lcdc_device,
 435        &migor_nor_flash_device,
 436        &migor_nand_flash_device,
 437        &sdhi_cn9_device,
 438};
 439
 440extern char migor_sdram_enter_start;
 441extern char migor_sdram_enter_end;
 442extern char migor_sdram_leave_start;
 443extern char migor_sdram_leave_end;
 444
 445static int __init migor_devices_setup(void)
 446{
 447        struct clk *video_clk;
 448
 449        /* register board specific self-refresh code */
 450        sh_mobile_register_self_refresh(SUSP_SH_STANDBY | SUSP_SH_SF,
 451                                        &migor_sdram_enter_start,
 452                                        &migor_sdram_enter_end,
 453                                        &migor_sdram_leave_start,
 454                                        &migor_sdram_leave_end);
 455
 456        regulator_register_always_on(0, "fixed-3.3V", fixed3v3_power_consumers,
 457                                     ARRAY_SIZE(fixed3v3_power_consumers), 3300000);
 458
 459        /* Let D11 LED show STATUS0 */
 460        gpio_request(GPIO_FN_STATUS0, NULL);
 461
 462        /* Lit D12 LED show PDSTATUS */
 463        gpio_request(GPIO_FN_PDSTATUS, NULL);
 464
 465        /* SMC91C111 - Enable IRQ0, Setup CS4 for 16-bit fast access */
 466        gpio_request(GPIO_FN_IRQ0, NULL);
 467        __raw_writel(0x00003400, BSC_CS4BCR);
 468        __raw_writel(0x00110080, BSC_CS4WCR);
 469
 470        /* KEYSC */
 471        gpio_request(GPIO_FN_KEYOUT0, NULL);
 472        gpio_request(GPIO_FN_KEYOUT1, NULL);
 473        gpio_request(GPIO_FN_KEYOUT2, NULL);
 474        gpio_request(GPIO_FN_KEYOUT3, NULL);
 475        gpio_request(GPIO_FN_KEYOUT4_IN6, NULL);
 476        gpio_request(GPIO_FN_KEYIN1, NULL);
 477        gpio_request(GPIO_FN_KEYIN2, NULL);
 478        gpio_request(GPIO_FN_KEYIN3, NULL);
 479        gpio_request(GPIO_FN_KEYIN4, NULL);
 480        gpio_request(GPIO_FN_KEYOUT5_IN5, NULL);
 481
 482        /* NAND Flash */
 483        gpio_request(GPIO_FN_CS6A_CE2B, NULL);
 484        __raw_writel((__raw_readl(BSC_CS6ABCR) & ~0x0600) | 0x0200, BSC_CS6ABCR);
 485        gpio_request(GPIO_PTA1, NULL);
 486        gpio_direction_input(GPIO_PTA1);
 487
 488        /* SDHI */
 489        gpio_request(GPIO_FN_SDHICD, NULL);
 490        gpio_request(GPIO_FN_SDHIWP, NULL);
 491        gpio_request(GPIO_FN_SDHID3, NULL);
 492        gpio_request(GPIO_FN_SDHID2, NULL);
 493        gpio_request(GPIO_FN_SDHID1, NULL);
 494        gpio_request(GPIO_FN_SDHID0, NULL);
 495        gpio_request(GPIO_FN_SDHICMD, NULL);
 496        gpio_request(GPIO_FN_SDHICLK, NULL);
 497
 498        /* Touch Panel */
 499        gpio_request(GPIO_FN_IRQ6, NULL);
 500
 501        /* LCD Panel */
 502#ifdef CONFIG_SH_MIGOR_QVGA /* LCDC - QVGA - Enable SYS Interface signals */
 503        gpio_request(GPIO_FN_LCDD17, NULL);
 504        gpio_request(GPIO_FN_LCDD16, NULL);
 505        gpio_request(GPIO_FN_LCDD15, NULL);
 506        gpio_request(GPIO_FN_LCDD14, NULL);
 507        gpio_request(GPIO_FN_LCDD13, NULL);
 508        gpio_request(GPIO_FN_LCDD12, NULL);
 509        gpio_request(GPIO_FN_LCDD11, NULL);
 510        gpio_request(GPIO_FN_LCDD10, NULL);
 511        gpio_request(GPIO_FN_LCDD8, NULL);
 512        gpio_request(GPIO_FN_LCDD7, NULL);
 513        gpio_request(GPIO_FN_LCDD6, NULL);
 514        gpio_request(GPIO_FN_LCDD5, NULL);
 515        gpio_request(GPIO_FN_LCDD4, NULL);
 516        gpio_request(GPIO_FN_LCDD3, NULL);
 517        gpio_request(GPIO_FN_LCDD2, NULL);
 518        gpio_request(GPIO_FN_LCDD1, NULL);
 519        gpio_request(GPIO_FN_LCDRS, NULL);
 520        gpio_request(GPIO_FN_LCDCS, NULL);
 521        gpio_request(GPIO_FN_LCDRD, NULL);
 522        gpio_request(GPIO_FN_LCDWR, NULL);
 523        gpio_request(GPIO_PTH2, NULL); /* LCD_DON */
 524        gpio_direction_output(GPIO_PTH2, 1);
 525#endif
 526#ifdef CONFIG_SH_MIGOR_RTA_WVGA /* LCDC - WVGA - Enable RGB Interface signals */
 527        gpio_request(GPIO_FN_LCDD15, NULL);
 528        gpio_request(GPIO_FN_LCDD14, NULL);
 529        gpio_request(GPIO_FN_LCDD13, NULL);
 530        gpio_request(GPIO_FN_LCDD12, NULL);
 531        gpio_request(GPIO_FN_LCDD11, NULL);
 532        gpio_request(GPIO_FN_LCDD10, NULL);
 533        gpio_request(GPIO_FN_LCDD9, NULL);
 534        gpio_request(GPIO_FN_LCDD8, NULL);
 535        gpio_request(GPIO_FN_LCDD7, NULL);
 536        gpio_request(GPIO_FN_LCDD6, NULL);
 537        gpio_request(GPIO_FN_LCDD5, NULL);
 538        gpio_request(GPIO_FN_LCDD4, NULL);
 539        gpio_request(GPIO_FN_LCDD3, NULL);
 540        gpio_request(GPIO_FN_LCDD2, NULL);
 541        gpio_request(GPIO_FN_LCDD1, NULL);
 542        gpio_request(GPIO_FN_LCDD0, NULL);
 543        gpio_request(GPIO_FN_LCDLCLK, NULL);
 544        gpio_request(GPIO_FN_LCDDCK, NULL);
 545        gpio_request(GPIO_FN_LCDVEPWC, NULL);
 546        gpio_request(GPIO_FN_LCDVCPWC, NULL);
 547        gpio_request(GPIO_FN_LCDVSYN, NULL);
 548        gpio_request(GPIO_FN_LCDHSYN, NULL);
 549        gpio_request(GPIO_FN_LCDDISP, NULL);
 550        gpio_request(GPIO_FN_LCDDON, NULL);
 551#endif
 552
 553        /* CEU */
 554        gpio_request(GPIO_FN_VIO_CLK2, NULL);
 555        gpio_request(GPIO_FN_VIO_VD2, NULL);
 556        gpio_request(GPIO_FN_VIO_HD2, NULL);
 557        gpio_request(GPIO_FN_VIO_FLD, NULL);
 558        gpio_request(GPIO_FN_VIO_CKO, NULL);
 559        gpio_request(GPIO_FN_VIO_D15, NULL);
 560        gpio_request(GPIO_FN_VIO_D14, NULL);
 561        gpio_request(GPIO_FN_VIO_D13, NULL);
 562        gpio_request(GPIO_FN_VIO_D12, NULL);
 563        gpio_request(GPIO_FN_VIO_D11, NULL);
 564        gpio_request(GPIO_FN_VIO_D10, NULL);
 565        gpio_request(GPIO_FN_VIO_D9, NULL);
 566        gpio_request(GPIO_FN_VIO_D8, NULL);
 567
 568        __raw_writew(__raw_readw(PORT_MSELCRB) | 0x2000, PORT_MSELCRB); /* D15->D8 */
 569
 570        /* SIU: Port B */
 571        gpio_request(GPIO_FN_SIUBOLR, NULL);
 572        gpio_request(GPIO_FN_SIUBOBT, NULL);
 573        gpio_request(GPIO_FN_SIUBISLD, NULL);
 574        gpio_request(GPIO_FN_SIUBOSLD, NULL);
 575        gpio_request(GPIO_FN_SIUMCKB, NULL);
 576
 577        /*
 578         * The original driver sets SIUB OLR/OBT, ILR/IBT, and SIUA OLR/OBT to
 579         * output. Need only SIUB, set to output for master mode (table 34.2)
 580         */
 581        __raw_writew(__raw_readw(PORT_MSELCRA) | 1, PORT_MSELCRA);
 582
 583         /*
 584          * Use 10 MHz VIO_CKO instead of 24 MHz to work around signal quality
 585          * issues on Panel Board V2.1.
 586          */
 587        video_clk = clk_get(NULL, "video_clk");
 588        if (!IS_ERR(video_clk)) {
 589                clk_set_rate(video_clk, clk_round_rate(video_clk, 10000000));
 590                clk_put(video_clk);
 591        }
 592
 593        /* Add a clock alias for ov7725 xclk source. */
 594        clk_add_alias(NULL, "0-0021", "video_clk", NULL);
 595
 596        /* Register GPIOs for video sources. */
 597        gpiod_add_lookup_table(&ov7725_gpios);
 598        gpiod_add_lookup_table(&tw9910_gpios);
 599
 600        i2c_register_board_info(0, migor_i2c_devices,
 601                                ARRAY_SIZE(migor_i2c_devices));
 602
 603        /* Initialize CEU platform device separately to map memory first */
 604        device_initialize(&migor_ceu_device.dev);
 605        dma_declare_coherent_memory(&migor_ceu_device.dev,
 606                        ceu_dma_membase, ceu_dma_membase,
 607                        ceu_dma_membase + CEU_BUFFER_MEMORY_SIZE - 1);
 608
 609        platform_device_add(&migor_ceu_device);
 610
 611        return platform_add_devices(migor_devices, ARRAY_SIZE(migor_devices));
 612}
 613arch_initcall(migor_devices_setup);
 614
 615/* Return the board specific boot mode pin configuration */
 616static int migor_mode_pins(void)
 617{
 618        /* MD0=1, MD1=1, MD2=0: Clock Mode 3
 619         * MD3=0: 16-bit Area0 Bus Width
 620         * MD5=1: Little Endian
 621         * TSTMD=1, MD8=0: Test Mode Disabled
 622         */
 623        return MODE_PIN0 | MODE_PIN1 | MODE_PIN5;
 624}
 625
 626/* Reserve a portion of memory for CEU buffers */
 627static void __init migor_mv_mem_reserve(void)
 628{
 629        phys_addr_t phys;
 630        phys_addr_t size = CEU_BUFFER_MEMORY_SIZE;
 631
 632        phys = memblock_phys_alloc(size, PAGE_SIZE);
 633        if (!phys)
 634                panic("Failed to allocate CEU memory\n");
 635
 636        memblock_free(phys, size);
 637        memblock_remove(phys, size);
 638
 639        ceu_dma_membase = phys;
 640}
 641
 642/*
 643 * The Machine Vector
 644 */
 645static struct sh_machine_vector mv_migor __initmv = {
 646        .mv_name                = "Migo-R",
 647        .mv_mode_pins           = migor_mode_pins,
 648        .mv_mem_reserve         = migor_mv_mem_reserve,
 649};
 650