[ARM] 5197/1: gumstix: conversion to MFP support and add bluetooth support (d8ad7859) · Commits · e / devices / android_kernel_xiaomi_markw

arch/arm/mach-pxa/gumstix.c

+83 −17

Original line number	Diff line number	Diff line
		@@ -20,8 +20,12 @@
		#include <linux/init.h>
		#include <linux/platform_device.h>
		#include <linux/interrupt.h>
		#include <linux/delay.h>
		#include <linux/mtd/mtd.h>
		#include <linux/mtd/partitions.h>
		#include <linux/gpio.h>
		#include <linux/err.h>
		#include <linux/clk.h>

		#include <asm/setup.h>
		#include <asm/memory.h>
		@@ -40,7 +44,7 @@

		#include <mach/pxa-regs.h>
		#include <mach/pxa2xx-regs.h>
		#include <mach/pxa2xx-gpio.h>
		#include <mach/mfp-pxa25x.h>

		#include "generic.h"

		@@ -85,21 +89,8 @@ static struct platform_device *devices[] __initdata = {
		};

		#ifdef CONFIG_MMC_PXA
		static struct pxamci_platform_data gumstix_mci_platform_data;

		static int gumstix_mci_init(struct device *dev, irq_handler_t detect_int,
		void *data)
		{
		pxa_gpio_mode(GPIO6_MMCCLK_MD);
		pxa_gpio_mode(GPIO53_MMCCLK_MD);
		pxa_gpio_mode(GPIO8_MMCCS0_MD);

		return 0;
		}

		static struct pxamci_platform_data gumstix_mci_platform_data = {
		.ocr_mask = MMC_VDD_32_33\|MMC_VDD_33_34,
		.init = gumstix_mci_init,
		};

		static void __init gumstix_mmc_init(void)
		@@ -109,11 +100,11 @@ static void __init gumstix_mmc_init(void)
		#else
		static void __init gumstix_mmc_init(void)
		{
		printk(KERN_INFO "Gumstix mmc disabled\n");
		pr_debug("Gumstix mmc disabled\n");
		}
		#endif

		#ifdef CONFIG_USB_GADGET_PXA2XX
		#ifdef CONFIG_USB_GADGET_PXA25X
		static struct pxa2xx_udc_mach_info gumstix_udc_info __initdata = {
		.gpio_vbus = GPIO_GUMSTIX_USB_GPIOn,
		.gpio_pullup = GPIO_GUMSTIX_USB_GPIOx,
		@@ -126,12 +117,87 @@ static void __init gumstix_udc_init(void)
		#else
		static void gumstix_udc_init(void)
		{
		printk(KERN_INFO "Gumstix udc is disabled\n");
		pr_debug("Gumstix udc is disabled\n");
		}
		#endif

		#ifdef CONFIG_BT
		/* Normally, the bootloader would have enabled this 32kHz clock but many
		** boards still have u-boot 1.1.4 so we check if it has been turned on and
		** if not, we turn it on with a warning message. */
		static void gumstix_setup_bt_clock(void)
		{
		int timeout = 500;

		if (!(OSCC & OSCC_OOK))
		pr_warning("32kHz clock was not on. Bootloader may need to "
		"be updated\n");
		else
		return;

		OSCC \|= OSCC_OON;
		do {
		if (OSCC & OSCC_OOK)
		break;
		udelay(1);
		} while (--timeout);
		if (!timeout)
		pr_err("Failed to start 32kHz clock\n");
		}

		static void __init gumstix_bluetooth_init(void)
		{
		int err;

		gumstix_setup_bt_clock();

		err = gpio_request(GPIO_GUMSTIX_BTRESET, "BTRST");
		if (err) {
		pr_err("gumstix: failed request gpio for bluetooth reset\n");
		return;
		}

		err = gpio_direction_output(GPIO_GUMSTIX_BTRESET, 1);
		if (err) {
		pr_err("gumstix: can't reset bluetooth\n");
		return;
		}
		gpio_set_value(GPIO_GUMSTIX_BTRESET, 0);
		udelay(100);
		gpio_set_value(GPIO_GUMSTIX_BTRESET, 1);
		}
		#else
		static void gumstix_bluetooth_init(void)
		{
		pr_debug("Gumstix Bluetooth is disabled\n");
		}
		#endif

		static unsigned long gumstix_pin_config[] __initdata = {
		GPIO12_32KHz,
		/* BTUART */
		GPIO42_HWUART_RXD,
		GPIO43_HWUART_TXD,
		GPIO44_HWUART_CTS,
		GPIO45_HWUART_RTS,
		/* MMC */
		GPIO6_MMC_CLK,
		GPIO53_MMC_CLK,
		GPIO8_MMC_CS0,
		/* these are used by AM200EPD */
		GPIO51_GPIO,
		GPIO49_GPIO,
		GPIO48_GPIO,
		GPIO32_GPIO,
		GPIO17_GPIO,
		GPIO16_GPIO,
		};

		static void __init gumstix_init(void)
		{
		pxa2xx_mfp_config(ARRAY_AND_SIZE(gumstix_pin_config));

		gumstix_bluetooth_init();
		gumstix_udc_init();
		gumstix_mmc_init();
		(void) platform_add_devices(devices, ARRAY_SIZE(devices));