[deliverable/linux.git] / arch / arm / mach-s3c64xx / mach-smartq.c

/*
 * linux/arch/arm/mach-s3c64xx/mach-smartq.c
 *
 * Copyright (C) 2010 Maurus Cuelenaere
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 */

#include <linux/delay.h>
#include <linux/fb.h>
#include <linux/gpio.h>
#include <linux/gpio/machine.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/pwm.h>
#include <linux/pwm_backlight.h>
#include <linux/serial_core.h>
#include <linux/serial_s3c.h>
#include <linux/spi/spi_gpio.h>
#include <linux/usb/gpio_vbus.h>
#include <linux/platform_data/s3c-hsotg.h>

#include <asm/mach-types.h>
#include <asm/mach/map.h>

#include <mach/map.h>
#include <mach/regs-gpio.h>
#include <mach/gpio-samsung.h>

#include <plat/cpu.h>
#include <plat/devs.h>
#include <linux/platform_data/i2c-s3c2410.h>
#include <plat/gpio-cfg.h>
#include <linux/platform_data/hwmon-s3c.h>
#include <linux/platform_data/usb-ohci-s3c2410.h>
#include <plat/sdhci.h>
#include <linux/platform_data/touchscreen-s3c2410.h>

#include <video/platform_lcd.h>
#include <plat/samsung-time.h>

#include "common.h"
#include "regs-modem.h"

#define UCON S3C2410_UCON_DEFAULT
#define ULCON (S3C2410_LCON_CS8 | S3C2410_LCON_PNONE)
#define UFCON (S3C2410_UFCON_RXTRIG8 | S3C2410_UFCON_FIFOMODE)

static struct s3c2410_uartcfg smartq_uartcfgs[] __initdata = {
	[0] = {
		.hwport	     = 0,
		.flags	     = 0,
		.ucon	     = UCON,
		.ulcon	     = ULCON,
		.ufcon	     = UFCON,
	},
	[1] = {
		.hwport	     = 1,
		.flags	     = 0,
		.ucon	     = UCON,
		.ulcon	     = ULCON,
		.ufcon	     = UFCON,
	},
	[2] = {
		.hwport	     = 2,
		.flags	     = 0,
		.ucon	     = UCON,
		.ulcon	     = ULCON,
		.ufcon	     = UFCON,
	},
};

static void smartq_usb_host_powercontrol(int port, int to)
{
	pr_debug("%s(%d, %d)\n", __func__, port, to);

	if (port == 0) {
		gpio_set_value(S3C64XX_GPL(0), to);
		gpio_set_value(S3C64XX_GPL(1), to);
	}
}

static irqreturn_t smartq_usb_host_ocirq(int irq, void *pw)
{
	struct s3c2410_hcd_info *info = pw;

	if (gpio_get_value(S3C64XX_GPL(10)) == 0) {
		pr_debug("%s: over-current irq (oc detected)\n", __func__);
		s3c2410_usb_report_oc(info, 3);
	} else {
		pr_debug("%s: over-current irq (oc cleared)\n", __func__);
		s3c2410_usb_report_oc(info, 0);
	}

	return IRQ_HANDLED;
}

static void smartq_usb_host_enableoc(struct s3c2410_hcd_info *info, int on)
{
	int ret;

	/* This isn't present on a SmartQ 5 board */
	if (machine_is_smartq5())
		return;

	if (on) {
		ret = request_irq(gpio_to_irq(S3C64XX_GPL(10)),
				  smartq_usb_host_ocirq,
				  IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
				  "USB host overcurrent", info);
		if (ret != 0)
			pr_err("failed to request usb oc irq: %d\n", ret);
	} else {
		free_irq(gpio_to_irq(S3C64XX_GPL(10)), info);
	}
}

static struct s3c2410_hcd_info smartq_usb_host_info = {
	.port[0]	= {
		.flags	= S3C_HCDFLG_USED
	},
	.port[1]	= {
		.flags	= 0
	},

