/* Copyright Statement:
*
* This software/firmware and related documentation ("MediaTek Software") are
* protected under relevant copyright laws. The information contained herein
* is confidential and proprietary to MediaTek Inc. and/or its licensors.
* Without the prior written permission of MediaTek inc. and/or its licensors,
* any reproduction, modification, use or disclosure of MediaTek Software,
* and information contained herein, in whole or in part, shall be strictly prohibited.
*/
/* MediaTek Inc. (C) 2015. All rights reserved.
*
* BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
* AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
* NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
* SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
* SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
* THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
* THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
* CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
* SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
* STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
* CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
* AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
* OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
* MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
*/
#ifdef BUILD_LK
#include <stdio.h>
#include <string.h>
#else
#include <linux/string.h>
#include <linux/kernel.h>
#endif

#include "lcm_drv.h"


// ---------------------------------------------------------------------------
//  Local Constants
// ---------------------------------------------------------------------------

//#define ESD_SUPPORT

#define FRAME_WIDTH  (480)
#define FRAME_HEIGHT (800)
#define LCM_ID       (0x5510)

#ifndef TRUE
#define TRUE 1
#endif

#ifndef FALSE
#define FALSE 0
#endif

#ifdef BUILD_LK
#define LCM_PRINT printf
#else
#define LCM_PRINT printk
#endif

// ---------------------------------------------------------------------------
//  Local Variables
// ---------------------------------------------------------------------------

static LCM_UTIL_FUNCS lcm_util;

#define SET_RESET_PIN(v)    (lcm_util.set_reset_pin((v)))

#define UDELAY(n) (lcm_util.udelay(n))
#define MDELAY(n) (lcm_util.mdelay(n))


// ---------------------------------------------------------------------------
//  Local Functions
// ---------------------------------------------------------------------------

static __inline void send_ctrl_cmd(unsigned int cmd)
{
	lcm_util.send_cmd(cmd);
}


static __inline void send_data_cmd(unsigned int data)
{
	lcm_util.send_data(data & 0xFF);
}


static __inline unsigned int read_data_cmd(void)
{
	return 0xFFFF & lcm_util.read_data();
}


static __inline void set_lcm_register(unsigned int regIndex,
                                      unsigned int regData)
{
	send_ctrl_cmd(regIndex);
	send_data_cmd(regData);
}


