SAFE public projects git trees. - safe/jmp/linux-2.6/blob - arch/sh/boards/mach-se/7724/setup.c

   1 /*
   2  * linux/arch/sh/boards/se/7724/setup.c
   3  *
   4  * Copyright (C) 2009 Renesas Solutions Corp.
   5  *
   6  * Kuninori Morimoto <morimoto.kuninori@renesas.com>
   7  *
   8  * This file is subject to the terms and conditions of the GNU General Public
   9  * License.  See the file "COPYING" in the main directory of this archive
  10  * for more details.
  11  */
  12
  13 #include <linux/init.h>
  14 #include <linux/device.h>
  15 #include <linux/interrupt.h>
  16 #include <linux/platform_device.h>
  17 #include <linux/mtd/physmap.h>
  18 #include <linux/delay.h>
  19 #include <linux/smc91x.h>
  20 #include <linux/gpio.h>
  21 #include <linux/input.h>
  22 #include <linux/usb/r8a66597.h>
  23 #include <video/sh_mobile_lcdc.h>
  24 #include <media/sh_mobile_ceu.h>
  25 #include <asm/io.h>
  26 #include <asm/heartbeat.h>
  27 #include <asm/sh_eth.h>
  28 #include <asm/clock.h>
  29 #include <asm/sh_keysc.h>
  30 #include <cpu/sh7724.h>
  31 #include <mach-se/mach/se7724.h>
  32
  33 /*
  34  * SWx    1234 5678
  35  * ------------------------------------
  36  * SW31 : 1001 1100    : default
  37  * SW32 : 0111 1111    : use on board flash
  38  *
  39  * SW41 : abxx xxxx  -> a = 0 : Analog  monitor
  40  *                          1 : Digital monitor
  41  *                      b = 0 : VGA
  42  *                          1 : 720p
  43  */
  44
  45 /*
  46  * about 720p
  47  *
  48  * When you use 1280 x 720 lcdc output,
  49  * you should change OSC6 lcdc clock from 25.175MHz to 74.25MHz,
  50  * and change SW41 to use 720p
  51  */
  52
  53 /* Heartbeat */
  54 static struct heartbeat_data heartbeat_data = {
  55         .regsize = 16,
  56 };
  57
  58 static struct resource heartbeat_resources[] = {
  59         [0] = {
  60                 .start  = PA_LED,
  61                 .end    = PA_LED,
  62                 .flags  = IORESOURCE_MEM,
  63         },
  64 };
  65
  66 static struct platform_device heartbeat_device = {
  67         .name           = "heartbeat",
  68         .id             = -1,
  69         .dev = {
  70                 .platform_data = &heartbeat_data,
  71         },
  72         .num_resources  = ARRAY_SIZE(heartbeat_resources),
  73         .resource       = heartbeat_resources,
  74 };
  75
  76 /* LAN91C111 */
  77 static struct smc91x_platdata smc91x_info = {
  78         .flags = SMC91X_USE_16BIT | SMC91X_NOWAIT,
  79 };
  80
  81 static struct resource smc91x_eth_resources[] = {
  82         [0] = {
  83                 .name   = "SMC91C111" ,
  84                 .start  = 0x1a300300,
  85                 .end    = 0x1a30030f,
  86                 .flags  = IORESOURCE_MEM,
  87         },
  88         [1] = {
  89                 .start  = IRQ0_SMC,
  90                 .flags  = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHLEVEL,
  91         },
  92 };
  93
  94 static struct platform_device smc91x_eth_device = {
  95         .name   = "smc91x",
  96         .num_resources  = ARRAY_SIZE(smc91x_eth_resources),
  97         .resource       = smc91x_eth_resources,
  98         .dev    = {
  99                 .platform_data  = &smc91x_info,
 100         },
 101 };
 102
 103 /* MTD */
 104 static struct mtd_partition nor_flash_partitions[] = {
 105         {
 106                 .name = "uboot",
 107                 .offset = 0,
 108                 .size = (1 * 1024 * 1024),
 109                 .mask_flags = MTD_WRITEABLE,    /* Read-only */
 110         }, {
 111                 .name = "kernel",
 112                 .offset = MTDPART_OFS_APPEND,
 113                 .size = (2 * 1024 * 1024),
 114         }, {
 115                 .name = "free-area",
 116                 .offset = MTDPART_OFS_APPEND,
 117                 .size = MTDPART_SIZ_FULL,
 118         },
 119 };
 120
 121 static struct physmap_flash_data nor_flash_data = {
 122         .width          = 2,
 123         .parts          = nor_flash_partitions,
 124         .nr_parts       = ARRAY_SIZE(nor_flash_partitions),
 125 };
 126
 127 static struct resource nor_flash_resources[] = {
 128         [0] = {
 129                 .name   = "NOR Flash",
 130                 .start  = 0x00000000,
 131                 .end    = 0x01ffffff,
 132                 .flags  = IORESOURCE_MEM,
 133         }
 134 };
 135
 136 static struct platform_device nor_flash_device = {
 137         .name           = "physmap-flash",
 138         .resource       = nor_flash_resources,
 139         .num_resources  = ARRAY_SIZE(nor_flash_resources),
 140         .dev            = {
 141                 .platform_data = &nor_flash_data,
 142         },
 143 };
 144
 145 /* LCDC */
 146 static struct sh_mobile_lcdc_info lcdc_info = {
 147         .clock_source = LCDC_CLK_EXTERNAL,
 148         .ch[0] = {
 149                 .chan = LCDC_CHAN_MAINLCD,
 150                 .bpp = 16,
 151                 .clock_divider = 1,
 152                 .lcd_cfg = {
 153                         .name = "LB070WV1",
 154                         .sync = 0, /* hsync and vsync are active low */
 155                 },
 156                 .lcd_size_cfg = { /* 7.0 inch */
 157                         .width = 152,
 158                         .height = 91,
 159                 },
 160                 .board_cfg = {
 161                 },
 162         }
 163 };
 164
 165 static struct resource lcdc_resources[] = {
 166         [0] = {
 167                 .name   = "LCDC",
 168                 .start  = 0xfe940000,
 169                 .end    = 0xfe941fff,
 170                 .flags  = IORESOURCE_MEM,
 171         },
 172         [1] = {
 173                 .start  = 106,
 174                 .flags  = IORESOURCE_IRQ,
 175         },
 176 };
 177
 178 static struct platform_device lcdc_device = {
 179         .name           = "sh_mobile_lcdc_fb",
 180         .num_resources  = ARRAY_SIZE(lcdc_resources),
 181         .resource       = lcdc_resources,
 182         .dev            = {
 183                 .platform_data  = &lcdc_info,
 184         },
 185 };
 186
 187 /* CEU0 */
 188 static struct sh_mobile_ceu_info sh_mobile_ceu0_info = {
 189         .flags = SH_CEU_FLAG_USE_8BIT_BUS,
 190 };
 191
 192 static struct resource ceu0_resources[] = {
 193         [0] = {
 194                 .name   = "CEU0",
 195                 .start  = 0xfe910000,
 196                 .end    = 0xfe91009f,
 197                 .flags  = IORESOURCE_MEM,
 198         },
 199         [1] = {
 200                 .start  = 52,
 201                 .flags  = IORESOURCE_IRQ,
 202         },
 203         [2] = {
 204                 /* place holder for contiguous memory */
 205         },
 206 };
 207
 208 static struct platform_device ceu0_device = {
 209         .name           = "sh_mobile_ceu",
 210         .id             = 0, /* "ceu0" clock */
 211         .num_resources  = ARRAY_SIZE(ceu0_resources),
 212         .resource       = ceu0_resources,
 213         .dev    = {
 214                 .platform_data  = &sh_mobile_ceu0_info,
 215         },
 216 };
 217
 218 /* CEU1 */
 219 static struct sh_mobile_ceu_info sh_mobile_ceu1_info = {
 220         .flags = SH_CEU_FLAG_USE_8BIT_BUS,
 221 };
 222
 223 static struct resource ceu1_resources[] = {
 224         [0] = {
 225                 .name   = "CEU1",
 226                 .start  = 0xfe914000,
 227                 .end    = 0xfe91409f,
 228                 .flags  = IORESOURCE_MEM,
 229         },
 230         [1] = {
 231                 .start  = 63,
 232                 .flags  = IORESOURCE_IRQ,
 233         },
 234         [2] = {
 235                 /* place holder for contiguous memory */
 236         },
 237 };
 238
 239 static struct platform_device ceu1_device = {
 240         .name           = "sh_mobile_ceu",
 241         .id             = 1, /* "ceu1" clock */
 242         .num_resources  = ARRAY_SIZE(ceu1_resources),
 243         .resource       = ceu1_resources,
 244         .dev    = {
 245                 .platform_data  = &sh_mobile_ceu1_info,
 246         },
 247 };
 248
 249 /* KEYSC in SoC (Needs SW33-2 set to ON) */
 250 static struct sh_keysc_info keysc_info = {
 251         .mode = SH_KEYSC_MODE_1,
 252         .scan_timing = 10,
 253         .delay = 50,
 254         .keycodes = {
 255                 KEY_1, KEY_2, KEY_3, KEY_4, KEY_5,
 256                 KEY_6, KEY_7, KEY_8, KEY_9, KEY_A,
 257                 KEY_B, KEY_C, KEY_D, KEY_E, KEY_F,
 258                 KEY_G, KEY_H, KEY_I, KEY_K, KEY_L,
 259                 KEY_M, KEY_N, KEY_O, KEY_P, KEY_Q,
 260                 KEY_R, KEY_S, KEY_T, KEY_U, KEY_V,
 261         },
 262 };
 263
 264 static struct resource keysc_resources[] = {
 265         [0] = {
 266                 .name   = "KEYSC",
 267                 .start  = 0x044b0000,
 268                 .end    = 0x044b000f,
 269                 .flags  = IORESOURCE_MEM,
 270         },
 271         [1] = {
 272                 .start  = 79,
 273                 .flags  = IORESOURCE_IRQ,
 274         },
 275 };
 276
 277 static struct platform_device keysc_device = {
 278         .name           = "sh_keysc",
 279         .id             = 0, /* "keysc0" clock */
 280         .num_resources  = ARRAY_SIZE(keysc_resources),
 281         .resource       = keysc_resources,
 282         .dev    = {
 283                 .platform_data  = &keysc_info,
 284         },
 285 };
 286
 287 /* SH Eth */
 288 static struct resource sh_eth_resources[] = {
 289         [0] = {
 290                 .start = SH_ETH_ADDR,
 291                 .end   = SH_ETH_ADDR + 0x1FC,
 292                 .flags = IORESOURCE_MEM,
 293         },
 294         [1] = {
 295                 .start = 91,
 296                 .flags = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHLEVEL,
 297         },
 298 };
 299
 300 struct sh_eth_plat_data sh_eth_plat = {
 301         .phy = 0x1f, /* SMSC LAN8187 */
 302         .edmac_endian = EDMAC_LITTLE_ENDIAN,
 303 };
 304
 305 static struct platform_device sh_eth_device = {
 306         .name = "sh-eth",
 307         .id     = 0,
 308         .dev = {
 309                 .platform_data = &sh_eth_plat,
 310         },
 311         .num_resources = ARRAY_SIZE(sh_eth_resources),
 312         .resource = sh_eth_resources,
 313 };
 314
 315 static struct r8a66597_platdata sh7724_usb0_host_data = {
 316         .on_chip = 1,
 317 };
 318
 319 static struct resource sh7724_usb0_host_resources[] = {
 320         [0] = {
 321                 .start  = 0xa4d80000,
 322                 .end    = 0xa4d80124 - 1,
 323                 .flags  = IORESOURCE_MEM,
 324         },
 325         [1] = {
 326                 .start  = 65,
 327                 .end    = 65,
 328                 .flags  = IORESOURCE_IRQ | IRQF_TRIGGER_LOW,
 329         },
 330 };
 331
 332 static struct platform_device sh7724_usb0_host_device = {
 333         .name           = "r8a66597_hcd",
 334         .id             = 0,
 335         .dev = {
 336                 .dma_mask               = NULL,         /*  not use dma */
 337                 .coherent_dma_mask      = 0xffffffff,
 338                 .platform_data          = &sh7724_usb0_host_data,
 339         },
 340         .num_resources  = ARRAY_SIZE(sh7724_usb0_host_resources),
 341         .resource       = sh7724_usb0_host_resources,
 342 };
 343
 344 static struct platform_device *ms7724se_devices[] __initdata = {
 345         &heartbeat_device,
 346         &smc91x_eth_device,
 347         &lcdc_device,
 348         &nor_flash_device,
 349         &ceu0_device,
 350         &ceu1_device,
 351         &keysc_device,
 352         &sh_eth_device,
 353         &sh7724_usb0_host_device,
 354 };
 355
 356 #define EEPROM_OP   0xBA206000
 357 #define EEPROM_ADR  0xBA206004
 358 #define EEPROM_DATA 0xBA20600C
 359 #define EEPROM_STAT 0xBA206010
 360 #define EEPROM_STRT 0xBA206014
 361 static int __init sh_eth_is_eeprom_ready(void)
 362 {
 363         int t = 10000;
 364
 365         while (t--) {
 366                 if (!ctrl_inw(EEPROM_STAT))
 367                         return 1;
 368                 cpu_relax();
 369         }
 370
 371         printk(KERN_ERR "ms7724se can not access to eeprom\n");
 372         return 0;
 373 }
 374
 375 static void __init sh_eth_init(void)
 376 {
 377         int i;
 378         u16 mac[3];
 379
 380         /* check EEPROM status */
 381         if (!sh_eth_is_eeprom_ready())
 382                 return;
 383
 384         /* read MAC addr from EEPROM */
 385         for (i = 0 ; i < 3 ; i++) {
 386                 ctrl_outw(0x0, EEPROM_OP); /* read */
 387                 ctrl_outw(i*2, EEPROM_ADR);
 388                 ctrl_outw(0x1, EEPROM_STRT);
 389                 if (!sh_eth_is_eeprom_ready())
 390                         return;
 391
 392                 mac[i] = ctrl_inw(EEPROM_DATA);
 393                 mac[i] = ((mac[i] & 0xFF) << 8) | (mac[i] >> 8); /* swap */
 394         }
 395
 396         /* reset sh-eth */
 397         ctrl_outl(0x1, SH_ETH_ADDR + 0x0);
 398
 399         /* set MAC addr */
 400         ctrl_outl(((mac[0] << 16) | (mac[1])), SH_ETH_MAHR);
 401         ctrl_outl((mac[2]), SH_ETH_MALR);
 402 }
 403
 404 #define SW4140    0xBA201000
 405 #define FPGA_OUT  0xBA200400
 406 #define PORT_HIZA 0xA4050158
 407 #define PORT_MSELCRB 0xA4050182
 408
 409 #define SW41_A    0x0100
 410 #define SW41_B    0x0200
 411 #define SW41_C    0x0400
 412 #define SW41_D    0x0800
 413 #define SW41_E    0x1000
 414 #define SW41_F    0x2000
 415 #define SW41_G    0x4000
 416 #define SW41_H    0x8000
 417
 418 static int __init devices_setup(void)
 419 {
 420         u16 sw = ctrl_inw(SW4140); /* select camera, monitor */
 421
 422         /* Reset Release */
 423         ctrl_outw(ctrl_inw(FPGA_OUT) &
 424                   ~((1 << 1)  | /* LAN */
 425                     (1 << 6)  | /* VIDEO DAC */
 426                     (1 << 12) | /* USB0 */
 427                     (1 << 14)), /* RMII */
 428                   FPGA_OUT);
 429
 430         /* turn on USB clocks, use external clock */
 431         ctrl_outw((ctrl_inw(PORT_MSELCRB) & ~0xc000) | 0x8000, PORT_MSELCRB);
 432
 433 #ifdef CONFIG_PM
 434         /* Let LED9 show STATUS2 */
 435         gpio_request(GPIO_FN_STATUS2, NULL);
 436
 437         /* Lit LED10 show STATUS0 */
 438         gpio_request(GPIO_FN_STATUS0, NULL);
 439
 440         /* Lit LED11 show PDSTATUS */
 441         gpio_request(GPIO_FN_PDSTATUS, NULL);
 442 #else
 443         /* Lit LED9 */
 444         gpio_request(GPIO_PTJ6, NULL);
 445         gpio_direction_output(GPIO_PTJ6, 1);
 446         gpio_export(GPIO_PTJ6, 0);
 447
 448         /* Lit LED10 */
 449         gpio_request(GPIO_PTJ5, NULL);
 450         gpio_direction_output(GPIO_PTJ5, 1);
 451         gpio_export(GPIO_PTJ5, 0);
 452
 453         /* Lit LED11 */
 454         gpio_request(GPIO_PTJ7, NULL);
 455         gpio_direction_output(GPIO_PTJ7, 1);
 456         gpio_export(GPIO_PTJ7, 0);
 457 #endif
 458
 459         /* enable USB0 port */
 460         ctrl_outw(0x0600, 0xa40501d4);
 461
 462         /* enable IRQ 0,1,2 */
 463         gpio_request(GPIO_FN_INTC_IRQ0, NULL);
 464         gpio_request(GPIO_FN_INTC_IRQ1, NULL);
 465         gpio_request(GPIO_FN_INTC_IRQ2, NULL);
 466
 467         /* enable SCIFA3 */
 468         gpio_request(GPIO_FN_SCIF3_I_SCK, NULL);
 469         gpio_request(GPIO_FN_SCIF3_I_RXD, NULL);
 470         gpio_request(GPIO_FN_SCIF3_I_TXD, NULL);
 471         gpio_request(GPIO_FN_SCIF3_I_CTS, NULL);
 472         gpio_request(GPIO_FN_SCIF3_I_RTS, NULL);
 473
 474         /* enable LCDC */
 475         gpio_request(GPIO_FN_LCDD23,   NULL);
 476         gpio_request(GPIO_FN_LCDD22,   NULL);
 477         gpio_request(GPIO_FN_LCDD21,   NULL);
 478         gpio_request(GPIO_FN_LCDD20,   NULL);
 479         gpio_request(GPIO_FN_LCDD19,   NULL);
 480         gpio_request(GPIO_FN_LCDD18,   NULL);
 481         gpio_request(GPIO_FN_LCDD17,   NULL);
 482         gpio_request(GPIO_FN_LCDD16,   NULL);
 483         gpio_request(GPIO_FN_LCDD15,   NULL);
 484         gpio_request(GPIO_FN_LCDD14,   NULL);
 485         gpio_request(GPIO_FN_LCDD13,   NULL);
 486         gpio_request(GPIO_FN_LCDD12,   NULL);
 487         gpio_request(GPIO_FN_LCDD11,   NULL);
 488         gpio_request(GPIO_FN_LCDD10,   NULL);
 489         gpio_request(GPIO_FN_LCDD9,    NULL);
 490         gpio_request(GPIO_FN_LCDD8,    NULL);
 491         gpio_request(GPIO_FN_LCDD7,    NULL);
 492         gpio_request(GPIO_FN_LCDD6,    NULL);
 493         gpio_request(GPIO_FN_LCDD5,    NULL);
 494         gpio_request(GPIO_FN_LCDD4,    NULL);
 495         gpio_request(GPIO_FN_LCDD3,    NULL);
 496         gpio_request(GPIO_FN_LCDD2,    NULL);
 497         gpio_request(GPIO_FN_LCDD1,    NULL);
 498         gpio_request(GPIO_FN_LCDD0,    NULL);
 499         gpio_request(GPIO_FN_LCDDISP,  NULL);
 500         gpio_request(GPIO_FN_LCDHSYN,  NULL);
 501         gpio_request(GPIO_FN_LCDDCK,   NULL);
 502         gpio_request(GPIO_FN_LCDVSYN,  NULL);
 503         gpio_request(GPIO_FN_LCDDON,   NULL);
 504         gpio_request(GPIO_FN_LCDVEPWC, NULL);
 505         gpio_request(GPIO_FN_LCDVCPWC, NULL);
 506         gpio_request(GPIO_FN_LCDRD,    NULL);
 507         gpio_request(GPIO_FN_LCDLCLK,  NULL);
 508         ctrl_outw((ctrl_inw(PORT_HIZA) & ~0x0001), PORT_HIZA);
 509
 510         /* enable CEU0 */
 511         gpio_request(GPIO_FN_VIO0_D15, NULL);
 512         gpio_request(GPIO_FN_VIO0_D14, NULL);
 513         gpio_request(GPIO_FN_VIO0_D13, NULL);
 514         gpio_request(GPIO_FN_VIO0_D12, NULL);
 515         gpio_request(GPIO_FN_VIO0_D11, NULL);
 516         gpio_request(GPIO_FN_VIO0_D10, NULL);
 517         gpio_request(GPIO_FN_VIO0_D9,  NULL);
 518         gpio_request(GPIO_FN_VIO0_D8,  NULL);
 519         gpio_request(GPIO_FN_VIO0_D7,  NULL);
 520         gpio_request(GPIO_FN_VIO0_D6,  NULL);
 521         gpio_request(GPIO_FN_VIO0_D5,  NULL);
 522         gpio_request(GPIO_FN_VIO0_D4,  NULL);
 523         gpio_request(GPIO_FN_VIO0_D3,  NULL);
 524         gpio_request(GPIO_FN_VIO0_D2,  NULL);
 525         gpio_request(GPIO_FN_VIO0_D1,  NULL);
 526         gpio_request(GPIO_FN_VIO0_D0,  NULL);
 527         gpio_request(GPIO_FN_VIO0_VD,  NULL);
 528         gpio_request(GPIO_FN_VIO0_CLK, NULL);
 529         gpio_request(GPIO_FN_VIO0_FLD, NULL);
 530         gpio_request(GPIO_FN_VIO0_HD,  NULL);
 531         platform_resource_setup_memory(&ceu0_device, "ceu0", 4 << 20);
 532
 533         /* enable CEU1 */
 534         gpio_request(GPIO_FN_VIO1_D7,  NULL);
 535         gpio_request(GPIO_FN_VIO1_D6,  NULL);
 536         gpio_request(GPIO_FN_VIO1_D5,  NULL);
 537         gpio_request(GPIO_FN_VIO1_D4,  NULL);
 538         gpio_request(GPIO_FN_VIO1_D3,  NULL);
 539         gpio_request(GPIO_FN_VIO1_D2,  NULL);
 540         gpio_request(GPIO_FN_VIO1_D1,  NULL);
 541         gpio_request(GPIO_FN_VIO1_D0,  NULL);
 542         gpio_request(GPIO_FN_VIO1_FLD, NULL);
 543         gpio_request(GPIO_FN_VIO1_HD,  NULL);
 544         gpio_request(GPIO_FN_VIO1_VD,  NULL);
 545         gpio_request(GPIO_FN_VIO1_CLK, NULL);
 546         platform_resource_setup_memory(&ceu1_device, "ceu1", 4 << 20);
 547
 548         /* KEYSC */
 549         gpio_request(GPIO_FN_KEYOUT5_IN5, NULL);
 550         gpio_request(GPIO_FN_KEYOUT4_IN6, NULL);
 551         gpio_request(GPIO_FN_KEYIN4,      NULL);
 552         gpio_request(GPIO_FN_KEYIN3,      NULL);
 553         gpio_request(GPIO_FN_KEYIN2,      NULL);
 554         gpio_request(GPIO_FN_KEYIN1,      NULL);
 555         gpio_request(GPIO_FN_KEYIN0,      NULL);
 556         gpio_request(GPIO_FN_KEYOUT3,     NULL);
 557         gpio_request(GPIO_FN_KEYOUT2,     NULL);
 558         gpio_request(GPIO_FN_KEYOUT1,     NULL);
 559         gpio_request(GPIO_FN_KEYOUT0,     NULL);
 560
 561         /*
 562          * enable SH-Eth
 563          *
 564          * please remove J33 pin from your board !!
 565          *
 566          * ms7724 board should not use GPIO_FN_LNKSTA pin
 567          * So, This time PTX5 is set to input pin
 568          */
 569         gpio_request(GPIO_FN_RMII_RXD0,    NULL);
 570         gpio_request(GPIO_FN_RMII_RXD1,    NULL);
 571         gpio_request(GPIO_FN_RMII_TXD0,    NULL);
 572         gpio_request(GPIO_FN_RMII_TXD1,    NULL);
 573         gpio_request(GPIO_FN_RMII_REF_CLK, NULL);
 574         gpio_request(GPIO_FN_RMII_TX_EN,   NULL);
 575         gpio_request(GPIO_FN_RMII_RX_ER,   NULL);
 576         gpio_request(GPIO_FN_RMII_CRS_DV,  NULL);
 577         gpio_request(GPIO_FN_MDIO,         NULL);
 578         gpio_request(GPIO_FN_MDC,          NULL);
 579         gpio_request(GPIO_PTX5, NULL);
 580         gpio_direction_input(GPIO_PTX5);
 581         sh_eth_init();
 582
 583         if (sw & SW41_B) {
 584                 /* 720p */
 585                 lcdc_info.ch[0].lcd_cfg.xres         = 1280;
 586                 lcdc_info.ch[0].lcd_cfg.yres         = 720;
 587                 lcdc_info.ch[0].lcd_cfg.left_margin  = 220;
 588                 lcdc_info.ch[0].lcd_cfg.right_margin = 110;
 589                 lcdc_info.ch[0].lcd_cfg.hsync_len    = 40;
 590                 lcdc_info.ch[0].lcd_cfg.upper_margin = 20;
 591                 lcdc_info.ch[0].lcd_cfg.lower_margin = 5;
 592                 lcdc_info.ch[0].lcd_cfg.vsync_len    = 5;
 593         } else {
 594                 /* VGA */
 595                 lcdc_info.ch[0].lcd_cfg.xres         = 640;
 596                 lcdc_info.ch[0].lcd_cfg.yres         = 480;
 597                 lcdc_info.ch[0].lcd_cfg.left_margin  = 105;
 598                 lcdc_info.ch[0].lcd_cfg.right_margin = 50;
 599                 lcdc_info.ch[0].lcd_cfg.hsync_len    = 96;
 600                 lcdc_info.ch[0].lcd_cfg.upper_margin = 33;
 601                 lcdc_info.ch[0].lcd_cfg.lower_margin = 10;
 602                 lcdc_info.ch[0].lcd_cfg.vsync_len    = 2;
 603         }
 604
 605         if (sw & SW41_A) {
 606                 /* Digital monitor */
 607                 lcdc_info.ch[0].interface_type = RGB18;
 608                 lcdc_info.ch[0].flags          = 0;
 609         } else {
 610                 /* Analog monitor */
 611                 lcdc_info.ch[0].interface_type = RGB24;
 612                 lcdc_info.ch[0].flags          = LCDC_FLAGS_DWPOL;
 613         }
 614
 615         return platform_add_devices(ms7724se_devices,
 616                                     ARRAY_SIZE(ms7724se_devices));
 617 }
 618 device_initcall(devices_setup);
 619
 620 static struct sh_machine_vector mv_ms7724se __initmv = {
 621         .mv_name        = "ms7724se",
 622         .mv_init_irq    = init_se7724_IRQ,
 623         .mv_nr_irqs     = SE7724_FPGA_IRQ_BASE + SE7724_FPGA_IRQ_NR,
 624 };