	.power_control	= smartq_usb_host_powercontrol,
	.enable_oc	= smartq_usb_host_enableoc,
};

static struct gpio_vbus_mach_info smartq_usb_otg_vbus_pdata = {
	.gpio_vbus		= S3C64XX_GPL(9),
	.gpio_pullup		= -1,
	.gpio_vbus_inverted	= true,
};

static struct platform_device smartq_usb_otg_vbus_dev = {
	.name			= "gpio-vbus",
	.dev.platform_data	= &smartq_usb_otg_vbus_pdata,
};

static struct pwm_lookup smartq_pwm_lookup[] = {
	PWM_LOOKUP("samsung-pwm", 1, "pwm-backlight.0", NULL,
		   1000000000 / (1000 * 20), PWM_POLARITY_NORMAL),
};

static int smartq_bl_init(struct device *dev)
{
    s3c_gpio_cfgpin(S3C64XX_GPF(15), S3C_GPIO_SFN(2));

    return 0;
}

static struct platform_pwm_backlight_data smartq_backlight_data = {
	.max_brightness	= 1000,
	.dft_brightness	= 600,
	.enable_gpio	= -1,
	.init		= smartq_bl_init,
};

static struct platform_device smartq_backlight_device = {
	.name		= "pwm-backlight",
	.dev		= {
		.parent	= &samsung_device_pwm.dev,
		.platform_data = &smartq_backlight_data,
	},
};

static struct s3c2410_ts_mach_info smartq_touchscreen_pdata __initdata = {
	.delay			= 65535,
	.presc			= 99,
	.oversampling_shift	= 4,
};

static struct s3c_sdhci_platdata smartq_internal_hsmmc_pdata = {
	.max_width		= 4,
	.cd_type		= S3C_SDHCI_CD_PERMANENT,
};

static struct s3c_hwmon_pdata smartq_hwmon_pdata __initdata = {
	/* Battery voltage (?-4.2V) */
	.in[0] = &(struct s3c_hwmon_chcfg) {
		.name		= "smartq:battery-voltage",
		.mult		= 3300,
		.div		= 2048,
	},
	/* Reference voltage (1.2V) */
	.in[1] = &(struct s3c_hwmon_chcfg) {
		.name		= "smartq:reference-voltage",
		.mult		= 3300,
		.div		= 4096,
	},
};

static struct dwc2_hsotg_plat smartq_hsotg_pdata;

static int __init smartq_lcd_setup_gpio(void)
{
	int ret;

	ret = gpio_request(S3C64XX_GPM(3), "LCD power");
	if (ret < 0)
		return ret;

	/* turn power off */
	gpio_direction_output(S3C64XX_GPM(3), 0);

	return 0;
}

/* GPM0 -> CS */
static struct spi_gpio_platform_data smartq_lcd_control = {
	.sck			= S3C64XX_GPM(1),
	.mosi			= S3C64XX_GPM(2),
	.miso			= S3C64XX_GPM(2),
};

static struct platform_device smartq_lcd_control_device = {
	.name			= "spi-gpio",
	.id			= 1,
	.dev.platform_data	= &smartq_lcd_control,
};

static void smartq_lcd_power_set(struct plat_lcd_data *pd, unsigned int power)
{
	gpio_direction_output(S3C64XX_GPM(3), power);
}

static struct plat_lcd_data smartq_lcd_power_data = {
	.set_power	= smartq_lcd_power_set,
};

static struct platform_device smartq_lcd_power_device = {
	.name			= "platform-lcd",
	.dev.parent		= &s3c_device_fb.dev,
	.dev.platform_data	= &smartq_lcd_power_data,
};

static struct i2c_board_info smartq_i2c_devs[] __initdata = {
	{ I2C_BOARD_INFO("wm8987", 0x1a), },
};

