release/src-rt-6.x/linux/linux-2.6/arch/sh/boards/hp6xx/setup.c

   1 /*
   2  * linux/arch/sh/boards/hp6xx/setup.c
   3  *
   4  * Copyright (C) 2002 Andriy Skulysh
   5  * Copyright (C) 2007 Kristoffer Ericson <Kristoffer_e1@hotmail.com>
   6  *
   7  * May be copied or modified under the terms of the GNU General Public
   8  * License.  See linux/COPYING for more information.
   9  *
  10  * Setup code for an HP680  (internal peripherials only)
  11  */
  12 #include <linux/types.h>
  13 #include <linux/init.h>
  14 #include <linux/platform_device.h>
  15 #include <asm/hd64461.h>
  16 #include <asm/io.h>
  17 #include <asm/irq.h>
  18 #include <asm/hp6xx.h>
  19 #include <asm/cpu/dac.h>
  20
  21 #define SCPCR   0xa4000116
  22 #define SCPDR   0xa4000136
  23
  24 /* CF Slot */
  25 static struct resource cf_ide_resources[] = {
  26         [0] = {
  27                 .start = 0x15000000 + 0x1f0,
  28                 .end   = 0x15000000 + 0x1f0 + 0x08 - 0x01,
  29                 .flags = IORESOURCE_MEM,
  30         },
  31         [1] = {
  32                 .start = 0x15000000 + 0x1fe,
  33                 .end   = 0x15000000 + 0x1fe + 0x01,
  34                 .flags = IORESOURCE_MEM,
  35         },
  36         [2] = {
  37                 .start = 93,
  38                 .flags = IORESOURCE_IRQ,
  39         },
  40 };
  41
  42 static struct platform_device cf_ide_device = {
  43         .name           =  "pata_platform",
  44         .id             =  -1,
  45         .num_resources  = ARRAY_SIZE(cf_ide_resources),
  46         .resource       = cf_ide_resources,
  47 };
  48
  49 static struct platform_device *hp6xx_devices[] __initdata = {
  50        &cf_ide_device,
  51 };
  52
  53 static int __init hp6xx_devices_setup(void)
  54 {
  55         return platform_add_devices(hp6xx_devices, ARRAY_SIZE(hp6xx_devices));
  56 }
  57
  58 static void __init hp6xx_setup(char **cmdline_p)
  59 {
  60         u8 v8;
  61         u16 v;
  62
  63         v = inw(HD64461_STBCR);
  64         v |= HD64461_STBCR_SURTST | HD64461_STBCR_SIRST |
  65             HD64461_STBCR_STM1ST | HD64461_STBCR_STM0ST |
  66             HD64461_STBCR_SAFEST | HD64461_STBCR_SPC0ST |
  67             HD64461_STBCR_SMIAST | HD64461_STBCR_SAFECKE_OST |
  68             HD64461_STBCR_SAFECKE_IST;
  69 #ifndef CONFIG_HD64461_ENABLER
  70         v |= HD64461_STBCR_SPC1ST;
  71 #endif
  72         outw(v, HD64461_STBCR);
  73         v = inw(HD64461_GPADR);
  74         v |= HD64461_GPADR_SPEAKER | HD64461_GPADR_PCMCIA0;
  75         outw(v, HD64461_GPADR);
  76
  77         outw(HD64461_PCCGCR_VCC0 | HD64461_PCCSCR_VCC1, HD64461_PCC0GCR);
  78
  79 #ifndef CONFIG_HD64461_ENABLER
  80         outw(HD64461_PCCGCR_VCC0 | HD64461_PCCSCR_VCC1, HD64461_PCC1GCR);
  81 #endif
  82
  83         sh_dac_output(0, DAC_SPEAKER_VOLUME);
  84         sh_dac_disable(DAC_SPEAKER_VOLUME);
  85         v8 = ctrl_inb(DACR);
  86         v8 &= ~DACR_DAE;
  87         ctrl_outb(v8,DACR);
  88
  89         v8 = ctrl_inb(SCPDR);
  90         v8 |= SCPDR_TS_SCAN_X | SCPDR_TS_SCAN_Y;
  91         v8 &= ~SCPDR_TS_SCAN_ENABLE;
  92         ctrl_outb(v8, SCPDR);
  93
  94         v = ctrl_inw(SCPCR);
  95         v &= ~SCPCR_TS_MASK;
  96         v |= SCPCR_TS_ENABLE;
  97         ctrl_outw(v, SCPCR);
  98 }
  99 device_initcall(hp6xx_devices_setup);
 100
 101 struct sh_machine_vector mv_hp6xx __initmv = {
 102         .mv_name = "hp6xx",
 103         .mv_setup = hp6xx_setup,
 104         .mv_nr_irqs = HD64461_IRQBASE + HD64461_IRQ_NUM,
 105         .mv_irq_demux = hd64461_irq_demux,
 106 };
 107 ALIAS_MV(hp6xx)