1 files changed, 453 insertions, 226 deletions

diff --git a/arch/arm/mach-pxa/stargate2.c b/arch/arm/mach-pxa/stargate2.c
index af40d2a12d37..a654d1e6b38a 100644
--- a/arch/arm/mach-pxa/stargate2.c
+++ b/arch/arm/mach-pxa/stargate2.c
@@ -29,6 +29,7 @@
 #include <linux/i2c/at24.h>
 #include <linux/smc91x.h>
 #include <linux/gpio.h>
+#include <linux/leds.h>
 
 #include <asm/types.h>
 #include <asm/setup.h>
@@ -62,37 +63,12 @@
 #define SG2_GPIO_nSD_DETECT     90
 #define SG2_SD_POWER_ENABLE     89
 
-static unsigned long stargate2_pin_config[] __initdata = {
-
-        GPIO15_nCS_1, /* SRAM */
-        /* SMC91x */
-        GPIO80_nCS_4,
-        GPIO40_GPIO, /*cable detect?*/
+static unsigned long sg2_im2_unified_pin_config[] __initdata = {
         /* Device Identification for wakeup*/
         GPIO102_GPIO,
-
-        /* Button */
-        GPIO91_GPIO | WAKEUP_ON_LEVEL_HIGH,
-
         /* DA9030 */
         GPIO1_GPIO,
 
-        /* Compact Flash */
-        GPIO79_PSKTSEL,
-        GPIO48_nPOE,
-        GPIO49_nPWE,
-        GPIO50_nPIOR,
-        GPIO51_nPIOW,
-        GPIO85_nPCE_1,
-        GPIO54_nPCE_2,
-        GPIO55_nPREG,
-        GPIO56_nPWAIT,
-        GPIO57_nIOIS16,
-        GPIO120_GPIO, /* Buff ctrl */
-        GPIO108_GPIO, /* Power ctrl */
-        GPIO82_GPIO, /* Reset */
-        GPIO53_GPIO, /* SG2_S0_GPIO_DETECT */
-
         /* MMC */
         GPIO32_MMC_CLK,
         GPIO112_MMC_CMD,
@@ -100,49 +76,44 @@ static unsigned long stargate2_pin_config[] __initdata = {
         GPIO109_MMC_DAT_1,
         GPIO110_MMC_DAT_2,
         GPIO111_MMC_DAT_3,
-        GPIO90_GPIO, /* nSD detect */
-        GPIO89_GPIO, /* SD_POWER_ENABLE */
 
-        /* Bluetooth */
-        GPIO81_GPIO, /* reset */
-
-        /* cc2420 802.15.4 radio */
-        GPIO22_GPIO,            /* CC_RSTN  (out)*/
-        GPIO114_GPIO,           /* CC_FIFO (in) */
-        GPIO116_GPIO,           /* CC_CCA (in) */
-        GPIO0_GPIO,             /* CC_FIFOP (in) */
-        GPIO16_GPIO,            /* CCSFD (in) */
-        GPIO39_GPIO,            /* CSn (out) */
+        /* 802.15.4 radio - driver out of mainline */
+        GPIO22_GPIO,                    /* CC_RSTN */
+        GPIO114_GPIO,                   /* CC_FIFO */
+        GPIO116_GPIO,                   /* CC_CCA */
+        GPIO0_GPIO,                     /* CC_FIFOP */
+        GPIO16_GPIO,                    /* CCSFD */
+        GPIO115_GPIO,                   /* Power enable */
 
         /* I2C */
         GPIO117_I2C_SCL,
         GPIO118_I2C_SDA,
 
         /* SSP 3 - 802.15.4 radio */
-        GPIO39_GPIO, /* chip select */
+        GPIO39_GPIO,                    /* Chip Select */
         GPIO34_SSP3_SCLK,
         GPIO35_SSP3_TXD,
         GPIO41_SSP3_RXD,
 
-        /* SSP 2 */
+        /* SSP 2 to daughter boards */
         GPIO11_SSP2_RXD,
         GPIO38_SSP2_TXD,
         GPIO36_SSP2_SCLK,
         GPIO37_GPIO, /* chip select */
 
-        /* SSP 1 */
-        GPIO26_SSP1_RXD,
-        GPIO25_SSP1_TXD,
+        /* SSP 1 - to daughter boards */
+        GPIO24_GPIO,                    /* Chip Select */
         GPIO23_SSP1_SCLK,
-        GPIO24_GPIO, /* chip select */
+        GPIO25_SSP1_TXD,
+        GPIO26_SSP1_RXD,
 
-        /* BTUART */
+        /* BTUART Basic Connector*/
         GPIO42_BTUART_RXD,
         GPIO43_BTUART_TXD,
         GPIO44_BTUART_CTS,
         GPIO45_BTUART_RTS,
 
-        /* STUART */
+        /* STUART  - IM2 via debug board not sure on SG2*/
         GPIO46_STUART_RXD,
         GPIO47_STUART_TXD,
 
@@ -150,47 +121,17 @@ static unsigned long stargate2_pin_config[] __initdata = {
         GPIO96_GPIO,    /* accelerometer interrupt */
         GPIO99_GPIO,    /* ADC interrupt */
 
-        /* Connector pins specified as gpios */
-        GPIO94_GPIO, /* large basic connector pin 14 */
-        GPIO10_GPIO, /* large basic connector pin 23 */
-
         /* SHT15 */
         GPIO100_GPIO,
         GPIO98_GPIO,
-};
 
-/**
- * stargate2_reset_bluetooth() reset the bluecore to ensure consistent state
- **/
-static int stargate2_reset_bluetooth(void)
-{
-        int err;
-        err = gpio_request(SG2_BT_RESET, "SG2_BT_RESET");
-        if (err) {
-                printk(KERN_ERR "Could not get gpio for bluetooth reset \n");
-                return err;
-        }
-        gpio_direction_output(SG2_BT_RESET, 1);
-        mdelay(5);
-        /* now reset it - 5 msec minimum */
-        gpio_set_value(SG2_BT_RESET, 0);
-        mdelay(10);
-        gpio_set_value(SG2_BT_RESET, 1);
-        gpio_free(SG2_BT_RESET);
-        return 0;
-}
+        /* Basic sensor board */
+        GPIO96_GPIO,    /* accelerometer interrupt */
+        GPIO99_GPIO,    /* ADC interrupt */
 
-static struct led_info stargate2_leds[] = {
-        {
-                .name = "sg2:red",
-                .flags = DA9030_LED_RATE_ON,
-        }, {
-                .name = "sg2:blue",
-                .flags = DA9030_LED_RATE_ON,
-        }, {
-                .name = "sg2:green",
-                .flags = DA9030_LED_RATE_ON,
-        },
+        /* Connector pins specified as gpios */
+        GPIO94_GPIO, /* large basic connector pin 14 */
+        GPIO10_GPIO, /* large basic connector pin 23 */
 };
 
 static struct sht15_platform_data platform_data_sht15 = {
@@ -352,20 +293,184 @@ static struct regulator_init_data stargate2_ldo_init_data[] = {
         },
 };
 
-static struct da903x_subdev_info stargate2_da9030_subdevs[] = {
+static struct mtd_partition stargate2flash_partitions[] = {
         {
-                .name = "da903x-led",
-                .id = DA9030_ID_LED_2,
-                .platform_data = &stargate2_leds[0],
+                .name = "Bootloader",
+                .size = 0x00040000,
+                .offset = 0,
+                .mask_flags = 0,
         }, {
-                .name = "da903x-led",
-                .id = DA9030_ID_LED_3,
-                .platform_data = &stargate2_leds[2],
+                .name = "Kernel",
+                .size = 0x00200000,
+                .offset = 0x00040000,
+                .mask_flags = 0
         }, {
-                .name = "da903x-led",
-                .id = DA9030_ID_LED_4,
-                .platform_data = &stargate2_leds[1],
+                .name = "Filesystem",
+                .size = 0x01DC0000,
+                .offset = 0x00240000,
+                .mask_flags = 0
+        },
+};
+
+static struct resource flash_resources = {
+        .start = PXA_CS0_PHYS,
+        .end = PXA_CS0_PHYS + SZ_32M - 1,
+        .flags = IORESOURCE_MEM,
+};
+
+static struct flash_platform_data stargate2_flash_data = {
+        .map_name = "cfi_probe",
+        .parts = stargate2flash_partitions,
+        .nr_parts = ARRAY_SIZE(stargate2flash_partitions),
+        .name = "PXA27xOnChipROM",
+        .width = 2,
+};
+
+static struct platform_device stargate2_flash_device = {
+        .name = "pxa2xx-flash",
+        .id = 0,
+        .dev = {
+                .platform_data = &stargate2_flash_data,
+        },
+        .resource = &flash_resources,
+        .num_resources = 1,
+};
+
+static struct pxa2xx_spi_master pxa_ssp_master_0_info = {
+        .num_chipselect = 1,
+};
+
+static struct pxa2xx_spi_master pxa_ssp_master_1_info = {
+        .num_chipselect = 1,
+};
+
+static struct pxa2xx_spi_master pxa_ssp_master_2_info = {
+        .num_chipselect = 1,
+};
+
+/* An upcoming kernel change will scrap SFRM usage so these
+ * drivers have been moved to use gpio's via cs_control */
+static struct pxa2xx_spi_chip staccel_chip_info = {
+        .tx_threshold = 8,
+        .rx_threshold = 8,
+        .dma_burst_size = 8,
+        .timeout = 235,
+        .gpio_cs = 24,
+};
+
+static struct pxa2xx_spi_chip cc2420_info = {
+        .tx_threshold = 8,
+        .rx_threshold = 8,
+        .dma_burst_size = 8,
+        .timeout = 235,
+        .gpio_cs = 39,
+};
+
+static struct spi_board_info spi_board_info[] __initdata = {
+        {
+                .modalias = "lis3l02dq",
+                .max_speed_hz = 8000000,/* 8MHz max spi frequency at 3V */
+                .bus_num = 1,
+                .chip_select = 0,
+                .controller_data = &staccel_chip_info,
+                .irq = IRQ_GPIO(96),
         }, {
+                .modalias = "cc2420",
+                .max_speed_hz = 6500000,
+                .bus_num = 3,
+                .chip_select = 0,
+                .controller_data = &cc2420_info,
+        },
+};
+
+static void sg2_udc_command(int cmd)
+{
+        switch (cmd) {
+        case PXA2XX_UDC_CMD_CONNECT:
+                UP2OCR |=  UP2OCR_HXOE  | UP2OCR_DPPUE | UP2OCR_DPPUBE;
+                break;
+        case PXA2XX_UDC_CMD_DISCONNECT:
+                UP2OCR &= ~(UP2OCR_HXOE  | UP2OCR_DPPUE | UP2OCR_DPPUBE);
+                break;
+        }
+}
+
+static struct i2c_pxa_platform_data i2c_pwr_pdata = {
+        .fast_mode = 1,
+};
+
+static struct i2c_pxa_platform_data i2c_pdata = {
+        .fast_mode = 1,
+};
+
+static void __init imote2_stargate2_init(void)
+{
+
+        pxa2xx_mfp_config(ARRAY_AND_SIZE(sg2_im2_unified_pin_config));
+
+        pxa_set_ffuart_info(NULL);
+        pxa_set_btuart_info(NULL);
+        pxa_set_stuart_info(NULL);
+
+        pxa2xx_set_spi_info(1, &pxa_ssp_master_0_info);
+        pxa2xx_set_spi_info(2, &pxa_ssp_master_1_info);
+        pxa2xx_set_spi_info(3, &pxa_ssp_master_2_info);
+        spi_register_board_info(spi_board_info, ARRAY_SIZE(spi_board_info));
+
+
+        pxa27x_set_i2c_power_info(&i2c_pwr_pdata);
+        pxa_set_i2c_info(&i2c_pdata);
+}
+
+#ifdef CONFIG_MACH_INTELMOTE2
+/* As the the imote2 doesn't currently have a conventional SD slot
+ * there is no option to hotplug cards, making all this rather simple
+ */
+static int imote2_mci_get_ro(struct device *dev)
+{
+        return 0;
+}
+
+/* Rather simple case as hotplugging not possible */
+static struct pxamci_platform_data imote2_mci_platform_data = {
+        .ocr_mask = MMC_VDD_32_33 | MMC_VDD_33_34, /* default anyway */
+        .get_ro = imote2_mci_get_ro,
+        .gpio_card_detect = -1,
+        .gpio_card_ro   = -1,
+        .gpio_power = -1,
+};
+
+static struct gpio_led imote2_led_pins[] = {
+        {
+                .name       =  "imote2:red",
+                .gpio       = 103,
+                .active_low = 1,
+        }, {
+                .name       = "imote2:green",
+                .gpio       = 104,
+                .active_low = 1,
+        }, {
+                .name       = "imote2:blue",
+                .gpio       = 105,
+                .active_low = 1,
+        },
+};
+
+static struct gpio_led_platform_data imote2_led_data = {
+        .num_leds = ARRAY_SIZE(imote2_led_pins),
+        .leds     = imote2_led_pins,
+};
+
+static struct platform_device imote2_leds = {
+        .name = "leds-gpio",
+        .id   = -1,
+        .dev = {
+                .platform_data = &imote2_led_data,
+        },
+};
+
+static struct da903x_subdev_info imote2_da9030_subdevs[] = {
+        {
                 .name = "da903x-regulator",
                 .id = DA9030_ID_LDO2,
                 .platform_data = &stargate2_ldo_init_data[vcc_bbio],
@@ -428,9 +533,121 @@ static struct da903x_subdev_info stargate2_da9030_subdevs[] = {
         },
 };
 
-static struct da903x_platform_data stargate2_da9030_pdata = {
-        .num_subdevs = ARRAY_SIZE(stargate2_da9030_subdevs),
-        .subdevs = stargate2_da9030_subdevs,
+static struct da903x_platform_data imote2_da9030_pdata = {
+        .num_subdevs = ARRAY_SIZE(imote2_da9030_subdevs),
+        .subdevs = imote2_da9030_subdevs,
+};
+
+static struct i2c_board_info __initdata imote2_pwr_i2c_board_info[] = {
+        {
+                .type = "da9030",
+                .addr = 0x49,
+                .platform_data = &imote2_da9030_pdata,
+                .irq = gpio_to_irq(1),
+        },
+};
+
+static struct i2c_board_info __initdata imote2_i2c_board_info[] = {
+        { /* UCAM sensor board */
+                .type = "max1239",
+                .addr = 0x35,
+        }, { /* ITS400 Sensor board only */
+                .type = "max1363",
+                .addr = 0x34,
+                /* Through a nand gate - Also beware, on V2 sensor board the
+                 * pull up resistors are missing.
+                 */
+                .irq = IRQ_GPIO(99),
+        }, { /* ITS400 Sensor board only */
+                .type = "tsl2561",
+                .addr = 0x49,
+                /* Through a nand gate - Also beware, on V2 sensor board the
+                 * pull up resistors are missing.
+                 */
+                .irq = IRQ_GPIO(99),
+        }, { /* ITS400 Sensor board only */
+                .type = "tmp175",
+                .addr = 0x4A,
+                .irq = IRQ_GPIO(96),
+        }, { /* IMB400 Multimedia board */
+                .type = "wm8940",
+                .addr = 0x1A,
+        },
+};
+
+static unsigned long imote2_pin_config[] __initdata = {
+
+        /* Button */
+        GPIO91_GPIO,
+
+        /* LEDS */
+        GPIO103_GPIO, /* red led */
+        GPIO104_GPIO, /* green led */
+        GPIO105_GPIO, /* blue led */
+};
+
+static struct pxa2xx_udc_mach_info imote2_udc_info __initdata = {
+        .udc_command            = sg2_udc_command,
+};
+
+static struct platform_device *imote2_devices[] = {
+        &stargate2_flash_device,
+        &imote2_leds,
+        &sht15,
+};
+
+static void __init imote2_init(void)
+{
+        pxa2xx_mfp_config(ARRAY_AND_SIZE(imote2_pin_config));
+
+        imote2_stargate2_init();
+
+        platform_add_devices(imote2_devices, ARRAY_SIZE(imote2_devices));
+
+        i2c_register_board_info(0, imote2_i2c_board_info,
+                                ARRAY_SIZE(imote2_i2c_board_info));
+        i2c_register_board_info(1, imote2_pwr_i2c_board_info,
+                                ARRAY_SIZE(imote2_pwr_i2c_board_info));
+
+        pxa_set_mci_info(&imote2_mci_platform_data);
+        pxa_set_udc_info(&imote2_udc_info);
+}
+#endif
+
+#ifdef CONFIG_MACH_STARGATE2
+
+static unsigned long stargate2_pin_config[] __initdata = {
+
+        GPIO15_nCS_1, /* SRAM */
+        /* SMC91x */
+        GPIO80_nCS_4,
+        GPIO40_GPIO, /*cable detect?*/
+
+        /* Button */
+        GPIO91_GPIO | WAKEUP_ON_LEVEL_HIGH,
+
+        /* Compact Flash */
+        GPIO79_PSKTSEL,
+        GPIO48_nPOE,
+        GPIO49_nPWE,
+        GPIO50_nPIOR,
+        GPIO51_nPIOW,
+        GPIO85_nPCE_1,
+        GPIO54_nPCE_2,
+        GPIO55_nPREG,
+        GPIO56_nPWAIT,
+        GPIO57_nIOIS16,
+        GPIO120_GPIO, /* Buff ctrl */
+        GPIO108_GPIO, /* Power ctrl */
+        GPIO82_GPIO, /* Reset */
+        GPIO53_GPIO, /* SG2_S0_GPIO_DETECT */
+
+        /* MMC not shared with imote2 */
+        GPIO90_GPIO, /* nSD detect */
+        GPIO89_GPIO, /* SD_POWER_ENABLE */
+
+        /* Bluetooth */
+        GPIO81_GPIO, /* reset */
 };
 
 static struct resource smc91x_resources[] = {
@@ -463,7 +680,6 @@ static struct platform_device smc91x_device = {
 };
 
 
-
 /*
  * The card detect interrupt isn't debounced so we delay it by 250ms
  * to give the card a chance to fully insert / eject.
@@ -532,48 +748,6 @@ static struct pxamci_platform_data stargate2_mci_platform_data = {
         .exit = stargate2_mci_exit,
 };
 
-static struct mtd_partition stargate2flash_partitions[] = {
-        {
-                .name = "Bootloader",
-                .size = 0x00040000,
-                .offset = 0,
-                .mask_flags = 0,
-        }, {
-                .name = "Kernel",
-                .size = 0x00200000,
-                .offset = 0x00040000,
-                .mask_flags = 0
-        }, {
-                .name = "Filesystem",
-                .size = 0x01DC0000,
-                .offset = 0x00240000,
-                .mask_flags = 0
-        },
-};
-
-static struct resource flash_resources = {
-        .start = PXA_CS0_PHYS,
-        .end = PXA_CS0_PHYS + SZ_32M - 1,
-        .flags = IORESOURCE_MEM,
-};
-
-static struct flash_platform_data stargate2_flash_data = {
-        .map_name = "cfi_probe",
-        .parts = stargate2flash_partitions,
-        .nr_parts = ARRAY_SIZE(stargate2flash_partitions),
-        .name = "PXA27xOnChipROM",
-        .width = 2,
-};
-
-static struct platform_device stargate2_flash_device = {
-        .name = "pxa2xx-flash",
-        .id = 0,
-        .dev = {
-                .platform_data = &stargate2_flash_data,
-        },
-        .resource = &flash_resources,
-        .num_resources = 1,
-};
 
 /*
  * SRAM - The Stargate 2 has 32MB of SRAM.
@@ -616,6 +790,129 @@ static struct at24_platform_data pca9500_eeprom_pdata = {
         .page_size = 4,
 };
 
+/**
+ * stargate2_reset_bluetooth() reset the bluecore to ensure consistent state
+ **/
+static int stargate2_reset_bluetooth(void)
+{
+        int err;
+        err = gpio_request(SG2_BT_RESET, "SG2_BT_RESET");
+        if (err) {
+                printk(KERN_ERR "Could not get gpio for bluetooth reset\n");
+                return err;
+        }
+        gpio_direction_output(SG2_BT_RESET, 1);
+        mdelay(5);
+        /* now reset it - 5 msec minimum */
+        gpio_set_value(SG2_BT_RESET, 0);
+        mdelay(10);
+        gpio_set_value(SG2_BT_RESET, 1);
+        gpio_free(SG2_BT_RESET);
+        return 0;
+}
+
+static struct led_info stargate2_leds[] = {
+        {
+                .name = "sg2:red",
+                .flags = DA9030_LED_RATE_ON,
+        }, {
+                .name = "sg2:blue",
+                .flags = DA9030_LED_RATE_ON,
+        }, {
+                .name = "sg2:green",
+                .flags = DA9030_LED_RATE_ON,
+        },
+};
+
+static struct da903x_subdev_info stargate2_da9030_subdevs[] = {
+        {
+                .name = "da903x-led",
+                .id = DA9030_ID_LED_2,
+                .platform_data = &stargate2_leds[0],
+        }, {
+                .name = "da903x-led",
+                .id = DA9030_ID_LED_3,
+                .platform_data = &stargate2_leds[2],
+        }, {
+                .name = "da903x-led",
+                .id = DA9030_ID_LED_4,
+                .platform_data = &stargate2_leds[1],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO2,
+                .platform_data = &stargate2_ldo_init_data[vcc_bbio],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO3,
+                .platform_data = &stargate2_ldo_init_data[vcc_bb],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO4,
+                .platform_data = &stargate2_ldo_init_data[vcc_pxa_flash],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO5,
+                .platform_data = &stargate2_ldo_init_data[vcc_cc2420],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO6,
+                .platform_data = &stargate2_ldo_init_data[vcc_vref],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO7,
+                .platform_data = &stargate2_ldo_init_data[vcc_sram_ext],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO8,
+                .platform_data = &stargate2_ldo_init_data[vcc_mica],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO9,
+                .platform_data = &stargate2_ldo_init_data[vcc_bt],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO10,
+                .platform_data = &stargate2_ldo_init_data[vcc_sensor_1_8],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO11,
+                .platform_data = &stargate2_ldo_init_data[vcc_sensor_3],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO12,
+                .platform_data = &stargate2_ldo_init_data[vcc_lcd],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO15,
+                .platform_data = &stargate2_ldo_init_data[vcc_pxa_pll],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO17,
+                .platform_data = &stargate2_ldo_init_data[vcc_pxa_usim],
+        }, {
+                .name = "da903x-regulator", /*pxa vcc i/o and cc2420 vcc i/o */
+                .id = DA9030_ID_LDO18,
+                .platform_data = &stargate2_ldo_init_data[vcc_io],
+        }, {
+                .name = "da903x-regulator",
+                .id = DA9030_ID_LDO19,
+                .platform_data = &stargate2_ldo_init_data[vcc_pxa_mem],
+        },
+};
+
+static struct da903x_platform_data stargate2_da9030_pdata = {
+        .num_subdevs = ARRAY_SIZE(stargate2_da9030_subdevs),
+        .subdevs = stargate2_da9030_subdevs,
+};
+
+static struct i2c_board_info __initdata stargate2_pwr_i2c_board_info[] = {
+        {
+                .type = "da9030",
+                .addr = 0x49,
+                .platform_data = &stargate2_da9030_pdata,
+                .irq = gpio_to_irq(1),
+        },
+};
 
 static struct i2c_board_info __initdata stargate2_i2c_board_info[] = {
         /* Techically this a pca9500 - but it's compatible with the 8574
@@ -653,74 +950,6 @@ static struct i2c_board_info __initdata stargate2_i2c_board_info[] = {
         },
 };
 
-static struct i2c_board_info __initdata stargate2_pwr_i2c_board_info[] = {
-        {
-                .type = "da9030",
-                .addr = 0x49,
-                .platform_data = &stargate2_da9030_pdata,
-                .irq = gpio_to_irq(1),
-        },
-};
-
-static struct pxa2xx_spi_master pxa_ssp_master_0_info = {
-        .num_chipselect = 1,
-};
-
-static struct pxa2xx_spi_master pxa_ssp_master_1_info = {
-        .num_chipselect = 1,
-};
-
-static struct pxa2xx_spi_master pxa_ssp_master_2_info = {
-        .num_chipselect = 1,
-};
-
-/* An upcoming kernel change will scrap SFRM usage so these
- * drivers have been moved to use gpio's via cs_control */
-static struct pxa2xx_spi_chip staccel_chip_info = {
-        .tx_threshold = 8,
-        .rx_threshold = 8,
-        .dma_burst_size = 8,
-        .timeout = 235,
-        .gpio_cs = 24,
-};
-
-static struct pxa2xx_spi_chip cc2420_info = {
-        .tx_threshold = 8,
-        .rx_threshold = 8,
-        .dma_burst_size = 8,
-        .timeout = 235,
-        .gpio_cs = 39,
-};
-
-static struct spi_board_info spi_board_info[] __initdata = {
-        {
-                .modalias = "lis3l02dq",
-                .max_speed_hz = 8000000,/* 8MHz max spi frequency at 3V */
-                .bus_num = 1,
-                .chip_select = 0,
-                .controller_data = &staccel_chip_info,
-                .irq = IRQ_GPIO(96),
-        }, {
-                .modalias = "cc2420",
-                .max_speed_hz = 6500000,
-                .bus_num = 3,
-                .chip_select = 0,
-                .controller_data = &cc2420_info,
-        },
-};
-
-static void sg2_udc_command(int cmd)
-{
-        switch (cmd) {
-        case PXA2XX_UDC_CMD_CONNECT:
-                UP2OCR |=  UP2OCR_HXOE  | UP2OCR_DPPUE | UP2OCR_DPPUBE;
-                break;
-        case PXA2XX_UDC_CMD_DISCONNECT:
-                UP2OCR &= ~(UP2OCR_HXOE  | UP2OCR_DPPUE | UP2OCR_DPPUBE);
-                break;
-        }
-}
-
 /* Board doesn't support cable detection - so always lie and say
  * something is there.
  */
@@ -741,14 +970,6 @@ static struct platform_device *stargate2_devices[] = {
         &sht15,
 };
 
-static struct i2c_pxa_platform_data i2c_pwr_pdata = {
-        .fast_mode = 1,
-};
-
-static struct i2c_pxa_platform_data i2c_pdata = {
-        .fast_mode = 1,
-};
-
 static void __init stargate2_init(void)
 {
         /* This is probably a board specific hack as this must be set
@@ -757,22 +978,13 @@ static void __init stargate2_init(void)
 
         pxa2xx_mfp_config(ARRAY_AND_SIZE(stargate2_pin_config));
 
-        pxa_set_ffuart_info(NULL);
-        pxa_set_btuart_info(NULL);
-        pxa_set_stuart_info(NULL);
+        imote2_stargate2_init();
 
         platform_add_devices(ARRAY_AND_SIZE(stargate2_devices));
 
-        pxa2xx_set_spi_info(1, &pxa_ssp_master_0_info);
-        pxa2xx_set_spi_info(2, &pxa_ssp_master_1_info);
-        pxa2xx_set_spi_info(3, &pxa_ssp_master_2_info);
-        spi_register_board_info(spi_board_info, ARRAY_SIZE(spi_board_info));
-
         i2c_register_board_info(0, ARRAY_AND_SIZE(stargate2_i2c_board_info));
-        i2c_register_board_info(1,
-                                ARRAY_AND_SIZE(stargate2_pwr_i2c_board_info));
-        pxa27x_set_i2c_power_info(&i2c_pwr_pdata);
-        pxa_set_i2c_info(&i2c_pdata);
+        i2c_register_board_info(1, stargate2_pwr_i2c_board_info,
+                                ARRAY_SIZE(stargate2_pwr_i2c_board_info));
 
         pxa_set_mci_info(&stargate2_mci_platform_data);
 
@@ -780,7 +992,21 @@ static void __init stargate2_init(void)
 
         stargate2_reset_bluetooth();
 }
+#endif
+
+#ifdef CONFIG_MACH_INTELMOTE2
+MACHINE_START(INTELMOTE2, "IMOTE 2")
+        .phys_io        = 0x40000000,
+        .io_pg_offst    = (io_p2v(0x40000000) >> 18) & 0xfffc,
+        .map_io         = pxa_map_io,
+        .init_irq       = pxa27x_init_irq,
+        .timer          = &pxa_timer,
+        .init_machine   = imote2_init,
+        .boot_params    = 0xA0000100,
+MACHINE_END
+#endif
 
+#ifdef CONFIG_MACH_STARGATE2
 MACHINE_START(STARGATE2, "Stargate 2")
         .phys_io = 0x40000000,
         .io_pg_offst = (io_p2v(0x40000000) >> 18) & 0xfffc,
@@ -790,3 +1016,4 @@ MACHINE_START(STARGATE2, "Stargate 2")
         .init_machine = stargate2_init,
         .boot_params = 0xA0000100,
 MACHINE_END
+#endif