static struct platform_device *smartq_devices[] __initdata = {
	&s3c_device_hsmmc1,	/* Init iNAND first, ... */
	&s3c_device_hsmmc0,	/* ... then the external SD card */
	&s3c_device_hsmmc2,
	&s3c_device_adc,
	&s3c_device_fb,
	&s3c_device_hwmon,
	&s3c_device_i2c0,
	&s3c_device_ohci,
	&s3c_device_rtc,
	&samsung_device_pwm,
	&s3c_device_ts,
	&s3c_device_usb_hsotg,
	&s3c64xx_device_iis0,
	&smartq_backlight_device,
	&smartq_lcd_control_device,
	&smartq_lcd_power_device,
	&smartq_usb_otg_vbus_dev,
};

static void __init smartq_lcd_mode_set(void)
{
	u32 tmp;

	/* set the LCD type */
	tmp = __raw_readl(S3C64XX_SPCON);
	tmp &= ~S3C64XX_SPCON_LCD_SEL_MASK;
	tmp |= S3C64XX_SPCON_LCD_SEL_RGB;
	__raw_writel(tmp, S3C64XX_SPCON);

	/* remove the LCD bypass */
	tmp = __raw_readl(S3C64XX_MODEM_MIFPCON);
	tmp &= ~MIFPCON_LCD_BYPASS;
	__raw_writel(tmp, S3C64XX_MODEM_MIFPCON);
}

static void smartq_power_off(void)
{
	gpio_direction_output(S3C64XX_GPK(15), 1);
}

static int __init smartq_power_off_init(void)
{
	int ret;

	ret = gpio_request(S3C64XX_GPK(15), "Power control");
	if (ret < 0) {
		pr_err("%s: failed to get GPK15\n", __func__);
		return ret;
	}

	/* leave power on */
	gpio_direction_output(S3C64XX_GPK(15), 0);

	pm_power_off = smartq_power_off;

	return ret;
}

static int __init smartq_usb_host_init(void)
{
	int ret;

	ret = gpio_request(S3C64XX_GPL(0), "USB power control");
	if (ret < 0) {
		pr_err("%s: failed to get GPL0\n", __func__);
		return ret;
	}

	ret = gpio_request(S3C64XX_GPL(1), "USB host power control");
	if (ret < 0) {
		pr_err("%s: failed to get GPL1\n", __func__);
		goto err;
	}

	if (!machine_is_smartq5()) {
		/* This isn't present on a SmartQ 5 board */
		ret = gpio_request(S3C64XX_GPL(10), "USB host overcurrent");
		if (ret < 0) {
			pr_err("%s: failed to get GPL10\n", __func__);
			goto err2;
		}
	}

	/* turn power off */
	gpio_direction_output(S3C64XX_GPL(0), 0);
	gpio_direction_output(S3C64XX_GPL(1), 0);
	if (!machine_is_smartq5())
		gpio_direction_input(S3C64XX_GPL(10));

	s3c_device_ohci.dev.platform_data = &smartq_usb_host_info;

	return 0;

err2:
	gpio_free(S3C64XX_GPL(1));
err:
	gpio_free(S3C64XX_GPL(0));
	return ret;
}

static int __init smartq_wifi_init(void)
{
	int ret;

	ret = gpio_request(S3C64XX_GPK(1), "wifi control");
	if (ret < 0) {
		pr_err("%s: failed to get GPK1\n", __func__);
		return ret;
	}

	ret = gpio_request(S3C64XX_GPK(2), "wifi reset");
	if (ret < 0) {
		pr_err("%s: failed to get GPK2\n", __func__);
		gpio_free(S3C64XX_GPK(1));
		return ret;
	}

	/* turn power on */
	gpio_direction_output(S3C64XX_GPK(1), 1);

	/* reset device */
	gpio_direction_output(S3C64XX_GPK(2), 0);
	mdelay(100);
	gpio_set_value(S3C64XX_GPK(2), 1);
	gpio_direction_input(S3C64XX_GPK(2));

	return 0;
}

