Quelle  platform.c   Sprache: C

/*
 * Platform device support for Au1x00 SoCs.
 *
 * Copyright 2004, Matt Porter <mporter@kernel.crashing.org>
 *
 * (C) Copyright Embedded Alley Solutions, Inc 2005
 * Author: Pantelis Antoniou <pantelis@embeddedalley.com>
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2.  This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */

#include <linux/clk.h>
#include <linux/dma-mapping.h>
#include <linux/etherdevice.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/serial_8250.h>
#include <linux/slab.h>
#include <linux/usb/ehci_pdriver.h>
#include <linux/usb/ohci_pdriver.h>

#include <asm/mach-au1x00/au1000.h>
#include <asm/mach-au1x00/au1xxx_dbdma.h>
#include <asm/mach-au1x00/au1100_mmc.h>
#include <asm/mach-au1x00/au1xxx_eth.h>

#include <prom.h>

static void alchemy_8250_pm(struct uart_port *port, unsigned int state,
       unsigned int old_state)
{
#ifdef CONFIG_SERIAL_8250
 switch (state) {
 case 0:
  alchemy_uart_enable(CPHYSADDR(port->membase));
  serial8250_do_pm(port, state, old_state);
  break;
 case 3:  /* power off */
  serial8250_do_pm(port, state, old_state);
  alchemy_uart_disable(CPHYSADDR(port->membase));
  break;
 default:
  serial8250_do_pm(port, state, old_state);
  break;
 }
#endif
}

#define PORT(_base, _irq)     \
 {       \
  .mapbase = _base,   \
  .mapsize = 0x1000,   \
  .irq  = _irq,    \
  .regshift = 2,    \
  .flags  = UPF_SKIP_TEST | UPF_IOREMAP | \
      UPF_FIXED_TYPE,  \
  .type  = PORT_16550A,   \
  .pm  = alchemy_8250_pm,  \
 }

static struct plat_serial8250_port au1x00_uart_data[][4] __initdata = {
 [ALCHEMY_CPU_AU1000] = {
  PORT(AU1000_UART0_PHYS_ADDR, AU1000_UART0_INT),
  PORT(AU1000_UART1_PHYS_ADDR, AU1000_UART1_INT),
  PORT(AU1000_UART2_PHYS_ADDR, AU1000_UART2_INT),
  PORT(AU1000_UART3_PHYS_ADDR, AU1000_UART3_INT),
 },
 [ALCHEMY_CPU_AU1500] = {
  PORT(AU1000_UART0_PHYS_ADDR, AU1500_UART0_INT),
  PORT(AU1000_UART3_PHYS_ADDR, AU1500_UART3_INT),
 },
 [ALCHEMY_CPU_AU1100] = {
  PORT(AU1000_UART0_PHYS_ADDR, AU1100_UART0_INT),
  PORT(AU1000_UART1_PHYS_ADDR, AU1100_UART1_INT),
  PORT(AU1000_UART3_PHYS_ADDR, AU1100_UART3_INT),
 },
 [ALCHEMY_CPU_AU1550] = {
  PORT(AU1000_UART0_PHYS_ADDR, AU1550_UART0_INT),
  PORT(AU1000_UART1_PHYS_ADDR, AU1550_UART1_INT),
  PORT(AU1000_UART3_PHYS_ADDR, AU1550_UART3_INT),
 },
 [ALCHEMY_CPU_AU1200] = {
  PORT(AU1000_UART0_PHYS_ADDR, AU1200_UART0_INT),
  PORT(AU1000_UART1_PHYS_ADDR, AU1200_UART1_INT),
 },
 [ALCHEMY_CPU_AU1300] = {
  PORT(AU1300_UART0_PHYS_ADDR, AU1300_UART0_INT),
  PORT(AU1300_UART1_PHYS_ADDR, AU1300_UART1_INT),
  PORT(AU1300_UART2_PHYS_ADDR, AU1300_UART2_INT),
  PORT(AU1300_UART3_PHYS_ADDR, AU1300_UART3_INT),
 },
};

static struct platform_device au1xx0_uart_device = {
 .name   = "serial8250",
 .id   = PLAT8250_DEV_AU1X00,
};