static void init_lcm_registers(void)
{
	//PAGE1
	set_lcm_register(0xF000, 0x55);
	set_lcm_register(0xF001, 0xAA);
	set_lcm_register(0xF002, 0x52);
	set_lcm_register(0xF003, 0x08);
	set_lcm_register(0xF004, 0x01);

	//AVDD Set AVDD 5.2V
	set_lcm_register(0xB000, 0x0D);
	set_lcm_register(0xB001, 0x0D);
	set_lcm_register(0xB002, 0x0D);

	//AVDD ratio
	set_lcm_register(0xB600, 0x34);
	set_lcm_register(0xB601, 0x34);
	set_lcm_register(0xB602, 0x34);

	//AVEE  -5.2V
	set_lcm_register(0xB100, 0x0D);
	set_lcm_register(0xB101, 0x0D);
	set_lcm_register(0xB102, 0x0D);

	//AVEE ratio
	set_lcm_register(0xB700, 0x34);
	set_lcm_register(0xB701, 0x34);
	set_lcm_register(0xB702, 0x34);

	//VCL  -2.5V
	set_lcm_register(0xB200, 0x00);
	set_lcm_register(0xB201, 0x00);
	set_lcm_register(0xB202, 0x00);

	//VCL ratio
	set_lcm_register(0xB800, 0x24);
	set_lcm_register(0xB801, 0x24);
	set_lcm_register(0xB802, 0x24);

	//VGH 15V  (Free pump)
	set_lcm_register(0xBF00, 0x01);

	//VGH=15V(1V/step)  Free pump
	set_lcm_register(0xB300, 0x0F);
	set_lcm_register(0xB301, 0x0F);
	set_lcm_register(0xB302, 0x0F);

	//VGH ratio
	set_lcm_register(0xB900, 0x34);
	set_lcm_register(0xB901, 0x34);
	set_lcm_register(0xB902, 0x34);

	//VGL_REG -10V
	set_lcm_register(0xB500, 0x08);
	set_lcm_register(0xB501, 0x08);
	set_lcm_register(0xB502, 0x08);

	set_lcm_register(0xC200, 0x03);

	//VGLX ratio
	set_lcm_register(0xBA00, 0x24);
	set_lcm_register(0xBA01, 0x24);
	set_lcm_register(0xBA02, 0x24);

	//VGMP/VGSP 4.5V/0V
	set_lcm_register(0xBC00, 0x00);
	set_lcm_register(0xBC01, 0x78);
	set_lcm_register(0xBC02, 0x00);

	//VGMN/VGSN -4.5V/0V
	set_lcm_register(0xBD00, 0x00);
	set_lcm_register(0xBD01, 0x78);
	set_lcm_register(0xBD02, 0x00);

	//VCOM
	set_lcm_register(0xBE00, 0x00);
	set_lcm_register(0xBE01, 0x64);

	//Gamma Setting
	set_lcm_register(0xD100, 0x00);
	set_lcm_register(0xD101, 0x33);
	set_lcm_register(0xD102, 0x00);
	set_lcm_register(0xD103, 0x34);
	set_lcm_register(0xD104, 0x00);
	set_lcm_register(0xD105, 0x3A);
	set_lcm_register(0xD106, 0x00);
	set_lcm_register(0xD107, 0x4A);
	set_lcm_register(0xD108, 0x00);
	set_lcm_register(0xD109, 0x5C);
	set_lcm_register(0xD10A, 0x00);
	set_lcm_register(0xD10B, 0x81);
	set_lcm_register(0xD10C, 0x00);
	set_lcm_register(0xD10D, 0xA6);
	set_lcm_register(0xD10E, 0x00);
	set_lcm_register(0xD10F, 0xE5);
	set_lcm_register(0xD110, 0x01);
	set_lcm_register(0xD111, 0x13);
	set_lcm_register(0xD112, 0x01);
	set_lcm_register(0xD113, 0x54);
	set_lcm_register(0xD114, 0x01);
	set_lcm_register(0xD115, 0x82);
	set_lcm_register(0xD116, 0x01);
	set_lcm_register(0xD117, 0xCA);
	set_lcm_register(0xD118, 0x02);
	set_lcm_register(0xD119, 0x00);
	set_lcm_register(0xD11A, 0x02);
	set_lcm_register(0xD11B, 0x01);
	set_lcm_register(0xD11C, 0x02);
	set_lcm_register(0xD11D, 0x34);
	set_lcm_register(0xD11E, 0x02);
	set_lcm_register(0xD11F, 0x67);
	set_lcm_register(0xD120, 0x02);
	set_lcm_register(0xD121, 0x84);
	set_lcm_register(0xD122, 0x02);
	set_lcm_register(0xD123, 0xA4);
	set_lcm_register(0xD124, 0x02);
	set_lcm_register(0xD125, 0xB7);
	set_lcm_register(0xD126, 0x02);
	set_lcm_register(0xD127, 0xCF);
	set_lcm_register(0xD128, 0x02);
	set_lcm_register(0xD129, 0xDE);
	set_lcm_register(0xD12A, 0x02);
	set_lcm_register(0xD12B, 0xF2);
	set_lcm_register(0xD12C, 0x02);
	set_lcm_register(0xD12D, 0xFE);
	set_lcm_register(0xD12E, 0x03);
	set_lcm_register(0xD12F, 0x10);
	set_lcm_register(0xD130, 0x03);
	set_lcm_register(0xD131, 0x33);
	set_lcm_register(0xD132, 0x03);
	set_lcm_register(0xD133, 0x6D);

	//Gamma (G+)
	set_lcm_register(0xD200, 0x00);
	set_lcm_register(0xD201, 0x33);
	set_lcm_register(0xD202, 0x00);
	set_lcm_register(0xD203, 0x34);
	set_lcm_register(0xD204, 0x00);
	set_lcm_register(0xD205, 0x3A);
	set_lcm_register(0xD206, 0x00);
	set_lcm_register(0xD207, 0x4A);
	set_lcm_register(0xD208, 0x00);
	set_lcm_register(0xD209, 0x5C);
	set_lcm_register(0xD20A, 0x00);
	set_lcm_register(0xD20B, 0x81);
	set_lcm_register(0xD20C, 0x00);
	set_lcm_register(0xD20D, 0xA6);
	set_lcm_register(0xD20E, 0x00);
	set_lcm_register(0xD20F, 0xE5);
	set_lcm_register(0xD210, 0x01);
	set_lcm_register(0xD211, 0x13);
	set_lcm_register(0xD212, 0x01);
	set_lcm_register(0xD213, 0x54);
	set_lcm_register(0xD214, 0x01);
	set_lcm_register(0xD215, 0x82);
	set_lcm_register(0xD216, 0x01);
	set_lcm_register(0xD217, 0xCA);
	set_lcm_register(0xD218, 0x02);
	set_lcm_register(0xD219, 0x00);
	set_lcm_register(0xD21A, 0x02);
	set_lcm_register(0xD21B, 0x01);
	set_lcm_register(0xD21C, 0x02);
	set_lcm_register(0xD21D, 0x34);
	set_lcm_register(0xD21E, 0x02);
	set_lcm_register(0xD21F, 0x67);
	set_lcm_register(0xD220, 0x02);
	set_lcm_register(0xD221, 0x84);
	set_lcm_register(0xD222, 0x02);
	set_lcm_register(0xD223, 0xA4);
	set_lcm_register(0xD224, 0x02);
	set_lcm_register(0xD225, 0xB7);
	set_lcm_register(0xD226, 0x02);
	set_lcm_register(0xD227, 0xCF);
	set_lcm_register(0xD228, 0x02);
	set_lcm_register(0xD229, 0xDE);
	set_lcm_register(0xD22A, 0x02);
	set_lcm_register(0xD22B, 0xF2);
	set_lcm_register(0xD22C, 0x02);
	set_lcm_register(0xD22D, 0xFE);
	set_lcm_register(0xD22E, 0x03);
	set_lcm_register(0xD22F, 0x10);
	set_lcm_register(0xD230, 0x03);
	set_lcm_register(0xD231, 0x33);
	set_lcm_register(0xD232, 0x03);
	set_lcm_register(0xD233, 0x6D);

	//Gamma (B+)
	set_lcm_register(0xD300, 0x00);
	set_lcm_register(0xD301, 0x33);
	set_lcm_register(0xD302, 0x00);
	set_lcm_register(0xD303, 0x34);
	set_lcm_register(0xD304, 0x00);
	set_lcm_register(0xD305, 0x3A);
	set_lcm_register(0xD306, 0x00);
	set_lcm_register(0xD307, 0x4A);
	set_lcm_register(0xD308, 0x00);
	set_lcm_register(0xD309, 0x5C);
	set_lcm_register(0xD30A, 0x00);
	set_lcm_register(0xD30B, 0x81);
	set_lcm_register(0xD30C, 0x00);
	set_lcm_register(0xD30D, 0xA6);
	set_lcm_register(0xD30E, 0x00);
	set_lcm_register(0xD30F, 0xE5);
	set_lcm_register(0xD310, 0x01);
	set_lcm_register(0xD311, 0x13);
	set_lcm_register(0xD312, 0x01);
	set_lcm_register(0xD313, 0x54);
	set_lcm_register(0xD314, 0x01);
	set_lcm_register(0xD315, 0x82);
	set_lcm_register(0xD316, 0x01);
	set_lcm_register(0xD317, 0xCA);
	set_lcm_register(0xD318, 0x02);
	set_lcm_register(0xD319, 0x00);
	set_lcm_register(0xD31A, 0x02);
	set_lcm_register(0xD31B, 0x01);
	set_lcm_register(0xD31C, 0x02);
	set_lcm_register(0xD31D, 0x34);
	set_lcm_register(0xD31E, 0x02);
	set_lcm_register(0xD31F, 0x67);
	set_lcm_register(0xD320, 0x02);
	set_lcm_register(0xD321, 0x84);
	set_lcm_register(0xD322, 0x02);
	set_lcm_register(0xD323, 0xA4);
	set_lcm_register(0xD324, 0x02);
	set_lcm_register(0xD325, 0xB7);
	set_lcm_register(0xD326, 0x02);
	set_lcm_register(0xD327, 0xCF);
	set_lcm_register(0xD328, 0x02);
	set_lcm_register(0xD329, 0xDE);
	set_lcm_register(0xD32A, 0x02);
	set_lcm_register(0xD32B, 0xF2);
	set_lcm_register(0xD32C, 0x02);
	set_lcm_register(0xD32D, 0xFE);
	set_lcm_register(0xD32E, 0x03);
	set_lcm_register(0xD32F, 0x10);
	set_lcm_register(0xD330, 0x03);
	set_lcm_register(0xD331, 0x33);
	set_lcm_register(0xD332, 0x03);
	set_lcm_register(0xD333, 0x6D);

	//Gamma (R-)
	set_lcm_register(0xD400, 0x00);
	set_lcm_register(0xD401, 0x33);
	set_lcm_register(0xD402, 0x00);
	set_lcm_register(0xD403, 0x34);
	set_lcm_register(0xD404, 0x00);
	set_lcm_register(0xD405, 0x3A);
	set_lcm_register(0xD406, 0x00);
	set_lcm_register(0xD407, 0x4A);
	set_lcm_register(0xD408, 0x00);
	set_lcm_register(0xD409, 0x5C);
	set_lcm_register(0xD40A, 0x00);
	set_lcm_register(0xD40B, 0x81);
	set_lcm_register(0xD40C, 0x00);
	set_lcm_register(0xD40D, 0xA6);
	set_lcm_register(0xD40E, 0x00);
	set_lcm_register(0xD40F, 0xE5);
	set_lcm_register(0xD410, 0x01);
	set_lcm_register(0xD411, 0x13);
	set_lcm_register(0xD412, 0x01);
	set_lcm_register(0xD413, 0x54);
	set_lcm_register(0xD414, 0x01);
	set_lcm_register(0xD415, 0x82);
	set_lcm_register(0xD416, 0x01);
	set_lcm_register(0xD417, 0xCA);
	set_lcm_register(0xD418, 0x02);
	set_lcm_register(0xD419, 0x00);
	set_lcm_register(0xD41A, 0x02);
	set_lcm_register(0xD41B, 0x01);
	set_lcm_register(0xD41C, 0x02);
	set_lcm_register(0xD41D, 0x34);
	set_lcm_register(0xD41E, 0x02);
	set_lcm_register(0xD41F, 0x67);
	set_lcm_register(0xD420, 0x02);
	set_lcm_register(0xD421, 0x84);
	set_lcm_register(0xD422, 0x02);
	set_lcm_register(0xD423, 0xA4);
	set_lcm_register(0xD424, 0x02);
	set_lcm_register(0xD425, 0xB7);
	set_lcm_register(0xD426, 0x02);
	set_lcm_register(0xD427, 0xCF);
	set_lcm_register(0xD428, 0x02);
	set_lcm_register(0xD429, 0xDE);
	set_lcm_register(0xD42A, 0x02);
	set_lcm_register(0xD42B, 0xF2);
	set_lcm_register(0xD42C, 0x02);
	set_lcm_register(0xD42D, 0xFE);
	set_lcm_register(0xD42E, 0x03);
	set_lcm_register(0xD42F, 0x10);
	set_lcm_register(0xD430, 0x03);
	set_lcm_register(0xD431, 0x33);
	set_lcm_register(0xD432, 0x03);
	set_lcm_register(0xD433, 0x6D);

	//Gamma (G+)
	set_lcm_register(0xD500, 0x00);
	set_lcm_register(0xD501, 0x33);
	set_lcm_register(0xD502, 0x00);
	set_lcm_register(0xD503, 0x34);
	set_lcm_register(0xD504, 0x00);
	set_lcm_register(0xD505, 0x3A);
	set_lcm_register(0xD506, 0x00);
	set_lcm_register(0xD507, 0x4A);
	set_lcm_register(0xD508, 0x00);
	set_lcm_register(0xD509, 0x5C);
	set_lcm_register(0xD50A, 0x00);
	set_lcm_register(0xD50B, 0x81);
	set_lcm_register(0xD50C, 0x00);
	set_lcm_register(0xD50D, 0xA6);
	set_lcm_register(0xD50E, 0x00);
	set_lcm_register(0xD50F, 0xE5);
	set_lcm_register(0xD510, 0x01);
	set_lcm_register(0xD511, 0x13);
	set_lcm_register(0xD512, 0x01);
	set_lcm_register(0xD513, 0x54);
	set_lcm_register(0xD514, 0x01);
	set_lcm_register(0xD515, 0x82);
	set_lcm_register(0xD516, 0x01);
	set_lcm_register(0xD517, 0xCA);
	set_lcm_register(0xD518, 0x02);
	set_lcm_register(0xD519, 0x00);
	set_lcm_register(0xD51A, 0x02);
	set_lcm_register(0xD51B, 0x01);
	set_lcm_register(0xD51C, 0x02);
	set_lcm_register(0xD51D, 0x34);
	set_lcm_register(0xD51E, 0x02);
	set_lcm_register(0xD51F, 0x67);
	set_lcm_register(0xD520, 0x02);
	set_lcm_register(0xD521, 0x84);
	set_lcm_register(0xD522, 0x02);
	set_lcm_register(0xD523, 0xA4);
	set_lcm_register(0xD524, 0x02);
	set_lcm_register(0xD525, 0xB7);
	set_lcm_register(0xD526, 0x02);
	set_lcm_register(0xD527, 0xCF);
	set_lcm_register(0xD528, 0x02);
	set_lcm_register(0xD529, 0xDE);
	set_lcm_register(0xD52A, 0x02);
	set_lcm_register(0xD52B, 0xF2);
	set_lcm_register(0xD52C, 0x02);
	set_lcm_register(0xD52D, 0xFE);
	set_lcm_register(0xD52E, 0x03);
	set_lcm_register(0xD52F, 0x10);
	set_lcm_register(0xD530, 0x03);
	set_lcm_register(0xD531, 0x33);
	set_lcm_register(0xD532, 0x03);
	set_lcm_register(0xD533, 0x6D);

	//Gamma (B+)
	set_lcm_register(0xD600, 0x00);
	set_lcm_register(0xD601, 0x33);
	set_lcm_register(0xD602, 0x00);
	set_lcm_register(0xD603, 0x34);
	set_lcm_register(0xD604, 0x00);
	set_lcm_register(0xD605, 0x3A);
	set_lcm_register(0xD606, 0x00);
	set_lcm_register(0xD607, 0x4A);
	set_lcm_register(0xD608, 0x00);
	set_lcm_register(0xD609, 0x5C);
	set_lcm_register(0xD60A, 0x00);
	set_lcm_register(0xD60B, 0x81);
	set_lcm_register(0xD60C, 0x00);
	set_lcm_register(0xD60D, 0xA6);
	set_lcm_register(0xD60E, 0x00);
	set_lcm_register(0xD60F, 0xE5);
	set_lcm_register(0xD610, 0x01);
	set_lcm_register(0xD611, 0x13);
	set_lcm_register(0xD612, 0x01);
	set_lcm_register(0xD613, 0x54);
	set_lcm_register(0xD614, 0x01);
	set_lcm_register(0xD615, 0x82);
	set_lcm_register(0xD616, 0x01);
	set_lcm_register(0xD617, 0xCA);
	set_lcm_register(0xD618, 0x02);
	set_lcm_register(0xD619, 0x00);
	set_lcm_register(0xD61A, 0x02);
	set_lcm_register(0xD61B, 0x01);
	set_lcm_register(0xD61C, 0x02);
	set_lcm_register(0xD61D, 0x34);
	set_lcm_register(0xD61E, 0x02);
	set_lcm_register(0xD61F, 0x67);
	set_lcm_register(0xD620, 0x02);
	set_lcm_register(0xD621, 0x84);
	set_lcm_register(0xD622, 0x02);
	set_lcm_register(0xD623, 0xA4);
	set_lcm_register(0xD624, 0x02);
	set_lcm_register(0xD625, 0xB7);
	set_lcm_register(0xD626, 0x02);
	set_lcm_register(0xD627, 0xCF);
	set_lcm_register(0xD628, 0x02);
	set_lcm_register(0xD629, 0xDE);
	set_lcm_register(0xD62A, 0x02);
	set_lcm_register(0xD62B, 0xF2);
	set_lcm_register(0xD62C, 0x02);
	set_lcm_register(0xD62D, 0xFE);
	set_lcm_register(0xD62E, 0x03);
	set_lcm_register(0xD62F, 0x10);
	set_lcm_register(0xD630, 0x03);
	set_lcm_register(0xD631, 0x33);
	set_lcm_register(0xD632, 0x03);
	set_lcm_register(0xD633, 0x6D);

	//LV2 Page 0 enable
	set_lcm_register(0xF000, 0x55);
	set_lcm_register(0xF001, 0xAA);
	set_lcm_register(0xF002, 0x52);
	set_lcm_register(0xF003, 0x08);
	set_lcm_register(0xF004, 0x00);

	//Display control
	set_lcm_register(0xB100, 0x40);
	set_lcm_register(0xB101, 0x00);

	set_lcm_register(0xB600, 0x05);

	//Gate EQ control
	set_lcm_register(0xB700, 0x70);
	set_lcm_register(0xB701, 0x70);

	//Source EQ control (Mode 2)
	set_lcm_register(0xB800, 0x01);
	set_lcm_register(0xB801, 0x03);
	set_lcm_register(0xB802, 0x03);
	set_lcm_register(0xB803, 0x03);

	//Inversion mode  (2-dot)
	set_lcm_register(0xBC00, 0x02);
	set_lcm_register(0xBC01, 0x00);
	set_lcm_register(0xBC02, 0x00);

	//Frame rate    (non-used)
	set_lcm_register(0xBD00, 0x01);
	set_lcm_register(0xBD01, 0x84);
	set_lcm_register(0xBD02, 0x14);
	set_lcm_register(0xBD03, 0x14);
	set_lcm_register(0xBD04, 0x00);

	set_lcm_register(0xBE00, 0x01);
	set_lcm_register(0xBE01, 0x84);
	set_lcm_register(0xBE02, 0x14);
	set_lcm_register(0xBE03, 0x14);
	set_lcm_register(0xBE04, 0x00);

	set_lcm_register(0xBF00, 0x01);
	set_lcm_register(0xBF01, 0x84);
	set_lcm_register(0xBF02, 0x14);
	set_lcm_register(0xBF03, 0x14);
	set_lcm_register(0xBF04, 0x00);

	//Timing control 4H w/ 4-delay
	set_lcm_register(0xC900, 0xD0);
	set_lcm_register(0xC901, 0x02);
	set_lcm_register(0xC902, 0x50);
	set_lcm_register(0xC903, 0x50);
	set_lcm_register(0xC904, 0x50);

	set_lcm_register(0x2A00, 0x00);
	set_lcm_register(0x2A01, 0x00);
	set_lcm_register(0x2A02, 0x01);
	set_lcm_register(0x2A03, 0xDF);

	set_lcm_register(0x2B00, 0x00);
	set_lcm_register(0x2B01, 0x00);
	set_lcm_register(0x2B02, 0x03);
	set_lcm_register(0x2B03, 0x1F);

	set_lcm_register(0x3500, 0x00);

	set_lcm_register(0x3A00, 0x55);    // RGB565

	//Sleep out
	send_ctrl_cmd(0x1100);
	MDELAY(120);

	//Display on
	send_ctrl_cmd(0x2900);
	MDELAY(30);
}