static struct map_desc smartq_iodesc[] __initdata = {};
void __init smartq_map_io(void)
{
	s3c64xx_init_io(smartq_iodesc, ARRAY_SIZE(smartq_iodesc));
	s3c64xx_set_xtal_freq(12000000);
	s3c64xx_set_xusbxti_freq(12000000);
	s3c24xx_init_uarts(smartq_uartcfgs, ARRAY_SIZE(smartq_uartcfgs));
	samsung_set_timer_source(SAMSUNG_PWM3, SAMSUNG_PWM4);

	smartq_lcd_mode_set();
}

static struct gpiod_lookup_table smartq_audio_gpios = {
	.dev_id = "smartq-audio",
	.table = {
		GPIO_LOOKUP("GPL", 12, "headphone detect", 0),
		GPIO_LOOKUP("GPK", 12, "amplifiers shutdown", 0),
		{ },
	},
};

void __init smartq_machine_init(void)
{
	s3c_i2c0_set_platdata(NULL);
	dwc2_hsotg_set_platdata(&smartq_hsotg_pdata);
	s3c_hwmon_set_platdata(&smartq_hwmon_pdata);
	s3c_sdhci1_set_platdata(&smartq_internal_hsmmc_pdata);
	s3c_sdhci2_set_platdata(&smartq_internal_hsmmc_pdata);
	s3c24xx_ts_set_platdata(&smartq_touchscreen_pdata);

	i2c_register_board_info(0, smartq_i2c_devs,
				ARRAY_SIZE(smartq_i2c_devs));

	WARN_ON(smartq_lcd_setup_gpio());
	WARN_ON(smartq_power_off_init());
	WARN_ON(smartq_usb_host_init());
	WARN_ON(smartq_wifi_init());

	pwm_add_table(smartq_pwm_lookup, ARRAY_SIZE(smartq_pwm_lookup));
	platform_add_devices(smartq_devices, ARRAY_SIZE(smartq_devices));

	gpiod_add_lookup_table(&smartq_audio_gpios);
	platform_device_register_simple("smartq-audio", -1, NULL, 0);
}
Commit	Line	Data
a2f7bffa MC	1	/*
	2	* linux/arch/arm/mach-s3c64xx/mach-smartq.c
	3	*
	4	* Copyright (C) 2010 Maurus Cuelenaere
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*
	10	*/
	11
	12	#include <linux/delay.h>
	13	#include <linux/fb.h>
	14	#include <linux/gpio.h>
df0cc2d1	15	#include <linux/gpio/machine.h>
a2f7bffa MC	16	#include <linux/init.h>
a2f7bffa MC	17	#include <linux/platform_device.h>
4dddfb88	18	#include <linux/pwm.h>
a2f7bffa MC	19	#include <linux/pwm_backlight.h>
a2f7bffa MC	20	#include <linux/serial_core.h>
334a1c70	21	#include <linux/serial_s3c.h>
49f91b9e	22	#include <linux/spi/spi_gpio.h>
a2f7bffa	23	#include <linux/usb/gpio_vbus.h>
126625e1	24	#include <linux/platform_data/s3c-hsotg.h>
a2f7bffa MC	25
	26	#include <asm/mach-types.h>
	27	#include <asm/mach/map.h>
	28
	29	#include <mach/map.h>
	30	#include <mach/regs-gpio.h>