static void __init alchemy_setup_uarts(int ctype)
{
 long uartclk;
 int s = sizeof(struct plat_serial8250_port);
 int c = alchemy_get_uarts(ctype);
 struct plat_serial8250_port *ports;
 struct clk *clk = clk_get(NULL, ALCHEMY_PERIPH_CLK);

 if (IS_ERR(clk))
  return;
 if (clk_prepare_enable(clk)) {
  clk_put(clk);
  return;
 }
 uartclk = clk_get_rate(clk);
 clk_put(clk);

 ports = kcalloc(s, (c + 1), GFP_KERNEL);
 if (!ports) {
  printk(KERN_INFO "Alchemy: no memory for UART data\n");
  return;
 }
 memcpy(ports, au1x00_uart_data[ctype], s * c);
 au1xx0_uart_device.dev.platform_data = ports;

 /* Fill up uartclk. */
 for (s = 0; s < c; s++) {
  ports[s].uartclk = uartclk;
  if (au_platform_setup(&ports[s]) < 0) {
   kfree(ports);
   printk(KERN_INFO "Alchemy: missing support for UARTs\n");
   return;
  }
 }
 if (platform_device_register(&au1xx0_uart_device))
  printk(KERN_INFO "Alchemy: failed to register UARTs\n");
}


static u64 alchemy_all_dmamask = DMA_BIT_MASK(32);

/* Power on callback for the ehci platform driver */
static int alchemy_ehci_power_on(struct platform_device *pdev)
{
 return alchemy_usb_control(ALCHEMY_USB_EHCI0, 1);
}

/* Power off/suspend callback for the ehci platform driver */
static void alchemy_ehci_power_off(struct platform_device *pdev)
{
 alchemy_usb_control(ALCHEMY_USB_EHCI0, 0);
}

static struct usb_ehci_pdata alchemy_ehci_pdata = {
 .no_io_watchdog = 1,
 .power_on = alchemy_ehci_power_on,
 .power_off = alchemy_ehci_power_off,
 .power_suspend = alchemy_ehci_power_off,
};

/* Power on callback for the ohci platform driver */
static int alchemy_ohci_power_on(struct platform_device *pdev)
{
 int unit;

 unit = (pdev->id == 1) ?
  ALCHEMY_USB_OHCI1 : ALCHEMY_USB_OHCI0;

 return alchemy_usb_control(unit, 1);
}

/* Power off/suspend callback for the ohci platform driver */
static void alchemy_ohci_power_off(struct platform_device *pdev)
{
 int unit;

 unit = (pdev->id == 1) ?
  ALCHEMY_USB_OHCI1 : ALCHEMY_USB_OHCI0;

 alchemy_usb_control(unit, 0);
}

static struct usb_ohci_pdata alchemy_ohci_pdata = {
 .power_on  = alchemy_ohci_power_on,
 .power_off  = alchemy_ohci_power_off,
 .power_suspend  = alchemy_ohci_power_off,
};

static unsigned long alchemy_ohci_data[][2] __initdata = {
 [ALCHEMY_CPU_AU1000] = { AU1000_USB_OHCI_PHYS_ADDR, AU1000_USB_HOST_INT },
 [ALCHEMY_CPU_AU1500] = { AU1000_USB_OHCI_PHYS_ADDR, AU1500_USB_HOST_INT },
 [ALCHEMY_CPU_AU1100] = { AU1000_USB_OHCI_PHYS_ADDR, AU1100_USB_HOST_INT },
 [ALCHEMY_CPU_AU1550] = { AU1550_USB_OHCI_PHYS_ADDR, AU1550_USB_HOST_INT },
 [ALCHEMY_CPU_AU1200] = { AU1200_USB_OHCI_PHYS_ADDR, AU1200_USB_INT },
 [ALCHEMY_CPU_AU1300] = { AU1300_USB_OHCI0_PHYS_ADDR, AU1300_USB_INT },
};

static unsigned long alchemy_ehci_data[][2] __initdata = {
 [ALCHEMY_CPU_AU1200] = { AU1200_USB_EHCI_PHYS_ADDR, AU1200_USB_INT },
 [ALCHEMY_CPU_AU1300] = { AU1300_USB_EHCI_PHYS_ADDR, AU1300_USB_INT },
};

static int __init _new_usbres(struct resource **r, struct platform_device **d)
{
 *r = kcalloc(2, sizeof(struct resource), GFP_KERNEL);
 if (!*r)
  return -ENOMEM;
 *d = kzalloc(sizeof(struct platform_device), GFP_KERNEL);
 if (!*d) {
  kfree(*r);
  return -ENOMEM;
 }

 (*d)->dev.coherent_dma_mask = DMA_BIT_MASK(32);
 (*d)->num_resources = 2;
 (*d)->resource = *r;

 return 0;
}

