linux/arch/sh/boards/mach-kfr2r09/setup.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * KFR2R09 board support code
   4 *
   5 * Copyright (C) 2009 Magnus Damm
   6 */
   7
   8#include <asm/clock.h>
   9#include <asm/io.h>
  10#include <asm/machvec.h>
  11#include <asm/suspend.h>
  12
  13#include <cpu/sh7724.h>
  14
  15#include <linux/clkdev.h>
  16#include <linux/delay.h>
  17#include <linux/dma-mapping.h>
  18#include <linux/gpio.h>
  19#include <linux/gpio/machine.h>
  20#include <linux/i2c.h>
  21#include <linux/init.h>
  22#include <linux/input.h>
  23#include <linux/input/sh_keysc.h>
  24#include <linux/interrupt.h>
  25#include <linux/memblock.h>
  26#include <linux/mfd/tmio.h>
  27#include <linux/mmc/host.h>
  28#include <linux/mtd/physmap.h>
  29#include <linux/platform_data/lv5207lp.h>
  30#include <linux/platform_device.h>
  31#include <linux/regulator/fixed.h>
  32#include <linux/regulator/machine.h>
  33#include <linux/sh_intc.h>
  34#include <linux/usb/r8a66597.h>
  35#include <linux/videodev2.h>
  36
  37#include <mach/kfr2r09.h>
  38
  39#include <media/drv-intf/renesas-ceu.h>
  40#include <media/i2c/rj54n1cb0c.h>
  41
  42#include <video/sh_mobile_lcdc.h>
  43
  44#define CEU_BUFFER_MEMORY_SIZE          (4 << 20)
  45static phys_addr_t ceu_dma_membase;
  46
  47/* set VIO_CKO clock to 25MHz */
  48#define CEU_MCLK_FREQ                   25000000
  49#define DRVCRB                          0xA405018C
  50
  51static struct mtd_partition kfr2r09_nor_flash_partitions[] =
  52{
  53        {
  54                .name = "boot",
  55                .offset = 0,
  56                .size = (4 * 1024 * 1024),
  57                .mask_flags = MTD_WRITEABLE,    /* Read-only */
  58        },
  59        {
  60                .name = "other",
  61                .offset = MTDPART_OFS_APPEND,
  62                .size = MTDPART_SIZ_FULL,
  63        },
  64};
  65
  66static struct physmap_flash_data kfr2r09_nor_flash_data = {
  67        .width          = 2,
  68        .parts          = kfr2r09_nor_flash_partitions,
  69        .nr_parts       = ARRAY_SIZE(kfr2r09_nor_flash_partitions),
  70};
  71
  72static struct resource kfr2r09_nor_flash_resources[] = {
  73        [0] = {
  74                .name           = "NOR Flash",
  75                .start          = 0x00000000,
  76                .end            = 0x03ffffff,
  77                .flags          = IORESOURCE_MEM,
  78        }
  79};
  80
  81static struct platform_device kfr2r09_nor_flash_device = {
  82        .name           = "physmap-flash",
  83        .resource       = kfr2r09_nor_flash_resources,
  84        .num_resources  = ARRAY_SIZE(kfr2r09_nor_flash_resources),
  85        .dev            = {
  86                .platform_data = &kfr2r09_nor_flash_data,
  87        },
  88};
  89
  90static struct resource kfr2r09_nand_flash_resources[] = {
  91        [0] = {
  92                .name           = "NAND Flash",
  93                .start          = 0x10000000,
  94                .end            = 0x1001ffff,
  95                .flags          = IORESOURCE_MEM,
  96        }
  97};
  98
  99static struct platform_device kfr2r09_nand_flash_device = {
 100        .name           = "onenand-flash",
 101        .resource       = kfr2r09_nand_flash_resources,
 102        .num_resources  = ARRAY_SIZE(kfr2r09_nand_flash_resources),
 103};
 104
 105static struct sh_keysc_info kfr2r09_sh_keysc_info = {
 106        .mode = SH_KEYSC_MODE_1, /* KEYOUT0->4, KEYIN0->4 */
 107        .scan_timing = 3,
 108        .delay = 10,
 109        .keycodes = {
 110                KEY_PHONE, KEY_CLEAR, KEY_MAIL, KEY_WWW, KEY_ENTER,
 111                KEY_1, KEY_2, KEY_3, 0, KEY_UP,
 112                KEY_4, KEY_5, KEY_6, 0, KEY_LEFT,
 113                KEY_7, KEY_8, KEY_9, KEY_PROG1, KEY_RIGHT,
 114                KEY_S, KEY_0, KEY_P, KEY_PROG2, KEY_DOWN,
 115                0, 0, 0, 0, 0
 116        },
 117};
 118
 119static struct resource kfr2r09_sh_keysc_resources[] = {
 120        [0] = {
 121                .name   = "KEYSC",
 122                .start  = 0x044b0000,
 123                .end    = 0x044b000f,
 124                .flags  = IORESOURCE_MEM,
 125        },
 126        [1] = {
 127                .start  = evt2irq(0xbe0),
 128                .flags  = IORESOURCE_IRQ,
 129        },
 130};
 131
 132static struct platform_device kfr2r09_sh_keysc_device = {
 133        .name           = "sh_keysc",
 134        .id             = 0, /* "keysc0" clock */
 135        .num_resources  = ARRAY_SIZE(kfr2r09_sh_keysc_resources),
 136        .resource       = kfr2r09_sh_keysc_resources,
 137        .dev    = {
 138                .platform_data  = &kfr2r09_sh_keysc_info,
 139        },
 140};
 141
 142static const struct fb_videomode kfr2r09_lcdc_modes[] = {
 143        {
 144                .name = "TX07D34VM0AAA",
 145                .xres = 240,
 146                .yres = 400,
 147                .left_margin = 0,
 148                .right_margin = 16,
 149                .hsync_len = 8,
 150                .upper_margin = 0,
 151                .lower_margin = 1,
 152                .vsync_len = 1,
 153                .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 154        },
 155};
 156
 157static struct sh_mobile_lcdc_info kfr2r09_sh_lcdc_info = {
 158        .clock_source = LCDC_CLK_BUS,
 159        .ch[0] = {
 160                .chan = LCDC_CHAN_MAINLCD,
 161                .fourcc = V4L2_PIX_FMT_RGB565,
 162                .interface_type = SYS18,
 163                .clock_divider = 6,
 164                .flags = LCDC_FLAGS_DWPOL,
 165                .lcd_modes = kfr2r09_lcdc_modes,
 166                .num_modes = ARRAY_SIZE(kfr2r09_lcdc_modes),
 167                .panel_cfg = {
 168                        .width = 35,
 169                        .height = 58,
 170                        .setup_sys = kfr2r09_lcd_setup,
 171                        .start_transfer = kfr2r09_lcd_start,
 172                },
 173                .sys_bus_cfg = {
 174                        .ldmt2r = 0x07010904,
 175                        .ldmt3r = 0x14012914,
 176                        /* set 1s delay to encourage fsync() */
 177                        .deferred_io_msec = 1000,
 178                },
 179        }
 180};
 181
 182static struct resource kfr2r09_sh_lcdc_resources[] = {
 183        [0] = {
 184                .name   = "LCDC",
 185                .start  = 0xfe940000, /* P4-only space */
 186                .end    = 0xfe942fff,
 187                .flags  = IORESOURCE_MEM,
 188        },
 189        [1] = {
 190                .start  = evt2irq(0xf40),
 191                .flags  = IORESOURCE_IRQ,
 192        },
 193};
 194
 195static struct platform_device kfr2r09_sh_lcdc_device = {
 196        .name           = "sh_mobile_lcdc_fb",
 197        .num_resources  = ARRAY_SIZE(kfr2r09_sh_lcdc_resources),
 198        .resource       = kfr2r09_sh_lcdc_resources,
 199        .dev    = {
 200                .platform_data  = &kfr2r09_sh_lcdc_info,
 201        },
 202};
 203
 204static struct lv5207lp_platform_data kfr2r09_backlight_data = {
 205        .fbdev = &kfr2r09_sh_lcdc_device.dev,
 206        .def_value = 13,
 207        .max_value = 13,
 208};
 209
 210static struct i2c_board_info kfr2r09_backlight_board_info = {
 211        I2C_BOARD_INFO("lv5207lp", 0x75),
 212        .platform_data = &kfr2r09_backlight_data,
 213};
 214
 215static struct r8a66597_platdata kfr2r09_usb0_gadget_data = {
 216        .on_chip = 1,
 217};
 218
 219static struct resource kfr2r09_usb0_gadget_resources[] = {
 220        [0] = {
 221                .start  = 0x04d80000,
 222                .end    = 0x04d80123,
 223                .flags  = IORESOURCE_MEM,
 224        },
 225        [1] = {
 226                .start  = evt2irq(0xa20),
 227                .end    = evt2irq(0xa20),
 228                .flags  = IORESOURCE_IRQ | IRQF_TRIGGER_LOW,
 229        },
 230};
 231
 232static struct platform_device kfr2r09_usb0_gadget_device = {
 233        .name           = "r8a66597_udc",
 234        .id             = 0,
 235        .dev = {
 236                .dma_mask               = NULL,         /*  not use dma */
 237                .coherent_dma_mask      = 0xffffffff,
 238                .platform_data  = &kfr2r09_usb0_gadget_data,
 239        },
 240        .num_resources  = ARRAY_SIZE(kfr2r09_usb0_gadget_resources),
 241        .resource       = kfr2r09_usb0_gadget_resources,
 242};
 243
 244static struct ceu_platform_data ceu_pdata = {
 245        .num_subdevs                    = 1,
 246        .subdevs = {
 247                { /* [0] = rj54n1cb0c */
 248                        .flags          = 0,
 249                        .bus_width      = 8,
 250                        .bus_shift      = 0,
 251                        .i2c_adapter_id = 1,
 252                        .i2c_address    = 0x50,
 253                },
 254        },
 255};
 256
 257static struct resource kfr2r09_ceu_resources[] = {
 258        [0] = {
 259                .name   = "CEU",
 260                .start  = 0xfe910000,
 261                .end    = 0xfe91009f,
 262                .flags  = IORESOURCE_MEM,
 263        },
 264        [1] = {
 265                .start  = evt2irq(0x880),
 266                .end    = evt2irq(0x880),
 267                .flags  = IORESOURCE_IRQ,
 268        },
 269};
 270
 271static struct platform_device kfr2r09_ceu_device = {
 272        .name           = "renesas-ceu",
 273        .id             = 0, /* "ceu0" clock */
 274        .num_resources  = ARRAY_SIZE(kfr2r09_ceu_resources),
 275        .resource       = kfr2r09_ceu_resources,
 276        .dev    = {
 277                .platform_data  = &ceu_pdata,
 278        },
 279};
 280
 281static struct rj54n1_pdata rj54n1_priv = {
 282        .mclk_freq      = CEU_MCLK_FREQ,
 283        .ioctl_high     = false,
 284};
 285
 286static struct i2c_board_info kfr2r09_i2c_camera = {
 287        I2C_BOARD_INFO("rj54n1cb0c", 0x50),
 288        .platform_data = &rj54n1_priv,
 289};
 290
 291static struct gpiod_lookup_table rj54n1_gpios = {
 292        .dev_id         = "1-0050",
 293        .table          = {
 294                GPIO_LOOKUP("sh7724_pfc", GPIO_PTB4, "poweron",
 295                            GPIO_ACTIVE_HIGH),
 296                GPIO_LOOKUP("sh7724_pfc", GPIO_PTB7, "enable",
 297                            GPIO_ACTIVE_HIGH),
 298        },
 299};
 300
 301/* Fixed 3.3V regulator to be used by SDHI0 */
 302static struct regulator_consumer_supply fixed3v3_power_consumers[] =
 303{
 304        REGULATOR_SUPPLY("vmmc", "sh_mobile_sdhi.0"),
 305        REGULATOR_SUPPLY("vqmmc", "sh_mobile_sdhi.0"),
 306};
 307
 308static struct resource kfr2r09_sh_sdhi0_resources[] = {
 309        [0] = {
 310                .name   = "SDHI0",
 311                .start  = 0x04ce0000,
 312                .end    = 0x04ce00ff,
 313                .flags  = IORESOURCE_MEM,
 314        },
 315        [1] = {
 316                .start  = evt2irq(0xe80),
 317                .flags  = IORESOURCE_IRQ,
 318        },
 319};
 320
 321static struct tmio_mmc_data sh7724_sdhi0_data = {
 322        .chan_priv_tx   = (void *)SHDMA_SLAVE_SDHI0_TX,
 323        .chan_priv_rx   = (void *)SHDMA_SLAVE_SDHI0_RX,
 324        .capabilities   = MMC_CAP_SDIO_IRQ,
 325        .capabilities2  = MMC_CAP2_NO_WRITE_PROTECT,
 326};
 327
 328static struct platform_device kfr2r09_sh_sdhi0_device = {
 329        .name           = "sh_mobile_sdhi",
 330        .num_resources  = ARRAY_SIZE(kfr2r09_sh_sdhi0_resources),
 331        .resource       = kfr2r09_sh_sdhi0_resources,
 332        .dev = {
 333                .platform_data  = &sh7724_sdhi0_data,
 334        },
 335};
 336
 337static struct platform_device *kfr2r09_devices[] __initdata = {
 338        &kfr2r09_nor_flash_device,
 339        &kfr2r09_nand_flash_device,
 340        &kfr2r09_sh_keysc_device,
 341        &kfr2r09_sh_lcdc_device,
 342        &kfr2r09_sh_sdhi0_device,
 343};
 344
 345#define BSC_CS0BCR 0xfec10004
 346#define BSC_CS0WCR 0xfec10024
 347#define BSC_CS4BCR 0xfec10010
 348#define BSC_CS4WCR 0xfec10030
 349#define PORT_MSELCRB 0xa4050182
 350
 351#ifdef CONFIG_I2C
 352static int kfr2r09_usb0_gadget_i2c_setup(void)
 353{
 354        struct i2c_adapter *a;
 355        struct i2c_msg msg;
 356        unsigned char buf[2];
 357        int ret;
 358
 359        a = i2c_get_adapter(0);
 360        if (!a)
 361                return -ENODEV;
 362
 363        /* set bit 1 (the second bit) of chip at 0x09, register 0x13 */
 364        buf[0] = 0x13;
 365        msg.addr = 0x09;
 366        msg.buf = buf;
 367        msg.len = 1;
 368        msg.flags = 0;
 369        ret = i2c_transfer(a, &msg, 1);
 370        if (ret != 1)
 371                return -ENODEV;
 372
 373        buf[0] = 0;
 374        msg.addr = 0x09;
 375        msg.buf = buf;
 376        msg.len = 1;
 377        msg.flags = I2C_M_RD;
 378        ret = i2c_transfer(a, &msg, 1);
 379        if (ret != 1)
 380                return -ENODEV;
 381
 382        buf[1] = buf[0] | (1 << 1);
 383        buf[0] = 0x13;
 384        msg.addr = 0x09;
 385        msg.buf = buf;
 386        msg.len = 2;
 387        msg.flags = 0;
 388        ret = i2c_transfer(a, &msg, 1);
 389        if (ret != 1)
 390                return -ENODEV;
 391
 392        return 0;
 393}
 394
 395static int kfr2r09_serial_i2c_setup(void)
 396{
 397        struct i2c_adapter *a;
 398        struct i2c_msg msg;
 399        unsigned char buf[2];
 400        int ret;
 401
 402        a = i2c_get_adapter(0);
 403        if (!a)
 404                return -ENODEV;
 405
 406        /* set bit 6 (the 7th bit) of chip at 0x09, register 0x13 */
 407        buf[0] = 0x13;
 408        msg.addr = 0x09;
 409        msg.buf = buf;
 410        msg.len = 1;
 411        msg.flags = 0;
 412        ret = i2c_transfer(a, &msg, 1);
 413        if (ret != 1)
 414                return -ENODEV;
 415
 416        buf[0] = 0;
 417        msg.addr = 0x09;
 418        msg.buf = buf;
 419        msg.len = 1;
 420        msg.flags = I2C_M_RD;
 421        ret = i2c_transfer(a, &msg, 1);
 422        if (ret != 1)
 423                return -ENODEV;
 424
 425        buf[1] = buf[0] | (1 << 6);
 426        buf[0] = 0x13;
 427        msg.addr = 0x09;
 428        msg.buf = buf;
 429        msg.len = 2;
 430        msg.flags = 0;
 431        ret = i2c_transfer(a, &msg, 1);
 432        if (ret != 1)
 433                return -ENODEV;
 434
 435        return 0;
 436}
 437#else
 438static int kfr2r09_usb0_gadget_i2c_setup(void)
 439{
 440        return -ENODEV;
 441}
 442
 443static int kfr2r09_serial_i2c_setup(void)
 444{
 445        return -ENODEV;
 446}
 447#endif
 448
 449static int kfr2r09_usb0_gadget_setup(void)
 450{
 451        int plugged_in;
 452
 453        gpio_request(GPIO_PTN4, NULL); /* USB_DET */
 454        gpio_direction_input(GPIO_PTN4);
 455        plugged_in = gpio_get_value(GPIO_PTN4);
 456        if (!plugged_in)
 457                return -ENODEV; /* no cable plugged in */
 458
 459        if (kfr2r09_usb0_gadget_i2c_setup() != 0)
 460                return -ENODEV; /* unable to configure using i2c */
 461
 462        __raw_writew((__raw_readw(PORT_MSELCRB) & ~0xc000) | 0x8000, PORT_MSELCRB);
 463        gpio_request(GPIO_FN_PDSTATUS, NULL); /* R-standby disables USB clock */
 464        gpio_request(GPIO_PTV6, NULL); /* USBCLK_ON */
 465        gpio_direction_output(GPIO_PTV6, 1); /* USBCLK_ON = H */
 466        msleep(20); /* wait 20ms to let the clock settle */
 467        clk_enable(clk_get(NULL, "usb0"));
 468        __raw_writew(0x0600, 0xa40501d4);
 469
 470        return 0;
 471}
 472
 473extern char kfr2r09_sdram_enter_start;
 474extern char kfr2r09_sdram_enter_end;
 475extern char kfr2r09_sdram_leave_start;
 476extern char kfr2r09_sdram_leave_end;
 477
 478static int __init kfr2r09_devices_setup(void)
 479{
 480        struct clk *camera_clk;
 481
 482        /* register board specific self-refresh code */
 483        sh_mobile_register_self_refresh(SUSP_SH_STANDBY | SUSP_SH_SF |
 484                                        SUSP_SH_RSTANDBY,
 485                                        &kfr2r09_sdram_enter_start,
 486                                        &kfr2r09_sdram_enter_end,
 487                                        &kfr2r09_sdram_leave_start,
 488                                        &kfr2r09_sdram_leave_end);
 489
 490        regulator_register_always_on(0, "fixed-3.3V", fixed3v3_power_consumers,
 491                                     ARRAY_SIZE(fixed3v3_power_consumers), 3300000);
 492
 493        /* enable SCIF1 serial port for YC401 console support */
 494        gpio_request(GPIO_FN_SCIF1_RXD, NULL);
 495        gpio_request(GPIO_FN_SCIF1_TXD, NULL);
 496        kfr2r09_serial_i2c_setup(); /* ECONTMSK(bit6=L10ONEN) set 1 */
 497        gpio_request(GPIO_PTG3, NULL); /* HPON_ON */
 498        gpio_direction_output(GPIO_PTG3, 1); /* HPON_ON = H */
 499
 500        /* setup NOR flash at CS0 */
 501        __raw_writel(0x36db0400, BSC_CS0BCR);
 502        __raw_writel(0x00000500, BSC_CS0WCR);
 503
 504        /* setup NAND flash at CS4 */
 505        __raw_writel(0x36db0400, BSC_CS4BCR);
 506        __raw_writel(0x00000500, BSC_CS4WCR);
 507
 508        /* setup KEYSC pins */
 509        gpio_request(GPIO_FN_KEYOUT0, NULL);
 510        gpio_request(GPIO_FN_KEYOUT1, NULL);
 511        gpio_request(GPIO_FN_KEYOUT2, NULL);
 512        gpio_request(GPIO_FN_KEYOUT3, NULL);
 513        gpio_request(GPIO_FN_KEYOUT4_IN6, NULL);
 514        gpio_request(GPIO_FN_KEYIN0, NULL);
 515        gpio_request(GPIO_FN_KEYIN1, NULL);
 516        gpio_request(GPIO_FN_KEYIN2, NULL);
 517        gpio_request(GPIO_FN_KEYIN3, NULL);
 518        gpio_request(GPIO_FN_KEYIN4, NULL);
 519        gpio_request(GPIO_FN_KEYOUT5_IN5, NULL);
 520
 521        /* setup LCDC pins for SYS panel */
 522        gpio_request(GPIO_FN_LCDD17, NULL);
 523        gpio_request(GPIO_FN_LCDD16, NULL);
 524        gpio_request(GPIO_FN_LCDD15, NULL);
 525        gpio_request(GPIO_FN_LCDD14, NULL);
 526        gpio_request(GPIO_FN_LCDD13, NULL);
 527        gpio_request(GPIO_FN_LCDD12, NULL);
 528        gpio_request(GPIO_FN_LCDD11, NULL);
 529        gpio_request(GPIO_FN_LCDD10, NULL);
 530        gpio_request(GPIO_FN_LCDD9, NULL);
 531        gpio_request(GPIO_FN_LCDD8, NULL);
 532        gpio_request(GPIO_FN_LCDD7, NULL);
 533        gpio_request(GPIO_FN_LCDD6, NULL);
 534        gpio_request(GPIO_FN_LCDD5, NULL);
 535        gpio_request(GPIO_FN_LCDD4, NULL);
 536        gpio_request(GPIO_FN_LCDD3, NULL);
 537        gpio_request(GPIO_FN_LCDD2, NULL);
 538        gpio_request(GPIO_FN_LCDD1, NULL);
 539        gpio_request(GPIO_FN_LCDD0, NULL);
 540        gpio_request(GPIO_FN_LCDRS, NULL); /* LCD_RS */
 541        gpio_request(GPIO_FN_LCDCS, NULL); /* LCD_CS/ */
 542        gpio_request(GPIO_FN_LCDRD, NULL); /* LCD_RD/ */
 543        gpio_request(GPIO_FN_LCDWR, NULL); /* LCD_WR/ */
 544        gpio_request(GPIO_FN_LCDVSYN, NULL); /* LCD_VSYNC */
 545        gpio_request(GPIO_PTE4, NULL); /* LCD_RST/ */
 546        gpio_direction_output(GPIO_PTE4, 1);
 547        gpio_request(GPIO_PTF4, NULL); /* PROTECT/ */
 548        gpio_direction_output(GPIO_PTF4, 1);
 549        gpio_request(GPIO_PTU0, NULL); /* LEDSTDBY/ */
 550        gpio_direction_output(GPIO_PTU0, 1);
 551
 552        /* setup USB function */
 553        if (kfr2r09_usb0_gadget_setup() == 0)
 554                platform_device_register(&kfr2r09_usb0_gadget_device);
 555
 556        /* CEU */
 557        gpio_request(GPIO_FN_VIO_CKO, NULL);
 558        gpio_request(GPIO_FN_VIO0_CLK, NULL);
 559        gpio_request(GPIO_FN_VIO0_VD, NULL);
 560        gpio_request(GPIO_FN_VIO0_HD, NULL);
 561        gpio_request(GPIO_FN_VIO0_FLD, NULL);
 562        gpio_request(GPIO_FN_VIO0_D7, NULL);
 563        gpio_request(GPIO_FN_VIO0_D6, NULL);
 564        gpio_request(GPIO_FN_VIO0_D5, NULL);
 565        gpio_request(GPIO_FN_VIO0_D4, NULL);
 566        gpio_request(GPIO_FN_VIO0_D3, NULL);
 567        gpio_request(GPIO_FN_VIO0_D2, NULL);
 568        gpio_request(GPIO_FN_VIO0_D1, NULL);
 569        gpio_request(GPIO_FN_VIO0_D0, NULL);
 570
 571        /* SDHI0 connected to yc304 */
 572        gpio_request(GPIO_FN_SDHI0CD, NULL);
 573        gpio_request(GPIO_FN_SDHI0D3, NULL);
 574        gpio_request(GPIO_FN_SDHI0D2, NULL);
 575        gpio_request(GPIO_FN_SDHI0D1, NULL);
 576        gpio_request(GPIO_FN_SDHI0D0, NULL);
 577        gpio_request(GPIO_FN_SDHI0CMD, NULL);
 578        gpio_request(GPIO_FN_SDHI0CLK, NULL);
 579
 580        i2c_register_board_info(0, &kfr2r09_backlight_board_info, 1);
 581
 582        /* Set camera clock frequency and register and alias for rj54n1. */
 583        camera_clk = clk_get(NULL, "video_clk");
 584        if (!IS_ERR(camera_clk)) {
 585                clk_set_rate(camera_clk,
 586                             clk_round_rate(camera_clk, CEU_MCLK_FREQ));
 587                clk_put(camera_clk);
 588        }
 589        clk_add_alias(NULL, "1-0050", "video_clk", NULL);
 590
 591        /* set DRVCRB
 592         *
 593         * use 1.8 V for VccQ_VIO
 594         * use 2.85V for VccQ_SR
 595         */
 596        __raw_writew((__raw_readw(DRVCRB) & ~0x0003) | 0x0001, DRVCRB);
 597
 598        gpiod_add_lookup_table(&rj54n1_gpios);
 599
 600        i2c_register_board_info(1, &kfr2r09_i2c_camera, 1);
 601
 602        /* Initialize CEU platform device separately to map memory first */
 603        device_initialize(&kfr2r09_ceu_device.dev);
 604        arch_setup_pdev_archdata(&kfr2r09_ceu_device);
 605        dma_declare_coherent_memory(&kfr2r09_ceu_device.dev,
 606                        ceu_dma_membase, ceu_dma_membase,
 607                        ceu_dma_membase + CEU_BUFFER_MEMORY_SIZE - 1);
 608
 609        platform_device_add(&kfr2r09_ceu_device);
 610
 611        return platform_add_devices(kfr2r09_devices,
 612                                    ARRAY_SIZE(kfr2r09_devices));
 613}
 614device_initcall(kfr2r09_devices_setup);
 615
 616/* Return the board specific boot mode pin configuration */
 617static int kfr2r09_mode_pins(void)
 618{
 619        /* MD0=1, MD1=1, MD2=0: Clock Mode 3
 620         * MD3=0: 16-bit Area0 Bus Width
 621         * MD5=1: Little Endian
 622         * MD8=1: Test Mode Disabled
 623         */
 624        return MODE_PIN0 | MODE_PIN1 | MODE_PIN5 | MODE_PIN8;
 625}
 626
 627/* Reserve a portion of memory for CEU buffers */
 628static void __init kfr2r09_mv_mem_reserve(void)
 629{
 630        phys_addr_t phys;
 631        phys_addr_t size = CEU_BUFFER_MEMORY_SIZE;
 632
 633        phys = memblock_phys_alloc(size, PAGE_SIZE);
 634        if (!phys)
 635                panic("Failed to allocate CEU memory\n");
 636
 637        memblock_free(phys, size);
 638        memblock_remove(phys, size);
 639
 640        ceu_dma_membase = phys;
 641}
 642
 643/*
 644 * The Machine Vector
 645 */
 646static struct sh_machine_vector mv_kfr2r09 __initmv = {
 647        .mv_name                = "kfr2r09",
 648        .mv_mode_pins           = kfr2r09_mode_pins,
 649        .mv_mem_reserve         = kfr2r09_mv_mem_reserve,
 650};
 651