m68knommu: Add support for the Coldfire 5251/5253
authorSteven King <sfking@fdwdc.com>
Tue, 5 Jun 2012 15:23:08 +0000 (08:23 -0700)
committerGreg Ungerer <gerg@uclinux.org>
Sun, 15 Jul 2012 23:59:21 +0000 (09:59 +1000)
Basic support for the Coldfire 5251/5253.

Signed-off-by: Steven king <sfking@fdwdc.com>
Signed-off-by: Greg Ungerer <gerg@uclinux.org>
arch/m68k/Kconfig.cpu
arch/m68k/Makefile
arch/m68k/include/asm/dma.h
arch/m68k/include/asm/m525xsim.h [new file with mode: 0644]
arch/m68k/include/asm/mcfgpio.h
arch/m68k/include/asm/mcfsim.h
arch/m68k/include/asm/mcfuart.h
arch/m68k/platform/coldfire/Makefile
arch/m68k/platform/coldfire/head.S
arch/m68k/platform/coldfire/intc-525x.c [new file with mode: 0644]
arch/m68k/platform/coldfire/m525x.c [new file with mode: 0644]

index ff2314d5d934f375478da7c3bb37f0df28b0c653..8d9afb09f569e3f0d88cd110f64f84d75c553914 100644 (file)
@@ -167,6 +167,14 @@ config M5249
        help
          Motorola ColdFire 5249 processor support.
 
+config M525x
+       bool "MCF525x"
+       depends on !MMU
+       select COLDFIRE_SW_A7
+       select HAVE_MBAR
+       help
+         Freescale (Motorola) Coldfire 5251/5253 processor support.
+
 config M527x
        bool
 
index b7f2e2d5cd2e5d05ffd80c59c1e5bb5cb0777ae4..8daf9697e5e22b1c723f6cdc719e11615c188114 100644 (file)
@@ -50,6 +50,7 @@ cpuflags-$(CONFIG_M5275)      := $(call cc-option,-mcpu=5275,-m5307)
 cpuflags-$(CONFIG_M5272)       := $(call cc-option,-mcpu=5272,-m5307)
 cpuflags-$(CONFIG_M5271)       := $(call cc-option,-mcpu=5271,-m5307)
 cpuflags-$(CONFIG_M523x)       := $(call cc-option,-mcpu=523x,-m5307)
+cpuflags-$(CONFIG_M525x)       := $(call cc-option,-mcpu=5253,-m5200)
 cpuflags-$(CONFIG_M5249)       := $(call cc-option,-mcpu=5249,-m5200)
 cpuflags-$(CONFIG_M520x)       := $(call cc-option,-mcpu=5208,-m5200)
 cpuflags-$(CONFIG_M5206e)      := $(call cc-option,-mcpu=5206e,-m5200)
index 6fbdfe8951042e6498d37df345d24ce7fb64cf5b..94706418463933c534952d9b574b3f7c825964d0 100644 (file)
@@ -33,7 +33,9 @@
  * Set number of channels of DMA on ColdFire for different implementations.
  */
 #if defined(CONFIG_M5249) || defined(CONFIG_M5307) || defined(CONFIG_M5407) || \
-       defined(CONFIG_M523x) || defined(CONFIG_M527x) || defined(CONFIG_M528x)
+       defined(CONFIG_M523x) || defined(CONFIG_M527x) || \
+       defined(CONFIG_M528x) || defined(CONFIG_M525x)
+
 #define MAX_M68K_DMA_CHANNELS 4
 #elif defined(CONFIG_M5272)
 #define MAX_M68K_DMA_CHANNELS 1