// ---------------------------------------------------------------------------
//  LCM Driver Implementations
// ---------------------------------------------------------------------------

static void lcm_set_util_funcs(const LCM_UTIL_FUNCS *util)
{
	memcpy(&lcm_util, util, sizeof(LCM_UTIL_FUNCS));
}


static void lcm_get_params(LCM_PARAMS *params)
{
	memset(params, 0, sizeof(LCM_PARAMS));

	params->type = LCM_TYPE_DBI;
	params->ctrl = LCM_CTRL_PARALLEL_DBI;
	params->width = FRAME_WIDTH;
	params->height = FRAME_HEIGHT;

	params->dbi.port = 0;
	params->dbi.data_width = LCM_DBI_DATA_WIDTH_16BITS;
	params->dbi.data_format.color_order = LCM_COLOR_ORDER_RGB;
	params->dbi.data_format.trans_seq = LCM_DBI_TRANS_SEQ_MSB_FIRST;
	params->dbi.data_format.padding = LCM_DBI_PADDING_ON_LSB;
	params->dbi.data_format.format = LCM_DBI_FORMAT_RGB565;
	params->dbi.data_format.width = LCM_DBI_DATA_WIDTH_16BITS;
	params->dbi.cpu_write_bits = LCM_DBI_CPU_WRITE_16_BITS;
	params->dbi.io_driving_current = LCM_DRIVING_CURRENT_4MA;

	params->dbi.parallel.write_setup = 1;
	params->dbi.parallel.write_hold = 1;
	params->dbi.parallel.write_wait = 2;
	params->dbi.parallel.read_setup = 4;
	params->dbi.parallel.read_hold = 0;
	params->dbi.parallel.read_latency = 18;
	params->dbi.parallel.wait_period = 1;
	params->dbi.parallel.cs_high_width = 0;

	params->dbi.te_mode = LCM_DBI_TE_MODE_VSYNC_ONLY;
	params->dbi.te_edge_polarity = LCM_POLARITY_RISING;
}


