dirty fix to merging

1 files changed, 311 insertions, 0 deletions

diff --git a/drivers/video/wmt/devices/lcd-setup.c b/drivers/video/wmt/devices/lcd-setup.c
new file mode 100755
index 00000000..798f020e
--- /dev/null
+++ b/drivers/video/wmt/devices/lcd-setup.c
@@ -0,0 +1,311 @@
+/*
+ * ==========================================================================
+ *
+ *       Filename:  lcd-setup.c
+ *
+ *    Description:  
+ *
+ *        Version:  0.01
+ *        Created:  2014.6.6
+ *
+ *        Author:  SamMei
+ *        Company:  
+ *
+ * ==========================================================================
+ */
+
+#include <linux/delay.h>
+#include <linux/spi/spi.h>
+#include <linux/i2c.h>
+#include <mach/hardware.h>
+#include <mach/wmt-spi.h>
+#include <linux/gpio.h>
+#include <mach/wmt_iomux.h>
+#include "../lcd.h"
+
+#define DRIVERNAME	"lcd-setup"
+
+#undef pr_err
+#undef pr_info
+#undef pr_warning
+#define pr_err(fmt, args...)		printk("[" DRIVERNAME "] " fmt, ##args)
+#define pr_info(fmt, args...)		printk("[" DRIVERNAME "] " fmt, ##args)
+#define pr_warning(fmt, args...)	printk("[" DRIVERNAME "] " fmt, ##args)
+
+enum {
+	LCD_SETUP_TS8224B,                      /* spi init */
+	LCD_SETUP_CHUNGHWA,                     /* i2c init */
+	LCD_SETUP_MAX,
+};
+
+static int lcd_setup_id = -1;
+struct spi_device *g_spi_device;
+
+static int wmt_lcd_setup_id(void)
+{
+	char buf[32];
+	int len = sizeof(buf);
+	int id;
+
+	if (wmt_getsyspara("wmt.lcd.setup", buf, &len))
+		id = -ENODEV;
+	sscanf(buf, "%d", &id);
+	return id;
+}
+
+static inline void spi_ctrl_9bit_tx(u8 val, int cmd_data)
+{
+	uint8_t buf[2];
+
+	if (cmd_data)
+		buf[0] = (val >> 1) | BIT7;
+	else
+		buf[0] = (val >> 1) & 0x7f;
+
+	buf[1] = (val << 7);
+
+	spi_write(g_spi_device, buf, sizeof(buf));
+}
+
+static inline void spi_9bit_tx(u8 val, int cmd_data)
+{
+	spi_ctrl_9bit_tx(val, cmd_data);
+}
+
+static inline int ts8224b_cmd(u8 cmd)
+{
+	spi_9bit_tx(cmd, 0);
+	return 0;
+}
+
+static inline int ts8224b_data(u8 data)
+{
+	spi_9bit_tx(data, 1);
+	return 0;
+}
+
+static int ts8224b_init(void)
+{
+	static uint16_t settings[] = {
+		#include "ts8224b.h"
+	};
+	int i;
+
+	printk(" ## %s, %d\n", __func__, __LINE__);
+
+	for (i = 0; i < ARRAY_SIZE(settings); i += 2) {
+		ts8224b_cmd(settings[i] >> 8);
+		ts8224b_data(settings[i+1]);
+	}
+
+	ts8224b_cmd(0x11);
+	msleep(120);
+
+	ts8224b_cmd(0x29);
+	msleep(50);
+	ts8224b_cmd(0x2c);
+	return 0;
+}
+
+extern void lcd_power_on(bool on);
+
+//int lcd_spi_resume(struct spi_device *spi)
+int lcd_spi_resume(void)
+{
+	//printk(" ## %s, %d\n", __func__, __LINE__);
+	switch (lcd_setup_id) {
+	case LCD_SETUP_TS8224B:
+		printk(" ## %s, %d\n", __func__, __LINE__);
+		lcd_power_on(1);
+		mdelay(5);
+		return ts8224b_init();
+	default:
+		return 0;
+	}
+}
+
+static int __devinit lcd_spi_probe(struct spi_device *spi)
+{
+	g_spi_device = spi;
+
+	//lcd_spi_resume();
+
+	return 0;
+}
+
+static struct spi_driver lcd_spi_driver = {
+	.driver = {
+		.name = DRIVERNAME,
+		.owner = THIS_MODULE,
+	},
+	.probe = lcd_spi_probe,
+	//.resume = lcd_spi_resume,
+};
+
+static struct spi_board_info lcd_spi_info[] __initdata = {
+	{
+		.modalias	= DRIVERNAME,
+		.bus_num	= 0,
+		.chip_select	= 0,
+		.max_speed_hz	= 12000000,
+		.irq		= -1,
+		.mode		= SPI_CLK_MODE1,
+	},
+};
+
+
+// I2C
+
+static int lcd_i2c_resume(struct i2c_client *client)
+{
+	static uint8_t init_data[] = {
+		0x4b, 0x01,
+		0x0c, 0x01,
+		0x05, 0x03,
+		0x41, 0x03,
+		0x10, 0x06,
+		0x11, 0xE0,
+		0x12, 0x00,
+		0x13, 0x3C,
+		0x14, 0x06,
+		0x15, 0x40,
+		0x16, 0x03,
+		0x17, 0x9E,
+		0x18, 0x00,
+		0x19, 0x10,
+		0x1a, 0x03,
+		0x1b, 0x84,
+		0x1c, 0x80,
+		0x1d, 0x0A,
+		0x1e, 0x80,
+		0x1f, 0x06,
+		0x3c, 0x17,
+		0x3e, 0x16,
+		0x36, 0x00,
+		0x31, 0x00,
+		0x35, 0x41,
+		0x30, 0xB0,
+		0x30, 0xB1,
+		0x00, 0x0B,
+	};
+
+	int i, ret;
+
+	printk(" ## %s, %d\n", __FUNCTION__, __LINE__);
+	for (i = 0; i < ARRAY_SIZE(init_data); i += 2) {
+		ret = i2c_master_send(client, &init_data[i], 2);
+		if (ret < 0)
+			return ret;
+	}
+	return 0;
+}
+
+static int __devinit lcd_i2c_probe(struct i2c_client *client,
+				   const struct i2c_device_id *id)
+{
+	printk(" ## %s, %d\n", __FUNCTION__, __LINE__);
+	return 0;
+}
+
+static const struct i2c_device_id lcd_i2c_id[] = {
+	{ "lcd-i2c", 0 },
+	{ },
+};
+
+static struct i2c_driver lcd_i2c_driver = {
+	.driver    = {
+		.name  = "lcd-i2c",
+		.owner = THIS_MODULE,
+	},
+	.probe     = lcd_i2c_probe,
+//	.remove    = __devexit_p(lcd_i2c_remove),
+//	.suspend   = lcd_i2c_suspend,
+	.resume    = lcd_i2c_resume,
+//	.shutdown  = lcd_i2c_shutdown,
+	.id_table  = lcd_i2c_id,
+};
+
+static struct i2c_board_info lcd_i2c_board_info = {
+	.type          = "lcd-i2c",
+	.flags         = 0x00,
+	.addr          = 0xe0 >> 1,
+	.platform_data = NULL,
+	.archdata      = NULL,
+	.irq           = -1,
+};
+
+static struct i2c_client *i2c_client;
+static struct i2c_adapter *i2c_adap;
+
+static int __init lcd_setup_init(void)
+{
+	int ret;
+
+	lcd_setup_id = wmt_lcd_setup_id();
+	switch (lcd_setup_id) {
+
+	// SPI
+	case LCD_SETUP_TS8224B:
+		ret = spi_register_board_info(lcd_spi_info, ARRAY_SIZE(lcd_spi_info));
+		if (ret) {
+			pr_err("spi_register_board_info failed\n");
+			return ret;
+		}
+
+		ret = spi_register_driver(&lcd_spi_driver);
+		if (ret) {
+			pr_err("spi_register_driver failed\n");
+			return ret;
+		}
+
+		pr_info("spi %s register success\n", DRIVERNAME);
+		return 0;
+
+	// I2C
+	case LCD_SETUP_CHUNGHWA:
+		printk(" ## %s, %d\n", __FUNCTION__, __LINE__);
+		i2c_adap = i2c_get_adapter(1);
+		if (!i2c_adap) {
+			pr_err("Cannot get i2c adapter 1\n");
+			return -ENODEV;
+		}
+
+		i2c_client = i2c_new_device(i2c_adap, &lcd_i2c_board_info);
+		if (!i2c_client) {
+			pr_err("Unable to add I2C device for 0x%x\n",
+			       lcd_i2c_board_info.addr);
+			return -ENODEV;
+		}
+
+		return i2c_add_driver(&lcd_i2c_driver);
+
+	// INVALID
+	default:
+		return -EINVAL;
+	}
+}
+
+static void lcd_setup_exit(void)
+{
+	switch (lcd_setup_id) {
+
+	// SPI
+	case LCD_SETUP_TS8224B:
+		spi_unregister_driver(&lcd_spi_driver);
+		break;
+
+	// I2C
+	case LCD_SETUP_CHUNGHWA:
+		i2c_put_adapter(i2c_adap);
+		i2c_del_driver(&lcd_i2c_driver);
+		i2c_unregister_device(i2c_client);
+		break;
+
+	// INVALID
+	default:
+		return;
+	}
+}
+
+module_init(lcd_setup_init);
+module_exit(lcd_setup_exit);