b0161caa	31	#include <mach/gpio-samsung.h>
a2f7bffa	32
a2f7bffa MC	33	#include <plat/cpu.h>
a2f7bffa MC	34	#include <plat/devs.h>
436d42c6	35	#include <linux/platform_data/i2c-s3c2410.h>
a2f7bffa	36	#include <plat/gpio-cfg.h>
436d42c6	37	#include <linux/platform_data/hwmon-s3c.h>
436d42c6	38	#include <linux/platform_data/usb-ohci-s3c2410.h>
a2f7bffa	39	#include <plat/sdhci.h>
436d42c6	40	#include <linux/platform_data/touchscreen-s3c2410.h>
a2f7bffa MC	41
a2f7bffa MC	42	#include <video/platform_lcd.h>
04a49b71	43	#include <plat/samsung-time.h>
a2f7bffa	44
b024043b	45	#include "common.h"
a81c1970	46	#include "regs-modem.h"
b024043b	47
a2f7bffa MC	48	#define UCON S3C2410_UCON_DEFAULT
	49	#define ULCON (S3C2410_LCON_CS8 \| S3C2410_LCON_PNONE)
	50	#define UFCON (S3C2410_UFCON_RXTRIG8 \| S3C2410_UFCON_FIFOMODE)
	51
	52	static struct s3c2410_uartcfg smartq_uartcfgs[] __initdata = {
	53	[0] = {
	54	.hwport = 0,
	55	.flags = 0,
	56	.ucon = UCON,
	57	.ulcon = ULCON,
	58	.ufcon = UFCON,
	59	},
	60	[1] = {
	61	.hwport = 1,
	62	.flags = 0,
	63	.ucon = UCON,
	64	.ulcon = ULCON,
	65	.ufcon = UFCON,
	66	},
	67	[2] = {
	68	.hwport = 2,
	69	.flags = 0,
	70	.ucon = UCON,
	71	.ulcon = ULCON,
	72	.ufcon = UFCON,
	73	},
	74	};
	75
	76	static void smartq_usb_host_powercontrol(int port, int to)
	77	{
	78	pr_debug("%s(%d, %d)\n", __func__, port, to);
	79
	80	if (port == 0) {
	81	gpio_set_value(S3C64XX_GPL(0), to);
	82	gpio_set_value(S3C64XX_GPL(1), to);
	83	}
	84	}
	85
	86	static irqreturn_t smartq_usb_host_ocirq(int irq, void *pw)
	87	{
	88	struct s3c2410_hcd_info *info = pw;
	89
	90	if (gpio_get_value(S3C64XX_GPL(10)) == 0) {
	91	pr_debug("%s: over-current irq (oc detected)\n", __func__);
	92	s3c2410_usb_report_oc(info, 3);
	93	} else {
	94	pr_debug("%s: over-current irq (oc cleared)\n", __func__);
	95	s3c2410_usb_report_oc(info, 0);
	96	}
	97
	98	return IRQ_HANDLED;
	99	}
	100
	101	static void smartq_usb_host_enableoc(struct s3c2410_hcd_info *info, int on)
	102	{
	103	int ret;
	104
	105	/* This isn't present on a SmartQ 5 board */
	106	if (machine_is_smartq5())
	107	return;
	108
	109	if (on) {
	110	ret = request_irq(gpio_to_irq(S3C64XX_GPL(10)),
fa53d5cd	111	smartq_usb_host_ocirq,
a2f7bffa MC	112	IRQF_TRIGGER_RISING \| IRQF_TRIGGER_FALLING,
	113	"USB host overcurrent", info);
	114	if (ret != 0)
	115	pr_err("failed to request usb oc irq: %d\n", ret);
	116	} else {
	117	free_irq(gpio_to_irq(S3C64XX_GPL(10)), info);
	118	}
	119	}
	120
	121	static struct s3c2410_hcd_info smartq_usb_host_info = {
	122	.port[0] = {
	123	.flags = S3C_HCDFLG_USED
	124	},
	125	.port[1] = {
	126	.flags = 0
	127	},
	128
	129	.power_control = smartq_usb_host_powercontrol,
	130	.enable_oc = smartq_usb_host_enableoc,
	131	};
	132
	133	static struct gpio_vbus_mach_info smartq_usb_otg_vbus_pdata = {
	134	.gpio_vbus = S3C64XX_GPL(9),
	135	.gpio_pullup = -1,
	136	.gpio_vbus_inverted = true,
	137	};
	138
	139	static struct platform_device smartq_usb_otg_vbus_dev = {
	140	.name = "gpio-vbus",
	141	.dev.platform_data = &smartq_usb_otg_vbus_pdata,
	142	};
	143