diff --git a/arch/m68k/include/asm/m525xsim.h b/arch/m68k/include/asm/m525xsim.h
new file mode 100644 (file)
index 0000000..6da24f6
--- /dev/null
@@ -0,0 +1,194 @@
+/****************************************************************************/
+
+/*
+ *     m525xsim.h -- ColdFire 525x System Integration Module support.
+ *
+ *     (C) Copyright 2012, Steven king <sfking@fdwdc.com>
+ *     (C) Copyright 2002, Greg Ungerer (gerg@snapgear.com)
+ */
+
+/****************************************************************************/
+#ifndef        m525xsim_h
+#define m525xsim_h
+/****************************************************************************/
+
+#define CPU_NAME               "COLDFIRE(m525x)"
+#define CPU_INSTR_PER_JIFFY    3
+#define MCF_BUSCLK             (MCF_CLK / 2)
+
+#include <asm/m52xxacr.h>
+
+/*
+ *     The 525x has a second MBAR region, define its address.
+ */
+#define MCF_MBAR2              0x80000000
+
+/*
+ *     Define the 525x SIM register set addresses.
+ */
+#define MCFSIM_RSR             0x00            /* Reset Status reg (r/w) */
+#define MCFSIM_SYPCR           0x01            /* System Protection reg (r/w)*/
+#define MCFSIM_SWIVR           0x02            /* SW Watchdog intr reg (r/w) */
+#define MCFSIM_SWSR            0x03            /* SW Watchdog service (r/w) */
+#define MCFSIM_MPARK           0x0C            /* BUS Master Control Reg*/
+#define MCFSIM_IPR             0x40            /* Interrupt Pend reg (r/w) */
+#define MCFSIM_IMR             0x44            /* Interrupt Mask reg (r/w) */
+#define MCFSIM_ICR0            0x4c            /* Intr Ctrl reg 0 (r/w) */
+#define MCFSIM_ICR1            0x4d            /* Intr Ctrl reg 1 (r/w) */
+#define MCFSIM_ICR2            0x4e            /* Intr Ctrl reg 2 (r/w) */
+#define MCFSIM_ICR3            0x4f            /* Intr Ctrl reg 3 (r/w) */
+#define MCFSIM_ICR4            0x50            /* Intr Ctrl reg 4 (r/w) */
+#define MCFSIM_ICR5            0x51            /* Intr Ctrl reg 5 (r/w) */
+#define MCFSIM_ICR6            0x52            /* Intr Ctrl reg 6 (r/w) */
+#define MCFSIM_ICR7            0x53            /* Intr Ctrl reg 7 (r/w) */
+#define MCFSIM_ICR8            0x54            /* Intr Ctrl reg 8 (r/w) */
+#define MCFSIM_ICR9            0x55            /* Intr Ctrl reg 9 (r/w) */
+#define MCFSIM_ICR10           0x56            /* Intr Ctrl reg 10 (r/w) */
+#define MCFSIM_ICR11           0x57            /* Intr Ctrl reg 11 (r/w) */
+
+#define MCFSIM_CSAR0           0x80            /* CS 0 Address 0 reg (r/w) */
+#define MCFSIM_CSMR0           0x84            /* CS 0 Mask 0 reg (r/w) */
+#define MCFSIM_CSCR0           0x8a            /* CS 0 Control reg (r/w) */
+#define MCFSIM_CSAR1           0x8c            /* CS 1 Address reg (r/w) */
+#define MCFSIM_CSMR1           0x90            /* CS 1 Mask reg (r/w) */
+#define MCFSIM_CSCR1           0x96            /* CS 1 Control reg (r/w) */
+#define MCFSIM_CSAR2           0x98            /* CS 2 Address reg (r/w) */
+#define MCFSIM_CSMR2           0x9c            /* CS 2 Mask reg (r/w) */
+#define MCFSIM_CSCR2           0xa2            /* CS 2 Control reg (r/w) */
+#define MCFSIM_CSAR3           0xa4            /* CS 3 Address reg (r/w) */
+#define MCFSIM_CSMR3           0xa8            /* CS 3 Mask reg (r/w) */
+#define MCFSIM_CSCR3           0xae            /* CS 3 Control reg (r/w) */
+#define MCFSIM_CSAR4           0xb0            /* CS 4 Address reg (r/w) */
+#define MCFSIM_CSMR4           0xb4            /* CS 4 Mask reg (r/w) */
+#define MCFSIM_CSCR4           0xba            /* CS 4 Control reg (r/w) */
+
+#define MCFSIM_DCR             (MCF_MBAR + 0x100)      /* DRAM Control */
+#define MCFSIM_DACR0           (MCF_MBAR + 0x108)      /* DRAM 0 Addr/Ctrl */
+#define MCFSIM_DMR0            (MCF_MBAR + 0x10c)      /* DRAM 0 Mask */
+
+/*
+ * Secondary Interrupt Controller (in MBAR2)
+*/
+#define MCFINTC2_INTBASE       (MCF_MBAR2 + 0x168)     /* Base Vector Reg */
+#define MCFINTC2_INTPRI1       (MCF_MBAR2 + 0x140)     /* 0-7 priority */
+#define MCFINTC2_INTPRI2       (MCF_MBAR2 + 0x144)     /* 8-15 priority */
+#define MCFINTC2_INTPRI3       (MCF_MBAR2 + 0x148)     /* 16-23 priority */
+#define MCFINTC2_INTPRI4       (MCF_MBAR2 + 0x14c)     /* 24-31 priority */
+#define MCFINTC2_INTPRI5       (MCF_MBAR2 + 0x150)     /* 32-39 priority */
+#define MCFINTC2_INTPRI6       (MCF_MBAR2 + 0x154)     /* 40-47 priority */
+#define MCFINTC2_INTPRI7       (MCF_MBAR2 + 0x158)     /* 48-55 priority */
+#define MCFINTC2_INTPRI8       (MCF_MBAR2 + 0x15c)     /* 56-63 priority */
+
+#define MCFINTC2_INTPRI_REG(i) (MCFINTC2_INTPRI1 + \
+                               ((((i) - MCFINTC2_VECBASE) / 8) * 4))
+#define MCFINTC2_INTPRI_BITS(b, i)     ((b) << (((i) % 8) * 4))
+
+/*
+ *     Timer module.
+ */
+#define MCFTIMER_BASE1         (MCF_MBAR + 0x140)      /* Base of TIMER1 */
+#define MCFTIMER_BASE2         (MCF_MBAR + 0x180)      /* Base of TIMER2 */
+
+/*
+ *     UART module.
+ */
+#define MCFUART_BASE0          (MCF_MBAR + 0x1c0)      /* Base address UART0 */
+#define MCFUART_BASE1          (MCF_MBAR + 0x200)      /* Base address UART1 */
+
+/*
+ *     QSPI module.
+ */
+#define MCFQSPI_BASE           (MCF_MBAR + 0x300)      /* Base address QSPI */
+#define MCFQSPI_SIZE           0x40                    /* Register set size */
+
+
+#define MCFQSPI_CS0            15
+#define MCFQSPI_CS1            16
+#define MCFQSPI_CS2            24
+#define MCFQSPI_CS3            28
+
+/*
+ *     I2C module.
+ */
+#define MCFI2C_BASE0           (MCF_MBAR + 0x280)      /* Base addreess I2C0 */
+#define MCFI2C_SIZE0           0x20                    /* Register set size */
+
+#define MCFI2C_BASE1           (MCF_MBAR2 + 0x440)     /* Base addreess I2C1 */
+#define MCFI2C_SIZE1           0x20                    /* Register set size */
+/*
+ *     DMA unit base addresses.
+ */
+#define MCFDMA_BASE0           (MCF_MBAR + 0x300)      /* Base address DMA 0 */
+#define MCFDMA_BASE1           (MCF_MBAR + 0x340)      /* Base address DMA 1 */
+#define MCFDMA_BASE2           (MCF_MBAR + 0x380)      /* Base address DMA 2 */
+#define MCFDMA_BASE3           (MCF_MBAR + 0x3C0)      /* Base address DMA 3 */
+
+/*
+ *     Some symbol defines for the above...
+ */
+#define MCFSIM_SWDICR          MCFSIM_ICR0     /* Watchdog timer ICR */
+#define MCFSIM_TIMER1ICR       MCFSIM_ICR1     /* Timer 1 ICR */
+#define MCFSIM_TIMER2ICR       MCFSIM_ICR2     /* Timer 2 ICR */
+#define MCFSIM_I2CICR          MCFSIM_ICR3     /* I2C ICR */
+#define MCFSIM_UART1ICR                MCFSIM_ICR4     /* UART 1 ICR */
+#define MCFSIM_UART2ICR                MCFSIM_ICR5     /* UART 2 ICR */
+#define MCFSIM_DMA0ICR         MCFSIM_ICR6     /* DMA 0 ICR */
+#define MCFSIM_DMA1ICR         MCFSIM_ICR7     /* DMA 1 ICR */
+#define MCFSIM_DMA2ICR         MCFSIM_ICR8     /* DMA 2 ICR */
+#define MCFSIM_DMA3ICR         MCFSIM_ICR9     /* DMA 3 ICR */
+#define MCFSIM_QSPIICR         MCFSIM_ICR10    /* QSPI ICR */
+
+/*
+ *     Define system peripheral IRQ usage.
+ */
+#define MCF_IRQ_QSPI           28              /* QSPI, Level 4 */
+#define MCF_IRQ_I2C0           29
+#define MCF_IRQ_TIMER          30              /* Timer0, Level 6 */
+#define MCF_IRQ_PROFILER       31              /* Timer1, Level 7 */
+
+#define MCF_IRQ_UART0          73              /* UART0 */
+#define MCF_IRQ_UART1          74              /* UART1 */
+
+/*
+ * Define the base interrupt for the second interrupt controller.
+ * We set it to 128, out of the way of the base interrupts, and plenty
+ * of room for its 64 interrupts.
+ */
+#define MCFINTC2_VECBASE       128
+
+#define MCF_IRQ_GPIO0          (MCFINTC2_VECBASE + 32)
+#define MCF_IRQ_GPIO1          (MCFINTC2_VECBASE + 33)
+#define MCF_IRQ_GPIO2          (MCFINTC2_VECBASE + 34)
+#define MCF_IRQ_GPIO3          (MCFINTC2_VECBASE + 35)
+#define MCF_IRQ_GPIO4          (MCFINTC2_VECBASE + 36)
+#define MCF_IRQ_GPIO5          (MCFINTC2_VECBASE + 37)
+#define MCF_IRQ_GPIO6          (MCFINTC2_VECBASE + 38)
+
+#define MCF_IRQ_USBWUP         (MCFINTC2_VECBASE + 40)
+#define MCF_IRQ_I2C1           (MCFINTC2_VECBASE + 62)
+
+/*
+ *     General purpose IO registers (in MBAR2).
+ */
+#define MCFSIM2_GPIOREAD       (MCF_MBAR2 + 0x000)     /* GPIO read values */
+#define MCFSIM2_GPIOWRITE      (MCF_MBAR2 + 0x004)     /* GPIO write values */
+#define MCFSIM2_GPIOENABLE     (MCF_MBAR2 + 0x008)     /* GPIO enabled */
+#define MCFSIM2_GPIOFUNC       (MCF_MBAR2 + 0x00C)     /* GPIO function */
+#define MCFSIM2_GPIO1READ      (MCF_MBAR2 + 0x0B0)     /* GPIO1 read values */
+#define MCFSIM2_GPIO1WRITE     (MCF_MBAR2 + 0x0B4)     /* GPIO1 write values */
+#define MCFSIM2_GPIO1ENABLE    (MCF_MBAR2 + 0x0B8)     /* GPIO1 enabled */
+#define MCFSIM2_GPIO1FUNC      (MCF_MBAR2 + 0x0BC)     /* GPIO1 function */
+
+#define MCFSIM2_GPIOINTSTAT    (MCF_MBAR2 + 0xc0)      /* GPIO intr status */
+#define MCFSIM2_GPIOINTCLEAR   (MCF_MBAR2 + 0xc0)      /* GPIO intr clear */
+#define MCFSIM2_GPIOINTENABLE  (MCF_MBAR2 + 0xc4)      /* GPIO intr enable */
+
+/*
+ * Generic GPIO support
+ */
+#define MCFGPIO_PIN_MAX                64
+#define MCFGPIO_IRQ_MAX                7
+#define MCFGPIO_IRQ_VECBASE    MCF_IRQ_GPIO0
+
+/****************************************************************************/
+#endif /* m525xsim_h */
index 67ba20ffedbe45615704e54d5e7990b9c7c3c0ee..b2471a5f02eb5a924bc2768c66629f3bfbc72bf1 100644 (file)
@@ -122,7 +122,7 @@ static inline void gpio_free(unsigned gpio)
 #define mcfgpio_read(port)             __raw_readw(port)
 #define mcfgpio_write(data, port)      __raw_writew(data, port)
 