static void __init alchemy_setup_usb(int ctype)
{
 struct resource *res;
 struct platform_device *pdev;

 /* setup OHCI0.  Every variant has one */
 if (_new_usbres(&res, &pdev))
  return;

 res[0].start = alchemy_ohci_data[ctype][0];
 res[0].end = res[0].start + 0x100 - 1;
 res[0].flags = IORESOURCE_MEM;
 res[1].start = alchemy_ohci_data[ctype][1];
 res[1].end = res[1].start;
 res[1].flags = IORESOURCE_IRQ;
 pdev->name = "ohci-platform";
 pdev->id = 0;
 pdev->dev.dma_mask = &alchemy_all_dmamask;
 pdev->dev.platform_data = &alchemy_ohci_pdata;

 if (platform_device_register(pdev))
  printk(KERN_INFO "Alchemy USB: cannot add OHCI0\n");


 /* setup EHCI0: Au1200/Au1300 */
 if ((ctype == ALCHEMY_CPU_AU1200) || (ctype == ALCHEMY_CPU_AU1300)) {
  if (_new_usbres(&res, &pdev))
   return;

  res[0].start = alchemy_ehci_data[ctype][0];
  res[0].end = res[0].start + 0x100 - 1;
  res[0].flags = IORESOURCE_MEM;
  res[1].start = alchemy_ehci_data[ctype][1];
  res[1].end = res[1].start;
  res[1].flags = IORESOURCE_IRQ;
  pdev->name = "ehci-platform";
  pdev->id = 0;
  pdev->dev.dma_mask = &alchemy_all_dmamask;
  pdev->dev.platform_data = &alchemy_ehci_pdata;

  if (platform_device_register(pdev))
   printk(KERN_INFO "Alchemy USB: cannot add EHCI0\n");
 }

 /* Au1300: OHCI1 */
 if (ctype == ALCHEMY_CPU_AU1300) {
  if (_new_usbres(&res, &pdev))
   return;

  res[0].start = AU1300_USB_OHCI1_PHYS_ADDR;
  res[0].end = res[0].start + 0x100 - 1;
  res[0].flags = IORESOURCE_MEM;
  res[1].start = AU1300_USB_INT;
  res[1].end = res[1].start;
  res[1].flags = IORESOURCE_IRQ;
  pdev->name = "ohci-platform";
  pdev->id = 1;
  pdev->dev.dma_mask = &alchemy_all_dmamask;
  pdev->dev.platform_data = &alchemy_ohci_pdata;

  if (platform_device_register(pdev))
   printk(KERN_INFO "Alchemy USB: cannot add OHCI1\n");
 }
}

/* Macro to help defining the Ethernet MAC resources */
#define MAC_RES_COUNT 4 /* MAC regs, MAC en, MAC INT, MACDMA regs */
#define MAC_RES(_base, _enable, _irq, _macdma)  \
 {      \
  .start = _base,   \
  .end = _base + 0xffff,  \
  .flags = IORESOURCE_MEM,  \
 },      \
 {      \
  .start = _enable,   \
  .end = _enable + 0x3,  \
  .flags = IORESOURCE_MEM,  \
 },      \
 {      \
  .start = _irq,    \
  .end = _irq,    \
  .flags = IORESOURCE_IRQ  \
 },      \
 {      \
  .start = _macdma,   \
  .end = _macdma + 0x1ff,  \
  .flags = IORESOURCE_MEM,  \
 }

static struct resource au1xxx_eth0_resources[][MAC_RES_COUNT] __initdata = {
 [ALCHEMY_CPU_AU1000] = {
  MAC_RES(AU1000_MAC0_PHYS_ADDR,
   AU1000_MACEN_PHYS_ADDR,
   AU1000_MAC0_DMA_INT,
   AU1000_MACDMA0_PHYS_ADDR)
 },
 [ALCHEMY_CPU_AU1500] = {
  MAC_RES(AU1500_MAC0_PHYS_ADDR,
   AU1500_MACEN_PHYS_ADDR,
   AU1500_MAC0_DMA_INT,
   AU1000_MACDMA0_PHYS_ADDR)
 },
 [ALCHEMY_CPU_AU1100] = {
  MAC_RES(AU1000_MAC0_PHYS_ADDR,
   AU1000_MACEN_PHYS_ADDR,
   AU1100_MAC0_DMA_INT,
   AU1000_MACDMA0_PHYS_ADDR)
 },
 [ALCHEMY_CPU_AU1550] = {
  MAC_RES(AU1000_MAC0_PHYS_ADDR,
   AU1000_MACEN_PHYS_ADDR,
   AU1550_MAC0_DMA_INT,
   AU1000_MACDMA0_PHYS_ADDR)
 },
};

static struct au1000_eth_platform_data au1xxx_eth0_platform_data = {
 .phy1_search_mac0 = 1,
};