4dddfb88 TR	144	static struct pwm_lookup smartq_pwm_lookup[] = {
	145	PWM_LOOKUP("samsung-pwm", 1, "pwm-backlight.0", NULL,
	146	1000000000 / (1000 * 20), PWM_POLARITY_NORMAL),
	147	};
	148
9e978f09	149	static int smartq_bl_init(struct device *dev)
a2f7bffa MC	150	{
	151	s3c_gpio_cfgpin(S3C64XX_GPF(15), S3C_GPIO_SFN(2));
	152
	153	return 0;
	154	}
	155
	156	static struct platform_pwm_backlight_data smartq_backlight_data = {
a2f7bffa MC	157	.max_brightness = 1000,
a2f7bffa MC	158	.dft_brightness = 600,
a63652f1	159	.enable_gpio = -1,
a2f7bffa MC	160	.init = smartq_bl_init,
	161	};
	162
	163	static struct platform_device smartq_backlight_device = {
	164	.name = "pwm-backlight",
	165	.dev = {
7fa33bdb	166	.parent = &samsung_device_pwm.dev,
a2f7bffa MC	167	.platform_data = &smartq_backlight_data,
	168	},
	169	};
	170
	171	static struct s3c2410_ts_mach_info smartq_touchscreen_pdata __initdata = {
	172	.delay = 65535,
	173	.presc = 99,
	174	.oversampling_shift = 4,
	175	};
	176
	177	static struct s3c_sdhci_platdata smartq_internal_hsmmc_pdata = {
	178	.max_width = 4,
eeda5fcb	179	.cd_type = S3C_SDHCI_CD_PERMANENT,
a2f7bffa MC	180	};
	181
	182	static struct s3c_hwmon_pdata smartq_hwmon_pdata __initdata = {
	183	/* Battery voltage (?-4.2V) */
	184	.in[0] = &(struct s3c_hwmon_chcfg) {
	185	.name = "smartq:battery-voltage",
	186	.mult = 3300,
	187	.div = 2048,
	188	},
	189	/* Reference voltage (1.2V) */
	190	.in[1] = &(struct s3c_hwmon_chcfg) {
	191	.name = "smartq:reference-voltage",
	192	.mult = 3300,
	193	.div = 4096,
	194	},
	195	};
	196
1f91b4cc	197	static struct dwc2_hsotg_plat smartq_hsotg_pdata;
99f6e1f5	198
49f91b9e MC	199	static int __init smartq_lcd_setup_gpio(void)
	200	{
	201	int ret;
	202
	203	ret = gpio_request(S3C64XX_GPM(3), "LCD power");
	204	if (ret < 0)
	205	return ret;
	206
	207	/* turn power off */
	208	gpio_direction_output(S3C64XX_GPM(3), 0);
	209
	210	return 0;
	211	}
	212
	213	/* GPM0 -> CS */
	214	static struct spi_gpio_platform_data smartq_lcd_control = {
	215	.sck = S3C64XX_GPM(1),
	216	.mosi = S3C64XX_GPM(2),
	217	.miso = S3C64XX_GPM(2),
	218	};
	219
	220	static struct platform_device smartq_lcd_control_device = {
	221	.name = "spi-gpio",
	222	.id = 1,
	223	.dev.platform_data = &smartq_lcd_control,
	224	};
	225
a2f7bffa MC	226	static void smartq_lcd_power_set(struct plat_lcd_data *pd, unsigned int power)
	227	{
	228	gpio_direction_output(S3C64XX_GPM(3), power);
	229	}
	230
	231	static struct plat_lcd_data smartq_lcd_power_data = {
	232	.set_power = smartq_lcd_power_set,
	233	};
	234
	235	static struct platform_device smartq_lcd_power_device = {
	236	.name = "platform-lcd",
	237	.dev.parent = &s3c_device_fb.dev,
	238	.dev.platform_data = &smartq_lcd_power_data,
	239	};
	240