-#elif defined(CONFIG_M5249)
+#elif defined(CONFIG_M5249) || defined(CONFIG_M525x)
 
 /* These parts have GPIO organized by 32 bit ports */
 
@@ -183,7 +183,7 @@ static inline u32 __mcfgpio_ppdr(unsigned gpio)
                return MCFSIM_PBDAT;
        else
                return MCFSIM_PCDAT;
-#elif defined(CONFIG_M5249)
+#elif defined(CONFIG_M5249) || defined(CONFIG_M525x)
        if (gpio < 32)
                return MCFSIM2_GPIOREAD;
        else
@@ -222,7 +222,7 @@ static inline u32 __mcfgpio_podr(unsigned gpio)
                return MCFSIM_PBDAT;
        else
                return MCFSIM_PCDAT;
-#elif defined(CONFIG_M5249)
+#elif defined(CONFIG_M5249) || defined(CONFIG_M525x)
        if (gpio < 32)
                return MCFSIM2_GPIOWRITE;
        else
@@ -261,7 +261,7 @@ static inline u32 __mcfgpio_pddr(unsigned gpio)
                return MCFSIM_PBDDR;
        else
                return MCFSIM_PCDDR;
-#elif defined(CONFIG_M5249)
+#elif defined(CONFIG_M5249) || defined(CONFIG_M525x)
        if (gpio < 32)
                return MCFSIM2_GPIOENABLE;
        else