static unsigned int lcm_compare_id(void)
{
	unsigned int id1, id2, id3 = 0;

	SET_RESET_PIN(1);
	SET_RESET_PIN(0);
	MDELAY(5);
	SET_RESET_PIN(1);
	MDELAY(20);

	//*************Enable CMD2 Page1  *******************//
	set_lcm_register(0xF000, 0x55);
	set_lcm_register(0xF001, 0xAA);
	set_lcm_register(0xF002, 0x52);
	set_lcm_register(0xF003, 0x08);
	set_lcm_register(0xF004, 0x01);
	MDELAY(10);

	send_ctrl_cmd(0xC500);
	id1 = read_data_cmd();
	send_ctrl_cmd(0xC501);
	id2 = read_data_cmd();
	send_ctrl_cmd(0xC502);
	id3 = read_data_cmd();

	LCM_PRINT("[NT] ID:0x%x, 0x%x, 0x%x, 0x%x\n", id1, id2, id3, LCM_ID);
	return (LCM_ID == (id1 << 8 | id2))?1:0;
}


static void lcm_init(void)
{
	SET_RESET_PIN(1);
	SET_RESET_PIN(0);
	MDELAY(5);
	SET_RESET_PIN(1);
	MDELAY(20);

	init_lcm_registers();
}