4e13c0ea MC	241	static struct i2c_board_info smartq_i2c_devs[] __initdata = {
	242	{ I2C_BOARD_INFO("wm8987", 0x1a), },
	243	};
	244
a2f7bffa MC	245	static struct platform_device *smartq_devices[] __initdata = {
	246	&s3c_device_hsmmc1, /* Init iNAND first, ... */
	247	&s3c_device_hsmmc0, /* ... then the external SD card */
	248	&s3c_device_hsmmc2,
	249	&s3c_device_adc,
	250	&s3c_device_fb,
	251	&s3c_device_hwmon,
	252	&s3c_device_i2c0,
	253	&s3c_device_ohci,
	254	&s3c_device_rtc,
7fa33bdb	255	&samsung_device_pwm,
a2f7bffa MC	256	&s3c_device_ts,
a2f7bffa MC	257	&s3c_device_usb_hsotg,
4e13c0ea	258	&s3c64xx_device_iis0,
a2f7bffa	259	&smartq_backlight_device,
49f91b9e	260	&smartq_lcd_control_device,
a2f7bffa MC	261	&smartq_lcd_power_device,
	262	&smartq_usb_otg_vbus_dev,
	263	};
	264
	265	static void __init smartq_lcd_mode_set(void)
	266	{
	267	u32 tmp;
	268
	269	/* set the LCD type */
	270	tmp = __raw_readl(S3C64XX_SPCON);
	271	tmp &= ~S3C64XX_SPCON_LCD_SEL_MASK;
	272	tmp \|= S3C64XX_SPCON_LCD_SEL_RGB;
	273	__raw_writel(tmp, S3C64XX_SPCON);
	274
	275	/* remove the LCD bypass */
	276	tmp = __raw_readl(S3C64XX_MODEM_MIFPCON);
	277	tmp &= ~MIFPCON_LCD_BYPASS;
	278	__raw_writel(tmp, S3C64XX_MODEM_MIFPCON);
	279	}
	280
	281	static void smartq_power_off(void)
	282	{
	283	gpio_direction_output(S3C64XX_GPK(15), 1);
	284	}
	285
	286	static int __init smartq_power_off_init(void)
	287	{
	288	int ret;
	289
	290	ret = gpio_request(S3C64XX_GPK(15), "Power control");
	291	if (ret < 0) {
	292	pr_err("%s: failed to get GPK15\n", __func__);
	293	return ret;
	294	}
	295
	296	/* leave power on */
	297	gpio_direction_output(S3C64XX_GPK(15), 0);
	298
a2f7bffa MC	299	pm_power_off = smartq_power_off;
	300
	301	return ret;
	302	}
	303
	304	static int __init smartq_usb_host_init(void)
	305	{
	306	int ret;
	307
	308	ret = gpio_request(S3C64XX_GPL(0), "USB power control");
	309	if (ret < 0) {
	310	pr_err("%s: failed to get GPL0\n", __func__);
	311	return ret;
	312	}
	313
	314	ret = gpio_request(S3C64XX_GPL(1), "USB host power control");
	315	if (ret < 0) {
	316	pr_err("%s: failed to get GPL1\n", __func__);
	317	goto err;
	318	}
	319
	320	if (!machine_is_smartq5()) {
	321	/* This isn't present on a SmartQ 5 board */
	322	ret = gpio_request(S3C64XX_GPL(10), "USB host overcurrent");
	323	if (ret < 0) {
	324	pr_err("%s: failed to get GPL10\n", __func__);
	325	goto err2;
	326	}
	327	}
	328
	329	/* turn power off */
	330	gpio_direction_output(S3C64XX_GPL(0), 0);
	331	gpio_direction_output(S3C64XX_GPL(1), 0);
	332	if (!machine_is_smartq5())
	333	gpio_direction_input(S3C64XX_GPL(10));
	334
	335	s3c_device_ohci.dev.platform_data = &smartq_usb_host_info;
	336
	337	return 0;
	338
	339	err2:
	340	gpio_free(S3C64XX_GPL(1));
	341	err:
	342	gpio_free(S3C64XX_GPL(0));
	343	return ret;
	344	}
	345