index ebd0304054ad7800d3ddf4355d8140d890dbe2bf..6871f62b11b1095efd0c2e89913eb3e78abfd76e 100644 (file)
@@ -27,6 +27,9 @@
 #elif defined(CONFIG_M5249)
 #include <asm/m5249sim.h>
 #include <asm/mcfintc.h>
+#elif defined(CONFIG_M525x)
+#include <asm/m525xsim.h>
+#include <asm/mcfintc.h>
 #elif defined(CONFIG_M527x)
 #include <asm/m527xsim.h>
 #elif defined(CONFIG_M5272)
index 2d3bc774b3c5020ffced173c8f1feb982e875206..b40c20f66647120c90f044e3438b2825129c7ea0 100644 (file)
@@ -43,8 +43,8 @@ struct mcf_platform_uart {
 #define        MCFUART_UFPD            0x30            /* Frac Prec. Divider (r/w) */
 #endif
 #if defined(CONFIG_M5206) || defined(CONFIG_M5206e) || \
-        defined(CONFIG_M5249) || defined(CONFIG_M5307) || \
-        defined(CONFIG_M5407)
+       defined(CONFIG_M5249) || defined(CONFIG_M525x) || \
+       defined(CONFIG_M5307) || defined(CONFIG_M5407)
 #define        MCFUART_UIVR            0x30            /* Interrupt Vector (r/w) */
 #endif
 #define        MCFUART_UIPR            0x34            /* Input Port (r) */
index 69bc0ae2538d288e8e20b0f9bd908a6c02c777a2..a7329b4fbef87482024a7ef51714d55912068962 100644 (file)
@@ -20,6 +20,7 @@ obj-$(CONFIG_M5206e)  += m5206.o timers.o intc.o reset.o
 obj-$(CONFIG_M520x)    += m520x.o pit.o intc-simr.o reset.o
 obj-$(CONFIG_M523x)    += m523x.o pit.o dma_timer.o intc-2.o reset.o
 obj-$(CONFIG_M5249)    += m5249.o timers.o intc.o intc-5249.o reset.o
+obj-$(CONFIG_M525x)    += m525x.o timers.o intc.o intc-525x.o reset.o
 obj-$(CONFIG_M527x)    += m527x.o pit.o intc-2.o reset.o
 obj-$(CONFIG_M5272)    += m5272.o intc-5272.o timers.o
 obj-$(CONFIG_M528x)    += m528x.o pit.o intc-2.o reset.o
index c3db70ed33b333817811577fa3e8bf933f14f50d..4e0c9eb3bd1f437df4d8c469f58070b3558e8f5a 100644 (file)
@@ -31,9 +31,9 @@
 .endm
 
 #elif defined(CONFIG_M5206) || defined(CONFIG_M5206e) || \
-      defined(CONFIG_M5249) || defined(CONFIG_M527x) || \
-      defined(CONFIG_M528x) || defined(CONFIG_M5307) || \
-      defined(CONFIG_M5407)
+      defined(CONFIG_M5249) || defined(CONFIG_M525x) || \
+      defined(CONFIG_M527x) || defined(CONFIG_M528x) || \
+      defined(CONFIG_M5307) || defined(CONFIG_M5407)
 /*
  *     Not all these devices have exactly the same DRAM controller,
  *     but the DCMR register is virtually identical - give or take
diff --git a/arch/m68k/platform/coldfire/intc-525x.c b/arch/m68k/platform/coldfire/intc-525x.c
new file mode 100644 (file)
index 0000000..b23204d
--- /dev/null
@@ -0,0 +1,91 @@
+/*
+ * intc2.c  -- support for the 2nd INTC controller of the 525x
+ *
+ * (C) Copyright 2012, Steven King <sfking@fdwdc.com>
+ * (C) Copyright 2009, Greg Ungerer <gerg@snapgear.com>
+ *
+ * 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/types.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/io.h>
+#include <asm/coldfire.h>
+#include <asm/mcfsim.h>
+
+static void intc2_irq_gpio_mask(struct irq_data *d)
+{
+       u32 imr = readl(MCFSIM2_GPIOINTENABLE);
+       u32 type = irqd_get_trigger_type(d);
+       int irq = d->irq - MCF_IRQ_GPIO0;
+
+       if (type & IRQ_TYPE_EDGE_RISING)
+               imr &= ~(0x001 << irq);
+       if (type & IRQ_TYPE_EDGE_FALLING)
+               imr &= ~(0x100 << irq);
+       writel(imr, MCFSIM2_GPIOINTENABLE);
+}
+
+static void intc2_irq_gpio_unmask(struct irq_data *d)
+{
+       u32 imr = readl(MCFSIM2_GPIOINTENABLE);
+       u32 type = irqd_get_trigger_type(d);
+       int irq = d->irq - MCF_IRQ_GPIO0;
+
+       if (type & IRQ_TYPE_EDGE_RISING)
+               imr |= (0x001 << irq);
+       if (type & IRQ_TYPE_EDGE_FALLING)
+               imr |= (0x100 << irq);
+       writel(imr, MCFSIM2_GPIOINTENABLE);
+}
+
+static void intc2_irq_gpio_ack(struct irq_data *d)
+{
+       u32 imr = 0;
+       u32 type = irqd_get_trigger_type(d);
+       int irq = d->irq - MCF_IRQ_GPIO0;
+
+       if (type & IRQ_TYPE_EDGE_RISING)
+               imr |= (0x001 << irq);
+       if (type & IRQ_TYPE_EDGE_FALLING)
+               imr |= (0x100 << irq);
+       writel(imr, MCFSIM2_GPIOINTCLEAR);
+}
+
+static int intc2_irq_gpio_set_type(struct irq_data *d, unsigned int f)
+{
+       if (f & ~IRQ_TYPE_EDGE_BOTH)
+               return -EINVAL;
+       return 0;
+}
+
+static struct irq_chip intc2_irq_gpio_chip = {
+       .name           = "CF-INTC2",
+       .irq_mask       = intc2_irq_gpio_mask,
+       .irq_unmask     = intc2_irq_gpio_unmask,
+       .irq_ack        = intc2_irq_gpio_ack,
+       .irq_set_type   = intc2_irq_gpio_set_type,
+};
+
+static int __init mcf_intc2_init(void)
+{
+       int irq;
+
+       /* set the interrupt base for the second interrupt controller */
+       writel(MCFINTC2_VECBASE, MCFINTC2_INTBASE);
+
+       /* GPIO interrupt sources */
+       for (irq = MCF_IRQ_GPIO0; (irq <= MCF_IRQ_GPIO6); irq++) {
+               irq_set_chip(irq, &intc2_irq_gpio_chip);
+               irq_set_handler(irq, handle_edge_irq);
+       }
+
+       return 0;
+}
+
+arch_initcall(mcf_intc2_init);
diff --git a/arch/m68k/platform/coldfire/m525x.c b/arch/m68k/platform/coldfire/m525x.c
new file mode 100644 (file)
index 0000000..8ce905f
--- /dev/null
@@ -0,0 +1,66 @@
+/***************************************************************************/
+
+/*
+ *     525x.c
+ *
+ *     Copyright (C) 2012, Steven King <sfking@fdwdc.com>
+ */
+
+/***************************************************************************/
+
+#include <linux/kernel.h>
+#include <linux/param.h>
+#include <linux/init.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <asm/machdep.h>
+#include <asm/coldfire.h>
+#include <asm/mcfsim.h>
+
+/***************************************************************************/
+
+static void __init m525x_qspi_init(void)
+{
+#if IS_ENABLED(CONFIG_SPI_COLDFIRE_QSPI)
+       /* set the GPIO function for the qspi cs gpios */
+       /* FIXME: replace with pinmux/pinctl support */
+       u32 f = readl(MCFSIM2_GPIOFUNC);
+       f |= (1 << MCFQSPI_CS2) | (1 << MCFQSPI_CS1) | (1 << MCFQSPI_CS0);
+       writel(f, MCFSIM2_GPIOFUNC);
+
+       /* QSPI irq setup */
+       writeb(MCFSIM_ICR_AUTOVEC | MCFSIM_ICR_LEVEL4 | MCFSIM_ICR_PRI0,
+              MCF_MBAR + MCFSIM_QSPIICR);
+       mcf_mapirq2imr(MCF_IRQ_QSPI, MCFINTC_QSPI);
+#endif /* IS_ENABLED(CONFIG_SPI_COLDFIRE_QSPI) */
+}
+
+static void __init m525x_i2c_init(void)
+{
+#if IS_ENABLED(CONFIG_I2C_COLDFIRE)
+       u32 r;
+
+       /* first I2C controller uses regular irq setup */
+       writeb(MCFSIM_ICR_AUTOVEC | MCFSIM_ICR_LEVEL5 | MCFSIM_ICR_PRI0,
+                       MCF_MBAR + MCFSIM_I2CICR);
+       mcf_mapirq2imr(MCF_IRQ_I2C0, MCFINTC_I2C);
+
+       /* second I2C controller is completely different */
+       r = readl(MCFINTC2_INTPRI_REG(MCF_IRQ_I2C1));
+       r &= ~MCFINTC2_INTPRI_BITS(0xf, MCF_IRQ_I2C1);
+       r |= MCFINTC2_INTPRI_BITS(0x5, MCF_IRQ_I2C1);
+       writel(r, MCFINTC2_INTPRI_REG(MCF_IRQ_I2C1));
+#endif /* IS_ENABLED(CONFIG_I2C_COLDFIRE) */
+}
+
+/***************************************************************************/
+
+void __init config_BSP(char *commandp, int size)
+{
+       mach_sched_init = hw_timer_init;
+
+       m525x_qspi_init();
+       m525x_i2c_init();
+}
+
+/***************************************************************************/