Quelle  platform.c   Sprache: C

/*
 *  Copyright (C) 2007-2009 Geert Uytterhoeven
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file COPYING in the main directory of this archive
 * for more details.
 */

#include <linux/err.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/zorro.h>

#include <asm/amigahw.h>
#include <asm/amigayle.h>
#include <asm/byteorder.h>


#ifdef CONFIG_ZORRO

static const struct resource zorro_resources[] __initconst = {
 /* Zorro II regions (on Zorro II/III) */
 {
  .name = "Zorro II exp",
  .start = 0x00e80000,
  .end = 0x00efffff,
  .flags = IORESOURCE_MEM,
 }, {
  .name = "Zorro II mem",
  .start = 0x00200000,
  .end = 0x009fffff,
  .flags = IORESOURCE_MEM,
 },
 /* Zorro III regions (on Zorro III only) */
 {
  .name = "Zorro III exp",
  .start = 0xff000000,
  .end = 0xffffffff,
  .flags = IORESOURCE_MEM,
 }, {
  .name = "Zorro III cfg",
  .start = 0x40000000,
  .end = 0x7fffffff,
  .flags = IORESOURCE_MEM,
 }
};


static int __init amiga_init_bus(void)
{
 struct platform_device *pdev;
 unsigned int n;

 if (!MACH_IS_AMIGA || !AMIGAHW_PRESENT(ZORRO))
  return -ENODEV;

 n = AMIGAHW_PRESENT(ZORRO3) ? 4 : 2;
 pdev = platform_device_register_simple("amiga-zorro", -1,
            zorro_resources, n);
 return PTR_ERR_OR_ZERO(pdev);
}

subsys_initcall(amiga_init_bus);


static int __init z_dev_present(zorro_id id)
{
 unsigned int i;

 for (i = 0; i < zorro_num_autocon; i++) {
  const struct ExpansionRom *rom = &zorro_autocon_init[i].rom;
  if (be16_to_cpu(rom->er_Manufacturer) == ZORRO_MANUF(id) &&
      rom->er_Product == ZORRO_PROD(id))
   return 1;
 }

 return 0;
}

#else /* !CONFIG_ZORRO */

static inline int z_dev_present(zorro_id id) { return 0; }

#endif /* !CONFIG_ZORRO */


static const struct resource a3000_scsi_resource __initconst = {
 .start = 0xdd0000,
 .end = 0xdd00ff,
 .flags = IORESOURCE_MEM,
};


static const struct resource a4000t_scsi_resource __initconst = {
 .start = 0xdd0000,
 .end = 0xdd0fff,
 .flags = IORESOURCE_MEM,
};


static const struct resource a1200_ide_resource __initconst = {
 .start = 0xda0000,
 .end = 0xda1fff,
 .flags = IORESOURCE_MEM,
};

static const struct gayle_ide_platform_data a1200_ide_pdata __initconst = {
 .base  = 0xda0000,
 .irqport = 0xda9000,
 .explicit_ack = 1,
};


static const struct resource a4000_ide_resource __initconst = {
 .start = 0xdd2000,
 .end = 0xdd3fff,
 .flags = IORESOURCE_MEM,
};

static const struct gayle_ide_platform_data a4000_ide_pdata __initconst = {
 .base  = 0xdd2020,
 .irqport = 0xdd3020,
 .explicit_ack = 0,
};


static const struct resource amiga_rtc_resource __initconst = {
 .start = 0x00dc0000,
 .end = 0x00dcffff,
 .flags = IORESOURCE_MEM,
};


static int __init amiga_init_devices(void)
{
 struct platform_device *pdev;
 int error;

 if (!MACH_IS_AMIGA)
  return -ENODEV;

 /* video hardware */
 if (AMIGAHW_PRESENT(AMI_VIDEO)) {
  pdev = platform_device_register_simple("amiga-video", -1, NULL,
             0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }


 /* sound hardware */
 if (AMIGAHW_PRESENT(AMI_AUDIO)) {
  pdev = platform_device_register_simple("amiga-audio", -1, NULL,
             0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }


 /* storage interfaces */
 if (AMIGAHW_PRESENT(AMI_FLOPPY)) {
  pdev = platform_device_register_simple("amiga-floppy", -1,
             NULL, 0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(A3000_SCSI)) {
  pdev = platform_device_register_simple("amiga-a3000-scsi", -1,
             &a3000_scsi_resource, 1);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(A4000_SCSI)) {
  pdev = platform_device_register_simple("amiga-a4000t-scsi", -1,
             &a4000t_scsi_resource,
             1);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(A1200_IDE) ||
     z_dev_present(ZORRO_PROD_MTEC_VIPER_MK_V_E_MATRIX_530_SCSI_IDE)) {
  pdev = platform_device_register_simple("amiga-gayle-ide", -1,
             &a1200_ide_resource, 1);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
  error = platform_device_add_data(pdev, &a1200_ide_pdata,
       sizeof(a1200_ide_pdata));
  if (error)
   return error;
 }

 if (AMIGAHW_PRESENT(A4000_IDE)) {
  pdev = platform_device_register_simple("amiga-gayle-ide", -1,
             &a4000_ide_resource, 1);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
  error = platform_device_add_data(pdev, &a4000_ide_pdata,
       sizeof(a4000_ide_pdata));
  if (error)
   return error;
 }


 /* other I/O hardware */
 if (AMIGAHW_PRESENT(AMI_KEYBOARD)) {
  pdev = platform_device_register_simple("amiga-keyboard", -1,
             NULL, 0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(AMI_MOUSE)) {
  pdev = platform_device_register_simple("amiga-mouse", -1, NULL,
             0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(AMI_SERIAL)) {
  pdev = platform_device_register_simple("amiga-serial", -1,
             NULL, 0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(AMI_PARALLEL)) {
  pdev = platform_device_register_simple("amiga-parallel", -1,
             NULL, 0);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }


 /* real time clocks */
 if (AMIGAHW_PRESENT(A2000_CLK)) {
  pdev = platform_device_register_simple("rtc-msm6242", -1,
             &amiga_rtc_resource, 1);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 if (AMIGAHW_PRESENT(A3000_CLK)) {
  pdev = platform_device_register_simple("rtc-rp5c01", -1,
             &amiga_rtc_resource, 1);
  if (IS_ERR(pdev))
   return PTR_ERR(pdev);
 }

 return 0;
}

arch_initcall(amiga_init_devices);