static void lcm_suspend(void)
{
	send_ctrl_cmd(0x1000);
	MDELAY(120);

	send_ctrl_cmd(0x2800);
	MDELAY(10);

	set_lcm_register(0x4F00, 0x01);
	MDELAY(40);
}


static void lcm_resume(void)
{
	lcm_init();
}


static void lcm_update(unsigned int x, unsigned int y,
                       unsigned int width, unsigned int height)
{
	short  x0, y0, x1, y1;
	short   h_X_start,l_X_start,h_X_end,l_X_end,h_Y_start,l_Y_start,h_Y_end,l_Y_end;

	x0 = (short)x;
	y0 = (short)y;
	x1 = (short)x+width-1;
	y1 = (short)y+height-1;

	h_X_start=((x0&0x0300)>>8);
	l_X_start=(x0&0x00FF);
	h_X_end=((x1&0x0300)>>8);
	l_X_end=(x1&0x00FF);

	h_Y_start=((y0&0x0300)>>8);
	l_Y_start=(y0&0x00FF);
	h_Y_end=((y1&0x0300)>>8);
	l_Y_end=(y1&0x00FF);

	send_ctrl_cmd( 0x2A00 );
	send_data_cmd( h_X_start);
	send_ctrl_cmd( 0x2A01 );
	send_data_cmd( l_X_start);
	send_ctrl_cmd( 0x2A02);
	send_data_cmd( h_X_end );
	send_ctrl_cmd( 0x2A03);
	send_data_cmd( l_X_end );
	send_ctrl_cmd( 0x2B00 );
	send_data_cmd( h_Y_start);
	send_ctrl_cmd( 0x2B01 );
	send_data_cmd( l_Y_start);
	send_ctrl_cmd( 0x2B02);
	send_data_cmd( h_Y_end );
	send_ctrl_cmd( 0x2B03);
	send_data_cmd( l_Y_end );
	send_ctrl_cmd( 0x2C00 );
}