a2f7bffa MC	346	static int __init smartq_wifi_init(void)
	347	{
	348	int ret;
	349
	350	ret = gpio_request(S3C64XX_GPK(1), "wifi control");
	351	if (ret < 0) {
	352	pr_err("%s: failed to get GPK1\n", __func__);
	353	return ret;
	354	}
	355
	356	ret = gpio_request(S3C64XX_GPK(2), "wifi reset");
	357	if (ret < 0) {
	358	pr_err("%s: failed to get GPK2\n", __func__);
	359	gpio_free(S3C64XX_GPK(1));
	360	return ret;
	361	}
	362
	363	/* turn power on */
	364	gpio_direction_output(S3C64XX_GPK(1), 1);
	365
	366	/* reset device */
	367	gpio_direction_output(S3C64XX_GPK(2), 0);
	368	mdelay(100);
	369	gpio_set_value(S3C64XX_GPK(2), 1);
	370	gpio_direction_input(S3C64XX_GPK(2));
	371
	372	return 0;
	373	}
	374
	375	static struct map_desc smartq_iodesc[] __initdata = {};
	376	void __init smartq_map_io(void)
	377	{
	378	s3c64xx_init_io(smartq_iodesc, ARRAY_SIZE(smartq_iodesc));
b69f460d TF	379	s3c64xx_set_xtal_freq(12000000);
b69f460d TF	380	s3c64xx_set_xusbxti_freq(12000000);
a2f7bffa	381	s3c24xx_init_uarts(smartq_uartcfgs, ARRAY_SIZE(smartq_uartcfgs));
04a49b71	382	samsung_set_timer_source(SAMSUNG_PWM3, SAMSUNG_PWM4);
a2f7bffa MC	383
	384	smartq_lcd_mode_set();
	385	}
	386
df0cc2d1 AB	387	static struct gpiod_lookup_table smartq_audio_gpios = {
	388	.dev_id = "smartq-audio",
	389	.table = {
	390	GPIO_LOOKUP("GPL", 12, "headphone detect", 0),
	391	GPIO_LOOKUP("GPK", 12, "amplifiers shutdown", 0),
	392	{ },
	393	},
	394	};
	395
a2f7bffa MC	396	void __init smartq_machine_init(void)
	397	{
	398	s3c_i2c0_set_platdata(NULL);
1f91b4cc	399	dwc2_hsotg_set_platdata(&smartq_hsotg_pdata);
a2f7bffa MC	400	s3c_hwmon_set_platdata(&smartq_hwmon_pdata);
	401	s3c_sdhci1_set_platdata(&smartq_internal_hsmmc_pdata);
	402	s3c_sdhci2_set_platdata(&smartq_internal_hsmmc_pdata);
	403	s3c24xx_ts_set_platdata(&smartq_touchscreen_pdata);
	404
4e13c0ea MC	405	i2c_register_board_info(0, smartq_i2c_devs,
	406	ARRAY_SIZE(smartq_i2c_devs));
	407
49f91b9e	408	WARN_ON(smartq_lcd_setup_gpio());
a2f7bffa MC	409	WARN_ON(smartq_power_off_init());
a2f7bffa MC	410	WARN_ON(smartq_usb_host_init());
a2f7bffa MC	411	WARN_ON(smartq_wifi_init());
a2f7bffa MC	412
4dddfb88	413	pwm_add_table(smartq_pwm_lookup, ARRAY_SIZE(smartq_pwm_lookup));
a2f7bffa	414	platform_add_devices(smartq_devices, ARRAY_SIZE(smartq_devices));
df0cc2d1 AB	415
	416	gpiod_add_lookup_table(&smartq_audio_gpios);
	417	platform_device_register_simple("smartq-audio", -1, NULL, 0);
a2f7bffa	418	}