static struct platform_device au1xxx_eth0_device = {
 .name  = "au1000-eth",
 .id  = 0,
 .num_resources = MAC_RES_COUNT,
 .dev = {
  .dma_mask               = &alchemy_all_dmamask,
  .coherent_dma_mask      = DMA_BIT_MASK(32),
  .platform_data          = &au1xxx_eth0_platform_data,
 },
};

static struct resource au1xxx_eth1_resources[][MAC_RES_COUNT] __initdata = {
 [ALCHEMY_CPU_AU1000] = {
  MAC_RES(AU1000_MAC1_PHYS_ADDR,
   AU1000_MACEN_PHYS_ADDR + 4,
   AU1000_MAC1_DMA_INT,
   AU1000_MACDMA1_PHYS_ADDR)
 },
 [ALCHEMY_CPU_AU1500] = {
  MAC_RES(AU1500_MAC1_PHYS_ADDR,
   AU1500_MACEN_PHYS_ADDR + 4,
   AU1500_MAC1_DMA_INT,
   AU1000_MACDMA1_PHYS_ADDR)
 },
 [ALCHEMY_CPU_AU1550] = {
  MAC_RES(AU1000_MAC1_PHYS_ADDR,
   AU1000_MACEN_PHYS_ADDR + 4,
   AU1550_MAC1_DMA_INT,
   AU1000_MACDMA1_PHYS_ADDR)
 },
};

static struct au1000_eth_platform_data au1xxx_eth1_platform_data = {
 .phy1_search_mac0 = 1,
};

static struct platform_device au1xxx_eth1_device = {
 .name  = "au1000-eth",
 .id  = 1,
 .num_resources = MAC_RES_COUNT,
 .dev = {
  .dma_mask               = &alchemy_all_dmamask,
  .coherent_dma_mask      = DMA_BIT_MASK(32),
  .platform_data          = &au1xxx_eth1_platform_data,
 },
};

void __init au1xxx_override_eth_cfg(unsigned int port,
   struct au1000_eth_platform_data *eth_data)
{
 if (!eth_data || port > 1)
  return;

 if (port == 0)
  memcpy(&au1xxx_eth0_platform_data, eth_data,
   sizeof(struct au1000_eth_platform_data));
 else
  memcpy(&au1xxx_eth1_platform_data, eth_data,
   sizeof(struct au1000_eth_platform_data));
}

static void __init alchemy_setup_macs(int ctype)
{
 int ret, i;
 unsigned char ethaddr[6];
 struct resource *macres;

 /* Handle 1st MAC */
 if (alchemy_get_macs(ctype) < 1)
  return;

 macres = kmemdup_array(au1xxx_eth0_resources[ctype], MAC_RES_COUNT,
          sizeof(*macres), GFP_KERNEL);
 if (!macres) {
  printk(KERN_INFO "Alchemy: no memory for MAC0 resources\n");
  return;
 }
 au1xxx_eth0_device.resource = macres;

 i = prom_get_ethernet_addr(ethaddr);
 if (!i && !is_valid_ether_addr(au1xxx_eth0_platform_data.mac))
  memcpy(au1xxx_eth0_platform_data.mac, ethaddr, 6);

 ret = platform_device_register(&au1xxx_eth0_device);
 if (ret)
  printk(KERN_INFO "Alchemy: failed to register MAC0\n");


 /* Handle 2nd MAC */
 if (alchemy_get_macs(ctype) < 2)
  return;

 macres = kmemdup_array(au1xxx_eth1_resources[ctype], MAC_RES_COUNT,
          sizeof(*macres), GFP_KERNEL);
 if (!macres) {
  printk(KERN_INFO "Alchemy: no memory for MAC1 resources\n");
  return;
 }
 au1xxx_eth1_device.resource = macres;

 ethaddr[5] += 1; /* next addr for 2nd MAC */
 if (!i && !is_valid_ether_addr(au1xxx_eth1_platform_data.mac))
  memcpy(au1xxx_eth1_platform_data.mac, ethaddr, 6);

 /* Register second MAC if enabled in pinfunc */
 if (!(alchemy_rdsys(AU1000_SYS_PINFUNC) & SYS_PF_NI2)) {
  ret = platform_device_register(&au1xxx_eth1_device);
  if (ret)
   printk(KERN_INFO "Alchemy: failed to register MAC1\n");
 }
}

static int __init au1xxx_platform_init(void)
{
 int ctype = alchemy_get_cputype();

 alchemy_setup_uarts(ctype);
 alchemy_setup_macs(ctype);
 alchemy_setup_usb(ctype);

 return 0;
}

arch_initcall(au1xxx_platform_init);