void lcm_read_fb(unsigned char *buffer)
{
	int i =0;
	short  x0, y0, x1, y1;
	short  h_X_start,l_X_start,h_X_end,l_X_end,h_Y_start,l_Y_start,h_Y_end,l_Y_end;
	unsigned int readData;

	x0 = 0;
	y0 = 0;
	x1 = FRAME_WIDTH-1;
	y1 = FRAME_HEIGHT-1;

	h_X_start=((x0&0x0300)>>8);
	l_X_start=(x0&0x00FF);
	h_X_end=((x1&0x0300)>>8);
	l_X_end=(x1&0x00FF);

	h_Y_start=((y0&0x0300)>>8);
	l_Y_start=(y0&0x00FF);
	h_Y_end=((y1&0x0300)>>8);
	l_Y_end=(y1&0x00FF);

	send_ctrl_cmd( 0x2A00 );
	send_data_cmd( h_X_start);
	send_ctrl_cmd( 0x2A01 );
	send_data_cmd( l_X_start);
	send_ctrl_cmd( 0x2A02);
	send_data_cmd( h_X_end );
	send_ctrl_cmd( 0x2A03);
	send_data_cmd( l_X_end );
	send_ctrl_cmd( 0x2B00 );
	send_data_cmd( h_Y_start);
	send_ctrl_cmd( 0x2B01 );
	send_data_cmd( l_Y_start);
	send_ctrl_cmd( 0x2B02);
	send_data_cmd( h_Y_end );
	send_ctrl_cmd( 0x2B03);
	send_data_cmd( l_Y_end );
	send_ctrl_cmd( 0x2E00 );

	MDELAY(20);

	//Dummy Read
	readData = read_data_cmd();

	for (i=0; i<60; i+=3) {
		readData = read_data_cmd();
		LCM_PRINT("Read data: 0x%08x \n", readData);
		MDELAY(20);

		buffer[i]  =(readData&0x00FF0000)>>16;   //R
		buffer[i+1]=(readData&0x0000FF00)>>8;    //G
		buffer[i+2]=(readData&0x000000FF);       //B
	}
}

#ifdef ESD_SUPPORT

static unsigned int lcm_esd_check(void)
{
	unsigned int readData;
	unsigned int result = TRUE;

	send_ctrl_cmd(0x0A00);
	readData = read_data_cmd();
	if (readData == 0x009C)
		result = FALSE;

	return result;
}

static unsigned int lcm_esd_recover(void)
{
	lcm_init();

	return TRUE;
}

#endif


LCM_DRIVER nt35510_mcu_6572_lcm_drv = {
	.name           = "nt35510_mcu_6572",
	.set_util_funcs = lcm_set_util_funcs,
	.get_params     = lcm_get_params,
	.init           = lcm_init,
	.suspend        = lcm_suspend,
	.resume         = lcm_resume,
	.update         = lcm_update,
	.compare_id     = lcm_compare_id,
	.read_fb        = lcm_read_fb,
#ifdef ESD_SUPPORT
	.esd_check      = lcm_esd_check,
	.esd_recover    = lcm_esd_recover,
#endif
};